diff options
-rw-r--r-- | apps/sensors/sensors.cpp | 6 |
1 files changed, 5 insertions, 1 deletions
diff --git a/apps/sensors/sensors.cpp b/apps/sensors/sensors.cpp index 8b5c66b4f..577dc483b 100644 --- a/apps/sensors/sensors.cpp +++ b/apps/sensors/sensors.cpp @@ -994,6 +994,11 @@ Sensors::adc_poll(struct sensor_combined_s &raw) if (voltage > VOLTAGE_BATTERY_IGNORE_THRESHOLD_VOLTS) { + /* one-time initialization of low-pass value to avoid long init delays */ + if (_battery_status.voltage_v < 3.0f) { + _battery_status.voltage_v = voltage; + } + _battery_status.timestamp = hrt_absolute_time(); _battery_status.voltage_v = (BAT_VOL_LOWPASS_1 * (_battery_status.voltage_v + BAT_VOL_LOWPASS_2 * voltage));; /* current and discharge are unknown */ @@ -1003,7 +1008,6 @@ Sensors::adc_poll(struct sensor_combined_s &raw) /* announce the battery voltage if needed, just publish else */ if (_battery_pub > 0) { orb_publish(ORB_ID(battery_status), _battery_pub, &_battery_status); - printf("DBG: ADC PUB: %d, val: %d\n", ret, (int)(buf_adc[0].am_data)); } else { _battery_pub = orb_advertise(ORB_ID(battery_status), &_battery_status); |