Limit i_set within range of MAX1968 chip

atse 2024-04-03 11:31:34 +08:00
parent 76547be90a
commit 509b53d67d
1 changed files with 9 additions and 2 deletions

View File

@ -54,7 +54,8 @@ pub enum Handler {
pub enum Error {
ReportError,
PostFilterRateError,
FlashError
FlashError,
InputOutOfRangeError,
}
pub type JsonBuffer = Vec<u8, U1024>;
@ -184,8 +185,14 @@ impl Handler {
fn set_pwm (socket: &mut TcpSocket, channels: &mut Channels, channel: usize, pin: PwmPin, value: f64) -> Result<Handler, Error> {
match pin {
PwmPin::ISet => {
channels.channel_state(channel).pid_engaged = false;
let current = ElectricCurrent::new::<ampere>(value);
let min = ElectricCurrent::new::<ampere>(-3.0);
let max = ElectricCurrent::new::<ampere>(3.0);
if current < min || current > max {
send_line(socket, b"{\"error\": \"i_set has unit A and should be in range [-3, +3]\"}");
return Err(Error::InputOutOfRangeError);
}
channels.channel_state(channel).pid_engaged = false;
channels.set_i(channel, current);
channels.power_up(channel);
}