split GPIO stuff into separate file

1 files changed, 159 insertions, 0 deletions

diff --git a/gpio.c b/gpio.c
new file mode 100644
index 0000000..da2ffef
--- /dev/null
+++ b/gpio.c
@@ -0,0 +1,159 @@
+#include "gpio.h"
+
+#include <fcntl.h>
+#include <stdint.h>
+#include <stdio.h>
+#include <string.h>
+#include <unistd.h>
+
+#define GPIO_BASEDIR	"/sys/class/gpio"
+#define GPIO_EXPORT	GPIO_BASEDIR "/export"
+
+#define GPIO_IN		"in"
+#define GPIO_INIT_LOW	"GPIO_INIT_LOW"
+#define GPIO_INIT_HIGH	"GPIO_INIT_HIGH"
+
+static int gpio_open(int port, const char *field, int flags)
+{
+	char path[256];
+	sprintf(path, "%s/gpio%d/%s", GPIO_BASEDIR, port, field);
+	return open(path, flags);
+}
+
+int gpio_get(int port)
+{
+	char c;
+	int fd = gpio_open(port, "value", O_RDONLY);
+	read(fd, &c, 1);
+	close(fd);
+	if (c == '0') {
+		return 0;
+	}
+	return 1;
+}
+
+void gpio_set(int port)
+{
+	int fd = gpio_open(port, "value", O_WRONLY);
+	write(fd, "1", 1);
+	close(fd);
+}
+
+void gpio_clear(int port)
+{
+	int fd = gpio_open(port, "value", O_WRONLY);
+	write(fd, "0", 1);
+	close(fd);
+}
+
+static void gpio_enable(int export_fd, int port, const char *state)
+{
+	dprintf(export_fd, "%d", port);
+	int fd = gpio_open(port, "direction", O_WRONLY);
+	write(fd, "state", strlen(state));
+	close(fd);
+}
+
+void gpio_init(void)
+{
+	struct {
+		uint8_t port;
+		const char *initstate;
+	} ports[] = {
+		{ 100, GPIO_IN },
+		{ 91, GPIO_IN },
+		{ 96, GPIO_IN },
+		{ 89, GPIO_IN },
+			{ 95, GPIO_IN },
+			{ 92, GPIO_IN },
+				{ 108, GPIO_INIT_LOW },
+				{ 94, GPIO_INIT_LOW },
+				{ 101, GPIO_INIT_LOW },	/* 95, 92 */
+		{ 5, GPIO_INIT_LOW },
+		{ 4, GPIO_INIT_LOW },
+		{ 93, GPIO_IN },
+		{ 98, GPIO_INIT_HIGH },
+				{ 90, GPIO_INIT_HIGH },	/* 108, 94, 101 */
+		{ 88, GPIO_IN },
+		{ 0, GPIO_INIT_LOW },
+		{ 1, GPIO_INIT_LOW },
+		{ 2, GPIO_INIT_LOW },
+		{ 3, GPIO_INIT_LOW },
+		{ 6, GPIO_INIT_LOW },
+		{ 28, GPIO_INIT_LOW },
+		{ 29, GPIO_INIT_LOW },
+		{ 30, GPIO_INIT_LOW },
+		{ 33, GPIO_INIT_LOW },
+		{ 37, GPIO_INIT_LOW },
+		{ 38, GPIO_INIT_LOW },
+		{ 47, GPIO_INIT_LOW },
+		{ 48, GPIO_INIT_LOW },
+		{ 49, GPIO_INIT_LOW },
+		{ 50, GPIO_INIT_LOW },
+		{ 51, GPIO_INIT_LOW },
+		{ 52, GPIO_INIT_LOW },
+		{ 53, GPIO_INIT_LOW },
+		{ 54, GPIO_INIT_LOW },
+		{ 55, GPIO_INIT_LOW },
+		{ 56, GPIO_INIT_LOW },
+		{ 57, GPIO_INIT_LOW },
+		{ 58, GPIO_INIT_LOW },
+		{ 59, GPIO_INIT_LOW },
+		{ 60, GPIO_INIT_LOW },
+		{ 61, GPIO_INIT_LOW },
+		{ 62, GPIO_INIT_LOW },
+		{ 63, GPIO_INIT_LOW },
+		{ 64, GPIO_INIT_LOW },
+		{ 65, GPIO_INIT_LOW },
+		{ 66, GPIO_INIT_LOW },
+		{ 67, GPIO_INIT_LOW },
+		{ 68, GPIO_INIT_LOW },
+		{ 69, GPIO_INIT_LOW },
+		{ 70, GPIO_INIT_LOW },
+		{ 71, GPIO_INIT_LOW },
+		{ 72, GPIO_INIT_LOW },
+		{ 73, GPIO_INIT_LOW },
+		{ 74, GPIO_INIT_LOW },
+				{ 75, GPIO_INIT_LOW },	/* not enabled */
+		{ 78, GPIO_INIT_LOW },
+		{ 79, GPIO_INIT_LOW },
+		{ 86, GPIO_INIT_LOW },
+		{ 87, GPIO_INIT_LOW },
+		{ 97, GPIO_INIT_LOW },
+		{ 99, GPIO_INIT_LOW },
+		{ 104, GPIO_INIT_LOW },
+		{ 105, GPIO_INIT_LOW },
+		{ 106, GPIO_INIT_LOW },
+		{ 107, GPIO_INIT_LOW },
+		{ 109, GPIO_INIT_LOW },
+		{ 110, GPIO_INIT_LOW },
+		{ 111, GPIO_INIT_LOW },
+		{ 112, GPIO_INIT_LOW },
+		{ 113, GPIO_INIT_LOW },
+		{ 114, GPIO_INIT_LOW },
+		{ 115, GPIO_INIT_LOW },
+		{ 116, GPIO_INIT_LOW },
+		{ 117, GPIO_INIT_LOW },
+		{ 118, GPIO_INIT_LOW },
+		{ 119, GPIO_INIT_LOW },
+		{ 120, GPIO_INIT_LOW },
+		{ 121, GPIO_INIT_LOW },
+		{ 122, GPIO_INIT_LOW },
+		{ 135, GPIO_INIT_LOW },
+		{ 137, GPIO_INIT_LOW },
+		{ 138, GPIO_INIT_LOW },
+		{ 140, GPIO_INIT_LOW },
+		{ 144, GPIO_INIT_LOW },
+		{ 145, GPIO_INIT_LOW },
+		{ 146, GPIO_INIT_LOW },
+		{ 147, GPIO_INIT_LOW },
+		{ 148, GPIO_INIT_LOW },
+		{ 149, GPIO_INIT_LOW },
+	};
+
+	int gpio_export = open(GPIO_EXPORT, O_WRONLY);
+	for (size_t i = 0; i < sizeof(ports) / sizeof(ports[0]); i++) {
+		gpio_enable(gpio_export, ports[i].port, ports[i].initstate);
+	}
+	close(gpio_export);
+}