From 1dc7d758f96dd2b9bd7b03f01ca032d68b696cf0 Mon Sep 17 00:00:00 2001
From: root <root@lab2.panaceas.james.local>
Date: Sun, 2 Nov 2014 10:14:39 +0000
Subject: fish

---
 libopencm3/lib/sam/common/gpio.c | 64 ++++++++++++++++++++++++++++++++++++++++
 1 file changed, 64 insertions(+)
 create mode 100644 libopencm3/lib/sam/common/gpio.c

(limited to 'libopencm3/lib/sam/common/gpio.c')

diff --git a/libopencm3/lib/sam/common/gpio.c b/libopencm3/lib/sam/common/gpio.c
new file mode 100644
index 0000000..75929f8
--- /dev/null
+++ b/libopencm3/lib/sam/common/gpio.c
@@ -0,0 +1,64 @@
+/*
+ * This file is part of the libopencm3 project.
+ *
+ * Copyright (C) 2012 Gareth McMullin <gareth@blacksphere.co.nz>
+ *
+ * This library is free software: you can redistribute it and/or modify
+ * it under the terms of the GNU Lesser General Public License as published by
+ * the Free Software Foundation, either version 3 of the License, or
+ * (at your option) any later version.
+ *
+ * This library is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU Lesser General Public License for more details.
+ *
+ * You should have received a copy of the GNU Lesser General Public License
+ * along with this library.  If not, see <http://www.gnu.org/licenses/>.
+ */
+
+#include <libopencm3/sam/gpio.h>
+
+void gpio_init(uint32_t port, uint32_t pins, enum gpio_flags flags)
+{
+	switch (flags & 3) {
+	case GPIO_FLAG_GPINPUT:
+		/* input mode doesn't really exist, so we make a high
+		 * output in open-drain mode
+		 */
+		PIO_SODR(port) = pins;
+		flags |= GPIO_FLAG_OPEN_DRAIN;
+		/* fall through */
+	case GPIO_FLAG_GPOUTPUT:
+		PIO_OER(port) = pins;
+		PIO_PER(port) = pins;
+		break;
+	case GPIO_FLAG_PERIPHA:
+		PIO_ABSR(port) &= ~pins;
+		PIO_PDR(port) = pins;
+		break;
+	case GPIO_FLAG_PERIPHB:
+		PIO_ABSR(port) |= pins;
+		PIO_PDR(port) = pins;
+	}
+
+	if (flags & GPIO_FLAG_OPEN_DRAIN) {
+		PIO_MDER(port) = pins;
+	} else {
+		PIO_MDDR(port) = pins;
+	}
+
+	if (flags & GPIO_FLAG_PULL_UP) {
+		PIO_PUER(port) = pins;
+	} else {
+		PIO_PUDR(port) = pins;
+	}
+}
+
+void gpio_toggle(uint32_t gpioport, uint32_t gpios)
+{
+	uint32_t odsr = PIO_ODSR(gpioport);
+	PIO_CODR(gpioport) = odsr & gpios;
+	PIO_SODR(gpioport) = ~odsr & gpios;
+}
+
-- 
cgit v1.2.3