From c9145a24b46cf0f8db19331af9f04ccd2f558948 Mon Sep 17 00:00:00 2001 From: Julian Oes Date: Tue, 20 May 2025 11:59:33 +1200 Subject: [PATCH] holybro: hard-select CAM1 for now I don't think there is an easy way to hook this up to RC input at the moment, so I'm setting it fixed to CAM1 for now. --- boards/holybro/kakuteh7-wing/src/board_config.h | 6 ++++++ boards/holybro/kakuteh7-wing/src/init.c | 2 ++ 2 files changed, 8 insertions(+) diff --git a/boards/holybro/kakuteh7-wing/src/board_config.h b/boards/holybro/kakuteh7-wing/src/board_config.h index b6ba3321e9..2583282495 100644 --- a/boards/holybro/kakuteh7-wing/src/board_config.h +++ b/boards/holybro/kakuteh7-wing/src/board_config.h @@ -132,12 +132,17 @@ #define GPIO_VTX_9V_EN /* PE3 */ (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_SET|GPIO_PORTE|GPIO_PIN3) +#define GPIO_CAM_SWITCH /* PC13 */ (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_CLEAR|GPIO_PORTC|GPIO_PIN13) + /* Define True logic Power Control in arch agnostic form */ #define VDD_3V3_SENSORS_EN(on_true) px4_arch_gpiowrite(GPIO_VDD_3V3_SENSORS_EN, (on_true)) #define VTX_9V_EN(on_true) px4_arch_gpiowrite(GPIO_VTX_9V_EN, (on_true)) +#define CAM_SWITCH_CAM1 px4_arch_gpiowrite(GPIO_CAM_SWITCH, false) // low is CAM1 +#define CAM_SWITCH_CAM2 px4_arch_gpiowrite(GPIO_CAM_SWITCH, true) // high is CAM2 + /* Tone alarm output */ #define TONE_ALARM_TIMER 17 /* Timer 17 */ @@ -214,6 +219,7 @@ GPIO_TONE_ALARM_IDLE, \ GPIO_PPM_IN, \ GPIO_VTX_9V_EN, \ + GPIO_CAM_SWITCH, \ } #define BOARD_ENABLE_CONSOLE_BUFFER diff --git a/boards/holybro/kakuteh7-wing/src/init.c b/boards/holybro/kakuteh7-wing/src/init.c index 4d93e5c16a..5fbe50c6a6 100644 --- a/boards/holybro/kakuteh7-wing/src/init.c +++ b/boards/holybro/kakuteh7-wing/src/init.c @@ -121,6 +121,8 @@ __EXPORT void board_peripheral_reset(int ms) board_control_spi_sensors_power(true, 0xffff); VDD_3V3_SENSORS_EN(true); VTX_9V_EN(true); + + CAM_SWITCH_CAM1; } /************************************************************************************