|
123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323 |
- /*
- Copyright 2011 Jun Wako <[email protected]>
-
- 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/>.
- */
-
- /*
- * scan matrix
- */
- #include <stdint.h>
- #include <stdbool.h>
- #include <avr/io.h>
- #include <util/delay.h>
- #include "print.h"
- #include "util.h"
- #include "debug.h"
- #include "adb.h"
- #include "matrix.h"
- #include "report.h"
- #include "host.h"
- #include "led.h"
-
-
-
-
- static bool has_media_keys = false;
- static bool is_iso_layout = false;
- static report_mouse_t mouse_report = {};
-
- // matrix state buffer(1:on, 0:off)
- static matrix_row_t matrix[MATRIX_ROWS];
-
- static void register_key(uint8_t key);
-
-
- void matrix_init(void)
- {
- // LED on
- DDRD |= (1<<6); PORTD |= (1<<6);
-
- adb_host_init();
- // wait for keyboard to boot up and receive command
- _delay_ms(2000);
-
- // device scan
- xprintf("Before init:\n");
- for (uint8_t addr = 1; addr < 16; addr++) {
- uint16_t reg3 = adb_host_talk(addr, ADB_REG_3);
- if (reg3) {
- xprintf("Scan: addr:%d, reg3:%04X\n", addr, reg3);
- }
- _delay_ms(20);
- }
-
- // Determine ISO keyboard by handler id
- // http://lxr.free-electrons.com/source/drivers/macintosh/adbhid.c?v=4.4#L815
- uint8_t handler_id = (uint8_t) adb_host_talk(ADB_ADDR_KEYBOARD, ADB_REG_3);
- switch (handler_id) {
- case 0x04: case 0x05: case 0x07: case 0x09: case 0x0D:
- case 0x11: case 0x14: case 0x19: case 0x1D: case 0xC1:
- case 0xC4: case 0xC7:
- is_iso_layout = true;
- break;
- default:
- is_iso_layout = false;
- break;
- }
-
- // Adjustable keyboard media keys: address=0x07 and handlerID=0x02
- has_media_keys = (0x02 == (adb_host_talk(ADB_ADDR_APPLIANCE, ADB_REG_3) & 0xff));
- if (has_media_keys) {
- xprintf("Found: media keys\n");
- }
-
- // Enable keyboard left/right modifier distinction
- // Listen Register3
- // upper byte: reserved bits 0000, keyboard address 0010
- // lower byte: device handler 00000011
- adb_host_listen(ADB_ADDR_KEYBOARD, ADB_REG_3, ADB_ADDR_KEYBOARD, ADB_HANDLER_EXTENDED_PROTOCOL);
-
- // device scan
- xprintf("After init:\n");
- for (uint8_t addr = 1; addr < 16; addr++) {
- uint16_t reg3 = adb_host_talk(addr, ADB_REG_3);
- if (reg3) {
- xprintf("Scan: addr:%d, reg3:%04X\n", addr, reg3);
- }
- _delay_ms(20);
- }
-
- // initialize matrix state: all keys off
- for (uint8_t i=0; i < MATRIX_ROWS; i++) matrix[i] = 0x00;
-
- led_set(host_keyboard_leds());
-
- debug_enable = true;
- //debug_matrix = true;
- //debug_keyboard = true;
- //debug_mouse = true;
- print("debug enabled.\n");
-
- // LED off
- DDRD |= (1<<6); PORTD &= ~(1<<6);
- return;
- }
-
- #ifdef ADB_MOUSE_ENABLE
-
- #ifdef MAX
- #undef MAX
- #endif
- #define MAX(X, Y) ((X) > (Y) ? (X) : (Y))
-
- void adb_mouse_task(void)
- {
- uint16_t codes;
- int16_t x, y;
- static int8_t mouseacc;
- _delay_ms(12); // delay for preventing overload of poor ADB keyboard controller
- codes = adb_host_mouse_recv();
- // If nothing received reset mouse acceleration, and quit.
- if (!codes) {
- mouseacc = 1;
- return;
- };
- // Bit sixteen is button.
- if (~codes & (1 << 15))
- mouse_report.buttons |= MOUSE_BTN1;
- if (codes & (1 << 15))
- mouse_report.buttons &= ~MOUSE_BTN1;
- // lower seven bits are movement, as signed int_7.
- // low byte is X-axis, high byte is Y.
- y = (codes>>8 & 0x3F);
- x = (codes>>0 & 0x3F);
- // bit seven and fifteen is negative
- // usb does not use int_8, but int_7 (measuring distance) with sign-bit.
- if (codes & (1 << 6))
- x = (x-0x40);
- if (codes & (1 << 14))
- y = (y-0x40);
- // Accelerate mouse. (They weren't meant to be used on screens larger than 320x200).
- x *= mouseacc;
- y *= mouseacc;
- // Cap our two bytes per axis to one byte.
- // Easier with a MIN-function, but since -MAX(-a,-b) = MIN(a,b)...
- // I.E. MIN(MAX(x,-127),127) = -MAX(-MAX(x, -127), -127) = MIN(-MIN(-x,127),127)
- mouse_report.x = -MAX(-MAX(x, -127), -127);
- mouse_report.y = -MAX(-MAX(y, -127), -127);
- if (debug_mouse) {
- print("adb_host_mouse_recv: "); print_bin16(codes); print("\n");
- print("adb_mouse raw: [");
- phex(mouseacc); print(" ");
- phex(mouse_report.buttons); print("|");
- print_decs(mouse_report.x); print(" ");
- print_decs(mouse_report.y); print("]\n");
- }
- // Send result by usb.
- host_mouse_send(&mouse_report);
- // increase acceleration of mouse
- mouseacc += ( mouseacc < ADB_MOUSE_MAXACC ? 1 : 0 );
- return;
- }
- #endif
-
- uint8_t matrix_scan(void)
- {
- /* extra_key is volatile and more convoluted than necessary because gcc refused
- to generate valid code otherwise. Making extra_key uint8_t and constructing codes
- here via codes = extra_key<<8 | 0xFF; would consistently fail to even LOAD
- extra_key from memory, and leave garbage in the high byte of codes. I tried
- dozens of code variations and it kept generating broken assembly output. So
- beware if attempting to make extra_key code more logical and efficient. */
- static volatile uint16_t extra_key = 0xFFFF;
- uint16_t codes;
- uint8_t key0, key1;
-
- codes = extra_key;
- extra_key = 0xFFFF;
-
- if ( codes == 0xFFFF )
- {
- _delay_ms(12); // delay for preventing overload of poor ADB keyboard controller
- codes = adb_host_kbd_recv(ADB_ADDR_KEYBOARD);
-
- // Adjustable keybaord media keys
- if (codes == 0 && has_media_keys &&
- (codes = adb_host_kbd_recv(ADB_ADDR_APPLIANCE))) {
- // key1
- switch (codes & 0x7f ) {
- case 0x00: // Mic
- codes = (codes & ~0x007f) | 0x42;
- break;
- case 0x01: // Mute
- codes = (codes & ~0x007f) | 0x4a;
- break;
- case 0x02: // Volume down
- codes = (codes & ~0x007f) | 0x49;
- break;
- case 0x03: // Volume Up
- codes = (codes & ~0x007f) | 0x48;
- break;
- case 0x7F: // no code
- break;
- default:
- xprintf("ERROR: media key1\n");
- return 0x11;
- }
- // key0
- switch ((codes >> 8) & 0x7f ) {
- case 0x00: // Mic
- codes = (codes & ~0x7f00) | (0x42 << 8);
- break;
- case 0x01: // Mute
- codes = (codes & ~0x7f00) | (0x4a << 8);
- break;
- case 0x02: // Volume down
- codes = (codes & ~0x7f00) | (0x49 << 8);
- break;
- case 0x03: // Volume Up
- codes = (codes & ~0x7f00) | (0x48 << 8);
- break;
- default:
- xprintf("ERROR: media key0\n");
- return 0x10;
- }
- }
- }
- key0 = codes>>8;
- key1 = codes&0xFF;
-
- if (debug_matrix && codes) {
- print("adb_host_kbd_recv: "); phex16(codes); print("\n");
- }
-
- if (codes == 0) { // no keys
- return 0;
- } else if (codes == 0x7F7F) { // power key press
- register_key(0x7F);
- } else if (codes == 0xFFFF) { // power key release
- register_key(0xFF);
- } else if (key0 == 0xFF) { // error
- xprintf("adb_host_kbd_recv: ERROR(%d)\n", codes);
- // something wrong or plug-in
- matrix_init();
- return key1;
- } else {
- /* Swap codes for ISO keyboard
- * https://github.com/tmk/tmk_keyboard/issues/35
- *
- * ANSI
- * ,----------- ----------.
- * | *a| 1| 2 =|Backspa|
- * |----------- ----------|
- * |Tab | Q| | ]| *c|
- * |----------- ----------|
- * |CapsLo| A| '|Return |
- * |----------- ----------|
- * |Shift | Shift |
- * `----------- ----------'
- *
- * ISO
- * ,----------- ----------.
- * | *a| 1| 2 =|Backspa|
- * |----------- ----------|
- * |Tab | Q| | ]|Retur|
- * |----------- -----` |
- * |CapsLo| A| '| *c| |
- * |----------- ----------|
- * |Shif| *b| Shift |
- * `----------- ----------'
- *
- * ADB scan code USB usage
- * ------------- ---------
- * Key ANSI ISO ANSI ISO
- * ---------------------------------------------
- * *a 0x32 0x0A 0x35 0x35
- * *b ---- 0x32 ---- 0x64
- * *c 0x2A 0x2A 0x31 0x31(or 0x32)
- */
- if (is_iso_layout) {
- if ((key0 & 0x7F) == 0x32) {
- key0 = (key0 & 0x80) | 0x0A;
- } else if ((key0 & 0x7F) == 0x0A) {
- key0 = (key0 & 0x80) | 0x32;
- }
- }
- register_key(key0);
- if (key1 != 0xFF) // key1 is 0xFF when no second key.
- extra_key = key1<<8 | 0xFF; // process in a separate call
- }
-
- return 1;
- }
-
- inline
- matrix_row_t matrix_get_row(uint8_t row)
- {
- return matrix[row];
- }
-
- inline
- static void register_key(uint8_t key)
- {
- uint8_t col, row;
- col = key&0x07;
- row = (key>>3)&0x0F;
- if (key&0x80) {
- matrix[row] &= ~(1<<col);
- } else {
- matrix[row] |= (1<<col);
- }
- }
|