diff --git a/conf/modules/digital_cam.xml b/conf/modules/digital_cam.xml index c84947f986..2430a00aea 100644 --- a/conf/modules/digital_cam.xml +++ b/conf/modules/digital_cam.xml @@ -4,15 +4,6 @@ // Use (parts of) the following section in airframe file to change -
- - - - - - -
- # ap.CFLAGS += -DGPS_TRIGGERED_FUNCTION="dc_shoot_on_gps" # ap.CFLAGS += -DDC_GPS_TRIGGER_START=1 # ap.CFLAGS += -DDC_GPS_TRIGGER_STOP=3 @@ -24,6 +15,12 @@ Digital camera control (trigger using led) + + + + + +
diff --git a/sw/airborne/modules/digital_cam/led_cam_ctrl.h b/sw/airborne/modules/digital_cam/led_cam_ctrl.h index 421d44b962..0283e6261c 100644 --- a/sw/airborne/modules/digital_cam/led_cam_ctrl.h +++ b/sw/airborne/modules/digital_cam/led_cam_ctrl.h @@ -52,15 +52,6 @@ extern uint8_t dc_timer; -static inline void led_cam_ctrl_init(void) -{ - // Call common DC init - dc_init(); - - // Do LED specific DC init - dc_timer = 0; -} - #ifndef DC_PUSH #define DC_PUSH LED_ON #endif @@ -77,6 +68,26 @@ static inline void led_cam_ctrl_init(void) #error DC: Please specify at least a SHUTTER LED #endif +static inline void led_cam_ctrl_init(void) +{ + // Call common DC init + dc_init(); + + // Do LED specific DC init + dc_timer = 0; + + DC_RELEASE(DC_SHUTTER_LED); +#ifdef DC_ZOOM_IN_LED + DC_RELEASE(DC_ZOOM_IN_LED); +#endif +#ifdef DC_ZOOM_OUT_LED + DC_RELEASE(DC_ZOOM_OUT_LED); +#endif +#ifdef DC_POWER_LED + DC_RELEASE(DC_POWER_LED); +#endif +} + /* 4Hz Periodic */ static inline void led_cam_ctrl_periodic( void )