diff --git a/ROMFS/px4fmu_common/init.d/rcS b/ROMFS/px4fmu_common/init.d/rcS index 28ed13083b..2510b35734 100644 --- a/ROMFS/px4fmu_common/init.d/rcS +++ b/ROMFS/px4fmu_common/init.d/rcS @@ -643,6 +643,11 @@ then frsky_telemetry start -d /dev/ttyS6 fi + if ver hwcmp MINDPX_V2 + then + frsky_telemetry start -d /dev/ttyS6 + fi + if ver hwcmp PX4FMU_V2 then # Check for flow sensor - as it is a background task, launch it last @@ -657,7 +662,6 @@ then if ver hwcmp MINDPX_V2 then - #mindxp also need flow px4flow start & fi diff --git a/src/drivers/boards/mindpx-v2/board_config.h b/src/drivers/boards/mindpx-v2/board_config.h index 6d977cdf06..54fa3bff54 100644 --- a/src/drivers/boards/mindpx-v2/board_config.h +++ b/src/drivers/boards/mindpx-v2/board_config.h @@ -289,6 +289,9 @@ #define GPIO_SBUS_INV (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_SET|GPIO_PORTA|GPIO_PIN10) #define INVERT_RC_INPUT(_s) px4_arch_gpiowrite(GPIO_SBUS_INV, _s); +#define GPIO_FRSKY_INV (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_SET|GPIO_PORTB|GPIO_PIN12) +#define INVERT_FRSKY(_s) px4_arch_gpiowrite(GPIO_FRSKY_INV, _s); + /* Power switch controls */ #define GPIO_SPEKTRUM_PWR_EN #define POWER_SPEKTRUM(_s) do { } while (0) diff --git a/src/drivers/boards/mindpx-v2/mindpx2_init.c b/src/drivers/boards/mindpx-v2/mindpx2_init.c index be259453d4..3269b53fdd 100644 --- a/src/drivers/boards/mindpx-v2/mindpx2_init.c +++ b/src/drivers/boards/mindpx-v2/mindpx2_init.c @@ -183,6 +183,7 @@ __EXPORT int nsh_archinitialize(void) px4_arch_configgpio(GPIO_SBUS_INV); px4_arch_configgpio(GPIO_RC_OUT); /* Serial RC output pin */ px4_arch_gpiowrite(GPIO_RC_OUT, 1); /* set it high to pull RC input up */ + px4_arch_configgpio(GPIO_FRSKY_INV); /* configure the high-resolution time/callout interface */ hrt_init();