From 2fad9a63973889354971b1638570363ed97e22c3 Mon Sep 17 00:00:00 2001 From: Pavel Kirienko Date: Sat, 6 Aug 2016 15:28:27 +0300 Subject: [PATCH] ESC status: printing temperature in Celsius --- src/modules/uavcan/uavcan_main.cpp | 5 ++++- 1 file changed, 4 insertions(+), 1 deletion(-) diff --git a/src/modules/uavcan/uavcan_main.cpp b/src/modules/uavcan/uavcan_main.cpp index d245c2fb3a..1dd0a8c67c 100644 --- a/src/modules/uavcan/uavcan_main.cpp +++ b/src/modules/uavcan/uavcan_main.cpp @@ -1227,10 +1227,13 @@ UavcanNode::print_info() printf("Addr\tV\tA\tTemp\tSetpt\tRPM\tErr\n"); for (uint8_t i = 0; i < _outputs.noutputs; i++) { + const float temp_celsius = (esc.esc[i].esc_temperature > 0) ? + (esc.esc[i].esc_temperature - 273.15F) : 0.0F; + printf("%d\t", esc.esc[i].esc_address); printf("%3.2f\t", (double)esc.esc[i].esc_voltage); printf("%3.2f\t", (double)esc.esc[i].esc_current); - printf("%3.2f\t", (double)esc.esc[i].esc_temperature); + printf("%3.2f\t", (double)temp_celsius); printf("%3.2f\t", (double)esc.esc[i].esc_setpoint); printf("%d\t", esc.esc[i].esc_rpm); printf("%d", esc.esc[i].esc_errorcount);