diff options
author | Anton Babushkin <anton.babushkin@me.com> | 2014-03-04 23:13:20 +0400 |
---|---|---|
committer | Anton Babushkin <anton.babushkin@me.com> | 2014-03-04 23:13:20 +0400 |
commit | a50957c3cec92167594b7bd82561f72100ccebdd (patch) | |
tree | 35d0045ecac24871abc1109a1d87f6747b3a0b21 | |
parent | 046def571d21856f24f6afc805450c003858afea (diff) | |
download | px4-firmware-a50957c3cec92167594b7bd82561f72100ccebdd.tar.gz px4-firmware-a50957c3cec92167594b7bd82561f72100ccebdd.tar.bz2 px4-firmware-a50957c3cec92167594b7bd82561f72100ccebdd.zip |
px4io: print all control groups in "px4io status"
-rw-r--r-- | src/drivers/px4io/px4io.cpp | 10 |
1 files changed, 6 insertions, 4 deletions
diff --git a/src/drivers/px4io/px4io.cpp b/src/drivers/px4io/px4io.cpp index 7c7b3dcb7..4c48194d4 100644 --- a/src/drivers/px4io/px4io.cpp +++ b/src/drivers/px4io/px4io.cpp @@ -1921,12 +1921,14 @@ PX4IO::print_status() io_reg_get(PX4IO_PAGE_SETUP, PX4IO_P_SETUP_PWM_ALTRATE)); #endif printf("debuglevel %u\n", io_reg_get(PX4IO_PAGE_SETUP, PX4IO_P_SETUP_SET_DEBUG)); - printf("controls"); + for (unsigned group = 0; group < PX4IO_CONTROL_GROUPS; group++) { + printf("controls %u:", group); - for (unsigned i = 0; i < _max_controls; i++) - printf(" %u", io_reg_get(PX4IO_PAGE_CONTROLS, i)); + for (unsigned i = 0; i < _max_controls; i++) + printf(" %u", io_reg_get(PX4IO_PAGE_CONTROLS, group * PX4IO_PROTOCOL_MAX_CONTROL_COUNT + i)); - printf("\n"); + printf("\n"); + } for (unsigned i = 0; i < _max_rc_input; i++) { unsigned base = PX4IO_P_RC_CONFIG_STRIDE * i; |