digital camera code

conf/settings/dc.xml

@@ -0,0 +1,12 @@
+<!DOCTYPE settings SYSTEM "settings.dtd">
+
+<settings>
+  <dl_settings>
+    <dl_settings NAME="DC">
+      <dl_setting MAX="1" MIN="1" STEP="1" VAR="dc_timer" module="dc" handler="Shutter" shortname="Shutter">
+       <strip_button name="Photo" value="1"/>
+      </dl_setting>
+      <dl_setting MAX="1" MIN="1" STEP="1" VAR="dc_timer" module="dc" handler="Zoom" shortname="Zoom"/>
+    </dl_settings>
+  </dl_settings>
+</settings>

sw/airborne/dc.c

@@ -0,0 +1,3 @@
+#include "dc.h"
+
+uint8_t dc_timer;

sw/airborne/dc.h

@@ -0,0 +1,47 @@
+#ifndef DC_H
+#define DC_H
+
+#include <inttypes.h>
+
+extern uint8_t dc_timer;
+
+#ifdef SITL
+
+#define dc_Shutter(_) { }
+#define dc_Zoom(_) { }
+
+#else /* SITL */
+
+#include "LPC21xx.h"
+#include "std.h"
+
+#define SHUTTER_DELAY 2  /* 4Hz */
+#define SHUTTER_BANK 0 /* Grey */
+#define SHUTTER_PIN 16
+
+#define ZOOM_BANK 1
+#define ZOOM_PIN 20
+
+static inline uint8_t dc_shutter() {
+  dc_timer = SHUTTER_DELAY; 
+  IO0SET = _BV(SHUTTER_PIN);
+  return 0;
+}
+
+static inline uint8_t dc_zoom() {
+  dc_timer = SHUTTER_DELAY; 
+  IO1SET = _BV(ZOOM_PIN);
+  return 0;
+}
+
+#define dc_Shutter(_) { dc_shutter(); }
+#define dc_Zoom(_) { dc_zoom(); }
+
+#define dc_init() { IO0DIR |= _BV(SHUTTER_PIN); IO0CLR = _BV(SHUTTER_PIN); ClearBit(PINSEL2, 3); IO1DIR |= _BV(ZOOM_PIN); IO1CLR = _BV(ZOOM_PIN); } /* Output */
+
+/* 4Hz */
+#define dc_periodic() { if (dc_timer) { dc_timer--; } else { IO0CLR = _BV(SHUTTER_PIN); IO1CLR = _BV(ZOOM_PIN); } }
+
+#endif /* ! SITL */
+
+#endif