aboutsummaryrefslogtreecommitdiffstats
path: root/keyboards/model01/matrix.c
diff options
context:
space:
mode:
Diffstat (limited to 'keyboards/model01/matrix.c')
-rw-r--r--keyboards/model01/matrix.c94
1 files changed, 94 insertions, 0 deletions
diff --git a/keyboards/model01/matrix.c b/keyboards/model01/matrix.c
new file mode 100644
index 000000000..f1f9024c7
--- /dev/null
+++ b/keyboards/model01/matrix.c
@@ -0,0 +1,94 @@
+/* Copyright 2018 James Laird-Wah
+ *
+ * This program is free software: you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation, either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program 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 General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program. If not, see <http://www.gnu.org/licenses/>.
+ */
+#include <quantum.h>
+#include <i2c_master.h>
+#include <string.h>
+#include "model01.h"
+
+/* If no key events have occurred, the scanners will time out on reads.
+ * So we don't want to be too permissive here. */
+#define I2C_TIMEOUT 10
+
+static matrix_row_t rows[MATRIX_ROWS];
+#define ROWS_PER_HAND (MATRIX_ROWS / 2)
+
+inline
+uint8_t matrix_rows(void) {
+ return MATRIX_ROWS;
+}
+
+inline
+uint8_t matrix_cols(void) {
+ return MATRIX_COLS;
+}
+
+static int i2c_read_hand(int hand) {
+ uint8_t buf[5];
+ i2c_status_t ret = i2c_receive(I2C_ADDR(hand), buf, sizeof(buf), I2C_TIMEOUT);
+ if (ret != I2C_STATUS_SUCCESS)
+ return 1;
+
+ if (buf[0] != TWI_REPLY_KEYDATA)
+ return 2;
+
+ int start_row = hand ? ROWS_PER_HAND : 0;
+ uint8_t *out = &rows[start_row];
+ memcpy(out, &buf[1], 4);
+ return 0;
+}
+
+static int i2c_set_keyscan_interval(int hand, int delay) {
+ uint8_t buf[] = {TWI_CMD_KEYSCAN_INTERVAL, delay};
+ i2c_status_t ret = i2c_transmit(I2C_ADDR(hand), buf, sizeof(buf), I2C_TIMEOUT);
+ return ret;
+}
+
+void matrix_init(void) {
+ /* Ensure scanner power is on - else right hand will not work */
+ DDRC |= _BV(7);
+ PORTC |= _BV(7);
+
+ i2c_init();
+ i2c_set_keyscan_interval(LEFT, 2);
+ i2c_set_keyscan_interval(RIGHT, 2);
+ memset(rows, 0, sizeof(rows));
+
+ matrix_init_quantum();
+}
+
+uint8_t matrix_scan(void) {
+ uint8_t ret = 0;
+ ret |= i2c_read_hand(LEFT);
+ ret |= i2c_read_hand(RIGHT);
+ matrix_scan_quantum();
+ return ret;
+}
+
+inline
+matrix_row_t matrix_get_row(uint8_t row) {
+ return rows[row];
+}
+
+void matrix_print(void) {
+ print("\nr/c 0123456789ABCDEF\n");
+ for (uint8_t row = 0; row < MATRIX_ROWS; row++) {
+ phex(row); print(": ");
+ pbin_reverse16(matrix_get_row(row));
+ print("\n");
+ }
+}
+
+/* vim: set ts=2 sw=2 et: */