235 строки
7.3 KiB
C
235 строки
7.3 KiB
C
/*
|
|
Copyright 2012 Jun Wako <wakojun@gmail.com>
|
|
|
|
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 "ch.h"
|
|
#include "hal.h"
|
|
|
|
/*
|
|
* scan matrix
|
|
*/
|
|
#include "print.h"
|
|
#include "debug.h"
|
|
#include "util.h"
|
|
#include "wait.h"
|
|
#include "matrix.h"
|
|
#include "led.h"
|
|
#include "keymap.h"
|
|
#include "timer.h"
|
|
|
|
|
|
/* Matrix
|
|
* COL: input with pullup to sense
|
|
* PTD6 PTD5 PTD4 PTD3 PTA19 PTA18 PTA4 PTA2 PTA1 PTE25 PTE24 PTE30 PTE29 PTE21
|
|
*
|
|
* ROW: output low to strobe
|
|
* PTB3 PTB16 PTB17 PTC0 PTC1
|
|
*
|
|
* State(1:on, 0:off)
|
|
*/
|
|
static matrix_row_t matrix[MATRIX_ROWS];
|
|
static matrix_row_t matrix_debouncing[MATRIX_ROWS];
|
|
static bool debouncing = false;
|
|
static uint16_t debouncing_time = 0;
|
|
|
|
|
|
inline
|
|
uint8_t matrix_rows(void)
|
|
{
|
|
return MATRIX_ROWS;
|
|
}
|
|
|
|
inline
|
|
uint8_t matrix_cols(void)
|
|
{
|
|
return MATRIX_COLS;
|
|
}
|
|
|
|
void matrix_init(void)
|
|
{
|
|
debug_matrix = true;
|
|
memset(matrix, 0, MATRIX_ROWS);
|
|
memset(matrix_debouncing, 0, MATRIX_ROWS);
|
|
|
|
// COL: internal pull-up
|
|
palSetPadMode(GPIOD, 6, PAL_MODE_INPUT_PULLUP);
|
|
palSetPadMode(GPIOD, 5, PAL_MODE_INPUT_PULLUP);
|
|
palSetPadMode(GPIOD, 4, PAL_MODE_INPUT_PULLUP);
|
|
palSetPadMode(GPIOD, 3, PAL_MODE_INPUT_PULLUP);
|
|
|
|
palSetPadMode(GPIOA, 19, PAL_MODE_INPUT_PULLUP);
|
|
palSetPadMode(GPIOA, 18, PAL_MODE_INPUT_PULLUP);
|
|
palSetPadMode(GPIOA, 4, PAL_MODE_INPUT_PULLUP);
|
|
palSetPadMode(GPIOA, 2, PAL_MODE_INPUT_PULLUP);
|
|
palSetPadMode(GPIOA, 1, PAL_MODE_INPUT_PULLUP);
|
|
|
|
palSetPadMode(GPIOE, 25, PAL_MODE_INPUT_PULLUP);
|
|
palSetPadMode(GPIOE, 24, PAL_MODE_INPUT_PULLUP);
|
|
palSetPadMode(GPIOE, 30, PAL_MODE_INPUT_PULLUP);
|
|
palSetPadMode(GPIOE, 29, PAL_MODE_INPUT_PULLUP);
|
|
palSetPadMode(GPIOE, 21, PAL_MODE_INPUT_PULLUP);
|
|
|
|
// ROW: Output high
|
|
palSetPadMode(GPIOB, 3, PAL_MODE_OUTPUT_PUSHPULL);
|
|
palSetPadMode(GPIOB, 16, PAL_MODE_OUTPUT_PUSHPULL);
|
|
palSetPadMode(GPIOB, 17, PAL_MODE_OUTPUT_PUSHPULL);
|
|
palSetPadMode(GPIOC, 0, PAL_MODE_OUTPUT_PUSHPULL);
|
|
palSetPadMode(GPIOC, 1, PAL_MODE_OUTPUT_PUSHPULL);
|
|
palSetPad(GPIOB, 3);
|
|
palSetPad(GPIOB, 16);
|
|
palSetPad(GPIOB, 17);
|
|
palSetPad(GPIOC, 0);
|
|
palSetPad(GPIOC, 1);
|
|
|
|
|
|
// LED blink
|
|
palSetPadMode(GPIOD, 7, PAL_MODE_OUTPUT_PUSHPULL);
|
|
palSetPad(GPIOD, 7);
|
|
chThdSleepMilliseconds(200);
|
|
palClearPad(GPIOD, 7);
|
|
chThdSleepMilliseconds(200);
|
|
palSetPad(GPIOD, 7);
|
|
chThdSleepMilliseconds(200);
|
|
palClearPad(GPIOD, 7);
|
|
}
|
|
|
|
uint8_t matrix_scan(void)
|
|
{
|
|
for (int row = 0; row < MATRIX_ROWS; row++) {
|
|
matrix_row_t data = 0;
|
|
|
|
// strobe row
|
|
switch (row) {
|
|
case 0: palClearPad(GPIOB, 3); break;
|
|
case 1: palClearPad(GPIOB, 16); break;
|
|
case 2: palClearPad(GPIOB, 17); break;
|
|
case 3: palClearPad(GPIOC, 0); break;
|
|
case 4: palClearPad(GPIOC, 1); break;
|
|
}
|
|
|
|
//wait_us(1);
|
|
//chThdSleepMicroseconds(1); // TODO: sleep around 1ms for some reason
|
|
//chThdSleepMilliseconds(1); // seems to work correctly
|
|
|
|
data = (!palReadPad(GPIOD, 6) << 0UL) |
|
|
(!palReadPad(GPIOD, 5) << 1UL) |
|
|
(!palReadPad(GPIOD, 4) << 2UL) |
|
|
(!palReadPad(GPIOD, 3) << 3UL) |
|
|
(!palReadPad(GPIOA, 19) << 4UL) |
|
|
(!palReadPad(GPIOA, 18) << 5UL) |
|
|
(!palReadPad(GPIOA, 4) << 6UL) |
|
|
(!palReadPad(GPIOA, 2) << 7UL) |
|
|
(!palReadPad(GPIOA, 1) << 8UL) |
|
|
(!palReadPad(GPIOE, 25) << 9UL) |
|
|
(!palReadPad(GPIOE, 24) << 10UL) |
|
|
(!palReadPad(GPIOE, 30) << 11UL) |
|
|
(!palReadPad(GPIOE, 29) << 12UL) |
|
|
(!palReadPad(GPIOE, 21) << 13UL);
|
|
|
|
// unstrobe row
|
|
switch (row) {
|
|
case 0: palSetPad(GPIOB, 3); break;
|
|
case 1: palSetPad(GPIOB, 16); break;
|
|
case 2: palSetPad(GPIOB, 17); break;
|
|
case 3: palSetPad(GPIOC, 0); break;
|
|
case 4: palSetPad(GPIOC, 1); break;
|
|
}
|
|
|
|
if (matrix_debouncing[row] != data) {
|
|
matrix_debouncing[row] = data;
|
|
debouncing = true;
|
|
debouncing_time = timer_read();
|
|
}
|
|
}
|
|
|
|
if (debouncing && timer_elapsed(debouncing_time) > DEBOUNCE) {
|
|
for (int row = 0; row < MATRIX_ROWS; row++) {
|
|
matrix[row] = matrix_debouncing[row];
|
|
}
|
|
debouncing = false;
|
|
}
|
|
return 1;
|
|
}
|
|
|
|
inline
|
|
bool matrix_is_on(uint8_t row, uint8_t col)
|
|
{
|
|
return (matrix[row] & (1<<col));
|
|
}
|
|
|
|
inline
|
|
matrix_row_t matrix_get_row(uint8_t row)
|
|
{
|
|
return matrix[row];
|
|
}
|
|
|
|
void matrix_print(void)
|
|
{
|
|
return;
|
|
xprintf("\nr/c 0123456789ABCDEF\n");
|
|
for (uint8_t row = 0; row < MATRIX_ROWS; row++) {
|
|
xprintf("%02X: ", row);
|
|
matrix_row_t data = matrix_get_row(row);
|
|
for (int col = 0; col < MATRIX_COLS; col++) {
|
|
if (data & (1<<col))
|
|
xprintf("1");
|
|
else
|
|
xprintf("0");
|
|
}
|
|
xprintf("\n");
|
|
}
|
|
}
|
|
|
|
|
|
//
|
|
// LED
|
|
//
|
|
void led_set(uint8_t usb_led) {
|
|
if (usb_led & (1<<USB_LED_CAPS_LOCK)) {
|
|
// output high
|
|
palSetPadMode(GPIOD, 7, PAL_MODE_OUTPUT_PUSHPULL);
|
|
palSetPad(GPIOD, 7);
|
|
} else {
|
|
// Hi-Z
|
|
palSetPadMode(GPIOD, 7, PAL_MODE_INPUT);
|
|
}
|
|
}
|
|
|
|
|
|
//
|
|
// Keymap
|
|
//
|
|
const uint8_t keymaps[][MATRIX_ROWS][MATRIX_COLS] = {
|
|
[0] = {
|
|
{ KC_ESC, KC_1, KC_2, KC_3, KC_4, KC_5, KC_6, KC_7, KC_8, KC_9, KC_0, KC_MINS, KC_EQL, KC_BSLS },
|
|
{ KC_TAB, KC_Q, KC_W, KC_E, KC_R, KC_T, KC_Y, KC_U, KC_I, KC_O, KC_P, KC_LBRC, KC_RBRC, KC_BSPC },
|
|
{ KC_LCTL, KC_A, KC_S, KC_D, KC_F, KC_G, KC_H, KC_J, KC_K, KC_L, KC_SCLN, KC_QUOT, KC_ENT, KC_NO },
|
|
{ KC_LSFT, KC_Z, KC_X, KC_C, KC_V, KC_B, KC_N, KC_M, KC_COMM, KC_DOT, KC_SLSH, KC_RSFT, KC_NO, KC_FN0 },
|
|
{ KC_LCTL, KC_LGUI, KC_LALT, KC_NO, KC_SPC, KC_NO, KC_NO, KC_NO, KC_NLCK, KC_CAPS, KC_MENU, KC_RALT, KC_RGUI, KC_RCTL },
|
|
},
|
|
[1] = {
|
|
{ KC_ESC, KC_F1, KC_F2, KC_F3, KC_F4, KC_F5, KC_F6, KC_F7, KC_F8, KC_F9, KC_F10, KC_F11, KC_F12, KC_DEL },
|
|
{ KC_CAPS, KC_TRNS, KC_TRNS, KC_TRNS, KC_TRNS, KC_TRNS, KC_TRNS, KC_TRNS, KC_PSCR, KC_SLCK, KC_PAUS, KC_UP, KC_INS, KC_TRNS },
|
|
{ KC_TRNS, KC_VOLD, KC_VOLU, KC_MUTE, KC_TRNS, KC_TRNS, KC_PAST, KC_PSLS, KC_HOME, KC_PGUP, KC_LEFT, KC_RGHT, KC_PENT, KC_TRNS },
|
|
{ KC_TRNS, KC_TRNS, KC_TRNS, KC_TRNS, KC_TRNS, KC_TRNS, KC_PPLS, KC_PMNS, KC_END, KC_PGDN, KC_DOWN, KC_TRNS, KC_TRNS, KC_TRNS },
|
|
{ KC_TRNS, KC_TRNS, KC_TRNS, KC_TRNS, KC_TRNS, KC_TRNS, KC_TRNS, KC_TRNS, KC_TRNS, KC_TRNS, KC_TRNS, KC_TRNS, KC_TRNS, KC_TRNS },
|
|
},
|
|
};
|
|
|
|
const action_t fn_actions[] = {
|
|
[0] = ACTION_LAYER_TAP_KEY(1, KC_GRV),
|
|
};
|