Initial commit of library code, moved from leaftest repo

git-svn-id: https://leaflabs.googlecode.com/svn/trunk/library@69 749a229e-a60e-11de-b98f-4500b42dc123

1 files changed, 55 insertions, 0 deletions

diff --git a/src/wiring/wiring_digital.c b/src/wiring/wiring_digital.c
new file mode 100644
index 0000000..1ece41a
--- /dev/null
+++ b/src/wiring/wiring_digital.c
@@ -0,0 +1,55 @@
+#include "gpio.h"
+#include "wiring.h"
+#include "util.h"
+
+typedef struct PinGPIOMapping {
+    GPIO_Port *port;
+    uint32_t pin;
+} PinGPIOMapping;
+
+static const PinGPIOMapping PIN_TO_GPIO[NR_MAPLE_PINS] = {
+    {_GPIOA_BASE,  3},                          // D0/PA3
+    {_GPIOA_BASE,  2},                          // D1/PA2
+    {_GPIOA_BASE,  0},                          // D2/PA0
+    {_GPIOA_BASE,  1},                          // D3/PA1
+    {_GPIOB_BASE,  5},                          // D4/PB5
+    {_GPIOB_BASE,  6},                          // D5/PB6
+    {_GPIOA_BASE,  8},                          // D6/PA8
+    {_GPIOA_BASE,  9},                          // D7/PA9
+    {_GPIOA_BASE, 10},                          // D8/PA10
+    {_GPIOB_BASE,  7},                          // D9/PB7
+    {_GPIOA_BASE,  4},                          // D10/PA4
+    {_GPIOA_BASE,  7},                          // D11/PA7
+    {_GPIOA_BASE,  6},                          // D12/PA6
+    {_GPIOA_BASE,  5},                          // D13/PA5
+#if 0
+    {_GPIOC_BASE,  0},                          // D14/A0/PC0
+    {_GPIOC_BASE,  1},                          // D15/A1/PC1
+    {_GPIOC_BASE,  2},                          // D16/A2/PC2
+    {_GPIOC_BASE,  3},                          // D17/A3/PC3
+    {_GPIOC_BASE,  4},                          // D18/A4/PC4
+    {_GPIOC_BASE,  5},                          // D19/A5/PC5
+#endif
+};
+
+void pinMode(uint8_t pin, uint8_t mode) {
+    if (pin >= NR_MAPLE_PINS)
+        return;
+
+    gpio_set_mode(PIN_TO_GPIO[pin].port, PIN_TO_GPIO[pin].pin, mode);
+}
+
+
+uint32_t digitalRead(uint8_t pin) {
+    if (pin >= NR_MAPLE_PINS)
+        return 0;
+
+    return (PIN_TO_GPIO[pin].port->IDR & BIT(PIN_TO_GPIO[pin].pin)) ? 1 : 0;
+}
+
+void digitalWrite(uint8_t pin, uint8_t val) {
+    if (pin >= NR_MAPLE_PINS)
+        return;
+
+    gpio_write_bit(PIN_TO_GPIO[pin].port, PIN_TO_GPIO[pin].pin, val);
+}