diff options
Diffstat (limited to 'converter/pc98_usb/matrix.c')
| -rw-r--r-- | converter/pc98_usb/matrix.c | 168 |
1 files changed, 168 insertions, 0 deletions
diff --git a/converter/pc98_usb/matrix.c b/converter/pc98_usb/matrix.c new file mode 100644 index 0000000000..2f1e821c5d --- /dev/null +++ b/converter/pc98_usb/matrix.c @@ -0,0 +1,168 @@ +/* +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 <stdint.h> +#include <stdbool.h> +#include <avr/io.h> +#include <util/delay.h> +#include "print.h" +#include "util.h" +#include "matrix.h" +#include "debug.h" +#include "protocol/serial.h" + + +/* + * Matrix Array usage: + * + * ROW: 16(4bits) + * COL: 8(3bits) + * + * 8bit wide + * +---------+ + * 0|00 ... 07| + * 1|08 ... 0F| + * :| ... | + * :| ... | + * E|70 ... 77| + * F|78 ... 7F| + * +---------+ + */ +static uint8_t matrix[MATRIX_ROWS]; +#define ROW(code) ((code>>3)&0xF) +#define COL(code) (code&0x07) + +static bool is_modified = false; + + +inline +uint8_t matrix_rows(void) +{ + return MATRIX_ROWS; +} + +inline +uint8_t matrix_cols(void) +{ + return MATRIX_COLS; +} + +void matrix_init(void) +{ + print_enable = true; + debug_enable = true; + //debug_matrix = true; + + PC98_RST_DDR |= (1<<PC98_RST_BIT); + PC98_RDY_DDR |= (1<<PC98_RDY_BIT); + PC98_RTY_DDR |= (1<<PC98_RTY_BIT); + PC98_RST_PORT |= (1<<PC98_RST_BIT); + PC98_RDY_PORT |= (1<<PC98_RDY_BIT); + PC98_RTY_PORT |= (1<<PC98_RTY_BIT); + + DDRD |= 1<<7; + + + serial_init(); + + // PC98 reset + PC98_RST_PORT &= ~(1<<PC98_RST_BIT); + _delay_us(15); + PC98_RST_PORT |= (1<<PC98_RST_BIT); + _delay_us(13); + PC98_RDY_PORT |= (1<<PC98_RDY_BIT); + + // PC98 ready + PC98_RDY_PORT &= ~(1<<PC98_RDY_BIT); + + // initialize matrix state: all keys off + for (uint8_t i=0; i < MATRIX_ROWS; i++) matrix[i] = 0x00; + + debug("init\n"); + return; +} + +uint8_t matrix_scan(void) +{ + is_modified = false; + + uint16_t code; + PC98_RDY_PORT |= (1<<PC98_RDY_BIT); + _delay_us(30); + code = serial_recv2(); + PC98_RDY_PORT &= ~(1<<PC98_RDY_BIT); + if (code == -1) return 0; + + debug_hex(code); debug(" "); + + if (code&0x80) { + // break code + if (matrix_is_on(ROW(code), COL(code))) { + matrix[ROW(code)] &= ~(1<<COL(code)); + is_modified = true; + } + } else { + // make code + if (!matrix_is_on(ROW(code), COL(code))) { + matrix[ROW(code)] |= (1<<COL(code)); + is_modified = true; + } + } + return code; +} + +bool matrix_is_modified(void) +{ + return is_modified; +} + +inline +bool matrix_has_ghost(void) +{ + return false; +} + +inline +bool matrix_is_on(uint8_t row, uint8_t col) +{ + return (matrix[row] & (1<<col)); +} + +inline +uint8_t matrix_get_row(uint8_t row) +{ + return matrix[row]; +} + +void matrix_print(void) +{ + print("\nr/c 01234567\n"); + for (uint8_t row = 0; row < matrix_rows(); row++) { + phex(row); print(": "); + pbin_reverse(matrix_get_row(row)); + print("\n"); + } +} + +uint8_t matrix_key_count(void) +{ + uint8_t count = 0; + for (uint8_t i = 0; i < MATRIX_ROWS; i++) { + count += bitpop(matrix[i]); + } + return count; +} |