diff --git a/src/platforms/posix/drivers/airspeedsim/meas_airspeed_sim.cpp b/src/platforms/posix/drivers/airspeedsim/meas_airspeed_sim.cpp index 123a22b69e..94d8d5ce7b 100644 --- a/src/platforms/posix/drivers/airspeedsim/meas_airspeed_sim.cpp +++ b/src/platforms/posix/drivers/airspeedsim/meas_airspeed_sim.cpp @@ -291,61 +291,6 @@ MEASAirspeedSim::cycle() void MEASAirspeedSim::voltage_correction(float &diff_press_pa, float &temperature) { -#if defined(CONFIG_ARCH_BOARD_PX4FMU_V2) || defined(CONFIG_ARCH_BOARD_PX4FMU_V4) - - if (_t_system_power == -1) { - _t_system_power = orb_subscribe(ORB_ID(system_power)); - } - - if (_t_system_power == -1) { - // not available - return; - } - - bool updated = false; - orb_check(_t_system_power, &updated); - - if (updated) { - orb_copy(ORB_ID(system_power), _t_system_power, &system_power); - } - - if (system_power.voltage5V_v < 3.0f || system_power.voltage5V_v > 6.0f) { - // not valid, skip correction - return; - } - - const float slope = 65.0f; - /* - apply a piecewise linear correction, flattening at 0.5V from 5V - */ - float voltage_diff = system_power.voltage5V_v - 5.0f; - - if (voltage_diff > 0.5f) { - voltage_diff = 0.5f; - } - - if (voltage_diff < -0.5f) { - voltage_diff = -0.5f; - } - - diff_press_pa -= voltage_diff * slope; - - /* - the temperature masurement varies as well - */ - const float temp_slope = 0.887f; - voltage_diff = system_power.voltage5V_v - 5.0f; - - if (voltage_diff > 0.5f) { - voltage_diff = 0.5f; - } - - if (voltage_diff < -1.0f) { - voltage_diff = -1.0f; - } - - temperature -= voltage_diff * temp_slope; -#endif // CONFIG_ARCH_BOARD_PX4FMU_V2 } /**