forked from Archive/PX4-Autopilot
parent
8cc190e327
commit
badfbd7bac
|
@ -338,7 +338,6 @@ void FixedwingRateControl::Run()
|
||||||
_trim.setAirspeed(airspeed);
|
_trim.setAirspeed(airspeed);
|
||||||
_trim_slew.update(_trim.getTrim(), dt);
|
_trim_slew.update(_trim.getTrim(), dt);
|
||||||
|
|
||||||
if (_vcontrol_mode.flag_control_rates_enabled) {
|
|
||||||
_rates_sp_sub.update(&_rates_sp);
|
_rates_sp_sub.update(&_rates_sp);
|
||||||
|
|
||||||
Vector3f body_rates_setpoint = Vector3f(_rates_sp.roll, _rates_sp.pitch, _rates_sp.yaw);
|
Vector3f body_rates_setpoint = Vector3f(_rates_sp.roll, _rates_sp.pitch, _rates_sp.yaw);
|
||||||
|
@ -387,7 +386,6 @@ void FixedwingRateControl::Run()
|
||||||
|
|
||||||
_vehicle_thrust_setpoint.xyz[0] *= _battery_scale;
|
_vehicle_thrust_setpoint.xyz[0] *= _battery_scale;
|
||||||
}
|
}
|
||||||
}
|
|
||||||
|
|
||||||
// publish rate controller status
|
// publish rate controller status
|
||||||
rate_ctrl_status_s rate_ctrl_status{};
|
rate_ctrl_status_s rate_ctrl_status{};
|
||||||
|
|
Loading…
Reference in New Issue