diff options
| author | px4dev <px4@purgatory.org> | 2013-06-28 23:39:35 -0700 |
|---|---|---|
| committer | px4dev <px4@purgatory.org> | 2013-06-28 23:39:35 -0700 |
| commit | d1562f926f487d1ed05751d45a2516be8c192564 (patch) | |
| tree | a85bbb958f00be2c8f10b25c3cec145bd6cce0ef /src/modules/px4iofirmware/registers.c | |
| parent | 90c458cb618754905ab6d373f22d76e3309adf4c (diff) | |
| download | px4-firmware-d1562f926f487d1ed05751d45a2516be8c192564.tar.gz px4-firmware-d1562f926f487d1ed05751d45a2516be8c192564.tar.bz2 px4-firmware-d1562f926f487d1ed05751d45a2516be8c192564.zip | |
More implementation for the serial side on IO; fix a couple of bugs on the FMU side.
Still needs serial init and some more testing/config on the FMU side, but closer to being ready to test.
Diffstat (limited to 'src/modules/px4iofirmware/registers.c')
| -rw-r--r-- | src/modules/px4iofirmware/registers.c | 9 |
1 files changed, 9 insertions, 0 deletions
diff --git a/src/modules/px4iofirmware/registers.c b/src/modules/px4iofirmware/registers.c index df7d6dcd3..42554456c 100644 --- a/src/modules/px4iofirmware/registers.c +++ b/src/modules/px4iofirmware/registers.c @@ -44,6 +44,7 @@ #include <string.h> #include <drivers/drv_hrt.h> +#include <drivers/drv_pwm_output.h> #include "px4io.h" #include "protocol.h" @@ -349,10 +350,18 @@ registers_set_one(uint8_t page, uint8_t offset, uint16_t value) case PX4IO_P_SETUP_RELAYS: value &= PX4IO_P_SETUP_RELAYS_VALID; r_setup_relays = value; +#ifdef POWER_RELAY1 POWER_RELAY1(value & (1 << 0) ? 1 : 0); +#endif +#ifdef POWER_RELAY2 POWER_RELAY2(value & (1 << 1) ? 1 : 0); +#endif +#ifdef POWER_ACC1 POWER_ACC1(value & (1 << 2) ? 1 : 0); +#endif +#ifdef POWER_ACC2 POWER_ACC2(value & (1 << 3) ? 1 : 0); +#endif break; case PX4IO_P_SETUP_SET_DEBUG: |