1 files changed, 75 insertions, 0 deletions
diff --git a/src/hid.c b/src/hid.c
new file mode 100644
index 0000000..7ff1159
--- /dev/null
+++ b/src/hid.c
@@ -0,0 +1,75 @@
+#include "board.h"
+#include "util.h"
+
+#include "hardware/timer.h"
+
+#define KEY_ROWS ARRLEN(matrix_row_pins)
+#define KEY_COLS ARRLEN(matrix_col_pins)
+#define KEY_COUNT (KEY_ROWS * KEY_COLS)
+
+static void handle_press(uint x, uint y);
+static void handle_release(uint x, uint y);
+
+static const uint matrix_col_pins[] = { 4, 5, 6, 7 };
+static const uint matrix_row_pins[] = { 29, 28, 27, 26, 22, 20 };
+
+//static uint press_index = 0;
+static bool press_map[KEY_COUNT] = { 0 };
+//static uint32_t press_syms[KEY_COUNT] = { 0 };
+//static uint8_t press_order[KEY_COUNT] = { 0 };
+
+void
+handle_press(uint x, uint y)
+{
+	
+}
+
+void
+handle_release(uint x, uint y)
+{
+
+}
+
+void
+hid_init(void)
+{
+	uint x, y;
+
+	for (y = 0; y < ARRLEN(matrix_row_pins); y++) {
+		gpio_init(matrix_row_pins[y]);
+		gpio_set_dir(matrix_row_pins[y], GPIO_IN);
+		gpio_pull_up(matrix_row_pins[y]);
+	}
+
+	for (x = 0; x < ARRLEN(matrix_col_pins); x++) {
+		gpio_init(matrix_col_pins[x]);
+		gpio_set_dir(matrix_col_pins[x], GPIO_OUT);
+	}
+}
+
+void
+hid_task(void)
+{
+	bool pressed;
+	uint x, y;
+
+	/* scan matrix */
+	for (y = 0; y < ARRLEN(matrix_row_pins); y++) {
+		for (x = 0; x < ARRLEN(matrix_col_pins); x++) {
+			gpio_put(matrix_col_pins[x], 0);
+			busy_wait_us(5);
+			pressed = !gpio_get(matrix_row_pins[y]);
+			if (pressed && !press_map[y * KEY_COLS + x]) {
+				handle_press(x, y);
+				press_map[y * KEY_COLS + x] = true;
+			} else if (!pressed && press_map[y * KEY_COLS + x]) {
+				handle_release(x, y);
+				press_map[y * KEY_COLS + x] = false;
+			}
+			gpio_put(matrix_col_pins[x], 1);
+			busy_wait_us(5);
+		}
+	}
+
+	/* assemble hid report */
+}