From 925c3409150ee2469829575e29da8541d61061e8 Mon Sep 17 00:00:00 2001 From: Lorenz Meier Date: Fri, 24 Jun 2016 00:24:09 +0200 Subject: [PATCH] Remove unused code from simulated driver --- .../drivers/airspeedsim/meas_airspeed_sim.cpp | 55 ------------------- 1 file changed, 55 deletions(-) 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 } /**