mirror of https://github.com/ArduPilot/ardupilot
Plane: replaced constrain() with constrain_float()
This commit is contained in:
parent
25c576cad7
commit
9584aa89d9
|
@ -19,7 +19,7 @@ static float get_speed_scaler(void)
|
|||
} else {
|
||||
speed_scaler = 2.0;
|
||||
}
|
||||
speed_scaler = constrain(speed_scaler, 0.5, 2.0);
|
||||
speed_scaler = constrain_float(speed_scaler, 0.5, 2.0);
|
||||
} else {
|
||||
if (g.channel_throttle.servo_out > 0) {
|
||||
speed_scaler = 0.5 + ((float)THROTTLE_CRUISE / g.channel_throttle.servo_out / 2.0); // First order taylor expansion of square root
|
||||
|
@ -28,7 +28,7 @@ static float get_speed_scaler(void)
|
|||
speed_scaler = 1.67;
|
||||
}
|
||||
// This case is constrained tighter as we don't have real speed info
|
||||
speed_scaler = constrain(speed_scaler, 0.6, 1.67);
|
||||
speed_scaler = constrain_float(speed_scaler, 0.6, 1.67);
|
||||
}
|
||||
return speed_scaler;
|
||||
}
|
||||
|
@ -377,7 +377,7 @@ static void calc_nav_roll()
|
|||
* float roll_slew_limit(float servo)
|
||||
* {
|
||||
* static float last;
|
||||
* float temp = constrain(servo, last-ROLL_SLEW_LIMIT * delta_ms_fast_loop/1000.f, last + ROLL_SLEW_LIMIT * delta_ms_fast_loop/1000.f);
|
||||
* float temp = constrain_float(servo, last-ROLL_SLEW_LIMIT * delta_ms_fast_loop/1000.f, last + ROLL_SLEW_LIMIT * delta_ms_fast_loop/1000.f);
|
||||
* last = servo;
|
||||
* return temp;
|
||||
* }*/
|
||||
|
|
|
@ -1797,17 +1797,17 @@ mission_failed:
|
|||
} else if (var_type == AP_PARAM_INT32) {
|
||||
if (packet.param_value < 0) rounding_addition = -rounding_addition;
|
||||
float v = packet.param_value+rounding_addition;
|
||||
v = constrain(v, -2147483648.0, 2147483647.0);
|
||||
v = constrain_float(v, -2147483648.0, 2147483647.0);
|
||||
((AP_Int32 *)vp)->set_and_save(v);
|
||||
} else if (var_type == AP_PARAM_INT16) {
|
||||
if (packet.param_value < 0) rounding_addition = -rounding_addition;
|
||||
float v = packet.param_value+rounding_addition;
|
||||
v = constrain(v, -32768, 32767);
|
||||
v = constrain_float(v, -32768, 32767);
|
||||
((AP_Int16 *)vp)->set_and_save(v);
|
||||
} else if (var_type == AP_PARAM_INT8) {
|
||||
if (packet.param_value < 0) rounding_addition = -rounding_addition;
|
||||
float v = packet.param_value+rounding_addition;
|
||||
v = constrain(v, -128, 127);
|
||||
v = constrain_float(v, -128, 127);
|
||||
((AP_Int8 *)vp)->set_and_save(v);
|
||||
} else {
|
||||
// we don't support mavlink set on this parameter
|
||||
|
|
Loading…
Reference in New Issue