ESC status: printing temperature in Celsius

This commit is contained in:
Pavel Kirienko
2016-08-06 15:28:27 +03:00
committed by Lorenz Meier
parent 42031ab572
commit 2fad9a6397
+4 -1
View File
@@ -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);