Mirrors_Framework/PX4-Autopilot
1
0
Fork 0
mirror of https://github.com/PX4/PX4-Autopilot.git synced 2026-05-27 18:27:05 +08:00
Code Issues Actions 30 Packages Projects Releases Wiki Activity

PX4IO add IMU heater to status

Browse Source
This commit is contained in:
Daniel Agar
2016-12-04 17:22:37 -05:00
committed by Lorenz Meier
parent 1a1b8f69ac
commit 2f962a986b
1 changed files with 12 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/drivers/px4io/px4io.cpp
+12
View File
@@ -2499,6 +2499,18 @@ PX4IO::print_status(bool extended_status)
printf(" %u", io_reg_get(PX4IO_PAGE_DISARMED_PWM, i)); printf(" %u", io_reg_get(PX4IO_PAGE_DISARMED_PWM, i));
} }
/* IMU heater (Pixhawk 2.1) */
uint16_t heater_level = io_reg_get(PX4IO_PAGE_SETUP, PX4IO_P_SETUP_THERMAL);
if (heater_level != UINT16_MAX) {
if (heater_level == PX4IO_THERMAL_OFF) {
printf("\nIMU heater off", heater_level);
} else {
printf("\nIMU heater level %d", heater_level);
}
}
printf("\n"); printf("\n");
} }