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);