Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-03-03 12:14:10 -04:00
Code Issues Packages Projects Releases Wiki Activity

AP_HAL_SITL: remove redundant nullptr checks on _sitl member

Browse Source 
nullptr is checked for at the top of this function, no need to check it after that
This commit is contained in:
Peter Barker 2025-01-09 16:15:20 +11:00 committed by Peter Barker
parent 7c2d329d75
commit beb3dd1519
1 changed files with 15 additions and 21 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

34
libraries/AP_HAL_SITL/SITL_State.cpp
View File

@ -327,7 +327,7 @@ void SITL_State::_simulator_servos(struct sitl_input &input)
// give 5 seconds to calibrate airspeed sensor at 0 wind speed
if (wind_start_delay_micros == 0) {
wind_start_delay_micros = now;
} else if (_sitl && (now - wind_start_delay_micros) > 5000000 ) {
} else if ((now - wind_start_delay_micros) > 5000000 ) {
// The EKF does not like step inputs so this LPF keeps it happy.
uint32_t dt_us = now - last_wind_update_us;
if (dt_us > 1000) {
@ -379,26 +379,21 @@ void SITL_State::_simulator_servos(struct sitl_input &input)
}
}
if (_sitl != nullptr) {
// FETtec ESC simulation support. Input signals of 1000-2000
// are positive thrust, 0 to 1000 are negative thrust. Deeper
// changes required to support negative thrust - potentially
// adding a field to input.
if (_sitl != nullptr) {
if (_sitl->fetteconewireesc_sim.enabled()) {
_sitl->fetteconewireesc_sim.update_sitl_input_pwm(input);
for (uint8_t i=0; i<ARRAY_SIZE(input.servos); i++) {
if (input.servos[i] != 0 && input.servos[i] < 1000) {
AP_HAL::panic("Bad input servo value (%u)", input.servos[i]);
}
}
// FETtec ESC simulation support. Input signals of 1000-2000
// are positive thrust, 0 to 1000 are negative thrust. Deeper
// changes required to support negative thrust - potentially
// adding a field to input.
if (_sitl->fetteconewireesc_sim.enabled()) {
_sitl->fetteconewireesc_sim.update_sitl_input_pwm(input);
for (uint8_t i=0; i<ARRAY_SIZE(input.servos); i++) {
if (input.servos[i] != 0 && input.servos[i] < 1000) {
AP_HAL::panic("Bad input servo value (%u)", input.servos[i]);
}
}
}
float engine_mul = _sitl?_sitl->engine_mul.get():1;
uint32_t engine_fail = _sitl?_sitl->engine_fail.get():0;
float throttle = 0.0f;
const float engine_mul = _sitl->engine_mul.get();
const uint32_t engine_fail = _sitl->engine_fail.get();
// apply engine multiplier to motor defined by the SIM_ENGINE_FAIL parameter
for (uint8_t i=0; i<ARRAY_SIZE(input.servos); i++) {
@ -411,6 +406,7 @@ void SITL_State::_simulator_servos(struct sitl_input &input)
}
}
float throttle = 0.0f;
if (_vehicle == ArduPlane) {
float forward_throttle = constrain_float((input.servos[2] - 1000) / 1000.0f, 0.0f, 1.0f);
// do a little quadplane dance
@ -459,9 +455,7 @@ void SITL_State::_simulator_servos(struct sitl_input &input)
throttle /= running_motors;
}
}
if (_sitl) {
_sitl->throttle = throttle;
}
_sitl->throttle = throttle;
update_voltage_current(input, throttle);
}