tmk
10 years ago
1 changed files with 24 additions and 33 deletions
+ 24
- 33
converter/ibm4704_usb/matrix.c
View File
| static void enable_break(void) | static void enable_break(void) | ||||
| { | { | ||||
| uint8_t ret; | uint8_t ret; | ||||
| for (uint8_t code = 0; code < 0x80; code++) { | |||||
| print("Enable break: "); | |||||
| // valid scancode: 00-77h | |||||
| for (uint8_t code = 0; code < 0x78; code++) { | |||||
| while (ibm4704_send(0x80|code) != 0) { | while (ibm4704_send(0x80|code) != 0) { | ||||
| print("z"); | print("z"); | ||||
| _delay_us(500); | |||||
| } | } | ||||
| _delay_ms(1); | |||||
| ret = ibm4704_recv(); | |||||
| if (ret!=0xFF) { | |||||
| xprintf("%0X: %0X ", code, ret); | |||||
| _delay_us(2000); | |||||
| ret = ibm4704_recv(); | |||||
| if (ret != 0xff) { | |||||
| xprintf("c%02X:r%02X ", code, ret); | |||||
| } | } | ||||
| _delay_us(1000); | |||||
| } | } | ||||
| _delay_us(100); | |||||
| _delay_us(1000); | |||||
| while (ibm4704_send(0xFF) != 0) { _delay_us(500); } // End | |||||
| print("End\n"); | print("End\n"); | ||||
| while (ibm4704_send(0xFF) != 0) { | |||||
| print("Z"); | |||||
| } // End | |||||
| } | } | ||||
| void matrix_init(void) | void matrix_init(void) | ||||
| { | { | ||||
| uint8_t ret; | |||||
| debug_enable = true; | debug_enable = true; | ||||
| ibm4704_init(); | ibm4704_init(); | ||||
| matrix_clear(); | matrix_clear(); | ||||
| xprintf("------\n"); | |||||
| // read keyboard id | |||||
| while ((ret = ibm4704_recv()) == 0xFF) { | |||||
| ibm4704_send(0xFE); | |||||
| _delay_us(100); | |||||
| } | |||||
| _delay_ms(2000); // wait for starting up debug console | |||||
| print("IBM 4704 converter\n"); | |||||
| xprintf("Keyboard ID: %02X\n", ret); | |||||
| enable_break(); | enable_break(); | ||||
| //while (ibm4704_send(0x8C) != 0) ; | |||||
| //while (ibm4704_send(0xFF) != 0) ; | |||||
| } | } | ||||
| /* | /* | ||||
| // Not receivd | // Not receivd | ||||
| return 0; | return 0; | ||||
| } else if ((code&0x78)==0x78) { | } else if ((code&0x78)==0x78) { | ||||
| // 0xFF-F8 and 0x7F-78 is not scan code | |||||
| dprintf("Error: %0X\n", code); | |||||
| // 0xFF-F8 and 0x7F-78 is not scancode | |||||
| xprintf("Error: %0X\n", code); | |||||
| matrix_clear(); | matrix_clear(); | ||||
| return 0; | return 0; | ||||
| } else if (code&0x80) { | } else if (code&0x80) { | ||||
| return 1; | return 1; | ||||
| } | } | ||||
| inline | |||||
| bool matrix_has_ghost(void) | |||||
| { | |||||
| return false; | |||||
| } | |||||
| inline | inline | ||||
| bool matrix_is_on(uint8_t row, uint8_t col) | bool matrix_is_on(uint8_t row, uint8_t col) | ||||
| { | { | ||||
| { | { | ||||
| print("\nr/c 01234567\n"); | print("\nr/c 01234567\n"); | ||||
| for (uint8_t row = 0; row < matrix_rows(); row++) { | for (uint8_t row = 0; row < matrix_rows(); row++) { | ||||
| // TODO: use new function | |||||
| 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]); | |||||
| xprintf("%02X: %08b\n", row, bitrev(matrix_get_row(row))); | |||||
| } | } | ||||
| return count; | |||||
| } | } | ||||
Loading…