diff --git a/src/drivers/boards/asc-v1/board_config.h b/src/drivers/boards/asc-v1/board_config.h index dda097b231..eec1a2d3c5 100644 --- a/src/drivers/boards/asc-v1/board_config.h +++ b/src/drivers/boards/asc-v1/board_config.h @@ -246,7 +246,7 @@ __BEGIN_DECLS #define GPIO_S2 (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_50MHz|GPIO_OUTPUT_CLEAR|GPIO_PORTC|GPIO_PIN13) #define GPIO_PCON_RADIO (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_SET|GPIO_PORTC|GPIO_PIN3) -#define RF_RADIO_CONTOL(_on_true) px4_arch_gpiowrite(GPIO_PCON_RADIO, !(_on_true)) +#define RF_RADIO_POWER_CONTROL(_on_true) px4_arch_gpiowrite(GPIO_PCON_RADIO, !(_on_true)) #define GPIO_TEMP_CONT (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_CLEAR|GPIO_PORTB|GPIO_PIN4) #define TEMP_CONTROL(_on_true) px4_arch_gpiowrite(GPIO_TEMP_CONT, (_on_true)) diff --git a/src/drivers/boards/tap-v1/board_config.h b/src/drivers/boards/tap-v1/board_config.h index 1aeb167606..dbd3364127 100644 --- a/src/drivers/boards/tap-v1/board_config.h +++ b/src/drivers/boards/tap-v1/board_config.h @@ -248,7 +248,7 @@ __BEGIN_DECLS #define GPIO_S2 (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_50MHz|GPIO_OUTPUT_CLEAR|GPIO_PORTC|GPIO_PIN13) #define GPIO_PCON_RADIO (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_SET|GPIO_PORTC|GPIO_PIN3) -#define RF_RADIO_CONTOL(_on_true) px4_arch_gpiowrite(GPIO_PCON_RADIO, !(_on_true)) +#define RF_RADIO_POWER_CONTROL(_on_true) px4_arch_gpiowrite(GPIO_PCON_RADIO, !(_on_true)) #define GPIO_TEMP_CONT (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_CLEAR|GPIO_PORTB|GPIO_PIN4) #define TEMP_CONTROL(_on_true) px4_arch_gpiowrite(GPIO_TEMP_CONT, (_on_true)) diff --git a/src/drivers/px4fmu/fmu.cpp b/src/drivers/px4fmu/fmu.cpp index 15006ced65..7620d82eae 100644 --- a/src/drivers/px4fmu/fmu.cpp +++ b/src/drivers/px4fmu/fmu.cpp @@ -862,10 +862,12 @@ void PX4FMU::rc_io_invert(bool invert) INVERT_RC_INPUT(invert); #ifdef GPIO_RC_OUT + if (!invert) { // set FMU_RC_OUTPUT high to pull RC_INPUT up px4_arch_gpiowrite(GPIO_RC_OUT, 1); } + #endif } #endif @@ -908,9 +910,9 @@ PX4FMU::cycle() #ifdef RC_SERIAL_PORT -#ifdef GPIO_PCON_RADIO +#ifdef RF_RADIO_POWER_CONTROL // power radio on - RF_RADIO_CONTOL(true); + RF_RADIO_POWER_CONTROL(true); #endif // dsm_init sets some file static variables and returns a file descriptor