/* Teensyduino Core Library * http://www.pjrc.com/teensy/ * Copyright (c) 2017 PJRC.COM, LLC. * * Permission is hereby granted, free of charge, to any person obtaining * a copy of this software and associated documentation files (the * "Software"), to deal in the Software without restriction, including * without limitation the rights to use, copy, modify, merge, publish, * distribute, sublicense, and/or sell copies of the Software, and to * permit persons to whom the Software is furnished to do so, subject to * the following conditions: * * 1. The above copyright notice and this permission notice shall be * included in all copies or substantial portions of the Software. * * 2. If the Software is incorporated into a build system that allows * selection among a list of target devices, then similar target * devices manufactured by PJRC.COM must be included in the list of * target devices and selectable in the same manner. * * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE * SOFTWARE. */ #include "usb_dev.h" #include "usb_keyboard.h" #include "core_pins.h" // for yield() #include "keylayouts.h" //#include "HardwareSerial.h" #include // for memcpy() #ifdef KEYBOARD_INTERFACE // defined by usb_dev.h -> usb_desc.h #if F_CPU >= 20000000 // which modifier keys are currently pressed // 1=left ctrl, 2=left shift, 4=left alt, 8=left gui // 16=right ctrl, 32=right shift, 64=right alt, 128=right gui uint8_t keyboard_modifier_keys=0; // which keys are currently pressed, up to 6 keys may be down at once uint8_t keyboard_keys[6]={0,0,0,0,0,0}; #ifdef KEYMEDIA_INTERFACE uint16_t keymedia_consumer_keys[4]; uint8_t keymedia_system_keys[3]; #endif // protocol setting from the host. We use exactly the same report // either way, so this variable only stores the setting since we // are required to be able to report which setting is in use. uint8_t keyboard_protocol=1; // the idle configuration, how often we send the report to the // host (ms * 4) even when it hasn't changed uint8_t keyboard_idle_config=125; // count until idle timeout uint8_t keyboard_idle_count=0; // 1=num lock, 2=caps lock, 4=scroll lock, 8=compose, 16=kana volatile uint8_t keyboard_leds=0; static KEYCODE_TYPE unicode_to_keycode(uint16_t cpoint); static void write_key(KEYCODE_TYPE keycode); static uint8_t keycode_to_modifier(KEYCODE_TYPE keycode); static uint8_t keycode_to_key(KEYCODE_TYPE keycode); static void usb_keyboard_press_key(uint8_t key, uint8_t modifier); static void usb_keyboard_release_key(uint8_t key, uint8_t modifier); #ifdef DEADKEYS_MASK static KEYCODE_TYPE deadkey_to_keycode(KEYCODE_TYPE keycode); #endif #ifdef KEYMEDIA_INTERFACE static void usb_keymedia_press_consumer_key(uint16_t key); static void usb_keymedia_release_consumer_key(uint16_t key); static void usb_keymedia_press_system_key(uint8_t key); static void usb_keymedia_release_system_key(uint8_t key); static int usb_keymedia_send(void); #endif // Step #1, decode UTF8 to Unicode code points // void usb_keyboard_write(uint8_t c) { static int utf8_state=0; static uint16_t unicode_wchar=0; if (c < 0x80) { // single byte encoded, 0x00 to 0x7F utf8_state = 0; usb_keyboard_write_unicode(c); } else if (c < 0xC0) { // 2nd, 3rd or 4th byte, 0x80 to 0xBF c &= 0x3F; if (utf8_state == 1) { utf8_state = 0; usb_keyboard_write_unicode(unicode_wchar | c); } else if (utf8_state == 2) { unicode_wchar |= ((uint16_t)c << 6); utf8_state = 1; } } else if (c < 0xE0) { // begin 2 byte sequence, 0xC2 to 0xDF // or illegal 2 byte sequence, 0xC0 to 0xC1 unicode_wchar = (uint16_t)(c & 0x1F) << 6; utf8_state = 1; } else if (c < 0xF0) { // begin 3 byte sequence, 0xE0 to 0xEF unicode_wchar = (uint16_t)(c & 0x0F) << 12; utf8_state = 2; } else { // begin 4 byte sequence (not supported), 0xF0 to 0xF4 // or illegal, 0xF5 to 0xFF utf8_state = 255; } } // Step #2: translate Unicode code point to keystroke sequence // static KEYCODE_TYPE unicode_to_keycode(uint16_t cpoint) { // Unicode code points beyond U+FFFF are not supported // technically this input should probably be called UCS-2 if (cpoint < 32) { if (cpoint == 10) return KEY_ENTER & KEYCODE_MASK; if (cpoint == 11) return KEY_TAB & KEYCODE_MASK; return 0; } if (cpoint < 128) { return keycodes_ascii[cpoint - 0x20]; } #ifdef ISO_8859_1_A0 if (cpoint >= 0xA0 && cpoint < 0x100) { return keycodes_iso_8859_1[cpoint - 0xA0]; } #endif //#ifdef UNICODE_20AC //if (cpoint == 0x20AC) return UNICODE_20AC & 0x3FFF; //#endif #ifdef KEYCODE_EXTRA00 if (cpoint == UNICODE_EXTRA00) return (KEYCODE_EXTRA00) & 0x3FFF; #endif #ifdef KEYCODE_EXTRA01 if (cpoint == UNICODE_EXTRA01) return (KEYCODE_EXTRA01) & 0x3FFF; #endif #ifdef KEYCODE_EXTRA02 if (cpoint == UNICODE_EXTRA02) return (KEYCODE_EXTRA02) & 0x3FFF; #endif #ifdef KEYCODE_EXTRA03 if (cpoint == UNICODE_EXTRA03) return (KEYCODE_EXTRA03) & 0x3FFF; #endif #ifdef KEYCODE_EXTRA04 if (cpoint == UNICODE_EXTRA04) return (KEYCODE_EXTRA04) & 0x3FFF; #endif #ifdef KEYCODE_EXTRA05 if (cpoint == UNICODE_EXTRA05) return (KEYCODE_EXTRA05) & 0x3FFF; #endif #ifdef KEYCODE_EXTRA06 if (cpoint == UNICODE_EXTRA06) return (KEYCODE_EXTRA06) & 0x3FFF; #endif #ifdef KEYCODE_EXTRA07 if (cpoint == UNICODE_EXTRA07) return (KEYCODE_EXTRA07) & 0x3FFF; #endif #ifdef KEYCODE_EXTRA08 if (cpoint == UNICODE_EXTRA08) return (KEYCODE_EXTRA08) & 0x3FFF; #endif #ifdef KEYCODE_EXTRA09 if (cpoint == UNICODE_EXTRA09) return (KEYCODE_EXTRA09) & 0x3FFF; #endif #ifdef KEYCODE_EXTRA0A if (cpoint == UNICODE_EXTRA0A) return (KEYCODE_EXTRA0A) & 0x3FFF; #endif return 0; } // Step #3: execute keystroke sequence // #ifdef DEADKEYS_MASK static KEYCODE_TYPE deadkey_to_keycode(KEYCODE_TYPE keycode) { keycode &= DEADKEYS_MASK; if (keycode == 0) return 0; #ifdef ACUTE_ACCENT_BITS if (keycode == ACUTE_ACCENT_BITS) return DEADKEY_ACUTE_ACCENT; #endif #ifdef CEDILLA_BITS if (keycode == CEDILLA_BITS) return DEADKEY_CEDILLA; #endif #ifdef CIRCUMFLEX_BITS if (keycode == CIRCUMFLEX_BITS) return DEADKEY_CIRCUMFLEX; #endif #ifdef DIAERESIS_BITS if (keycode == DIAERESIS_BITS) return DEADKEY_DIAERESIS; #endif #ifdef GRAVE_ACCENT_BITS if (keycode == GRAVE_ACCENT_BITS) return DEADKEY_GRAVE_ACCENT; #endif #ifdef TILDE_BITS if (keycode == TILDE_BITS) return DEADKEY_TILDE; #endif #ifdef RING_ABOVE_BITS if (keycode == RING_ABOVE_BITS) return DEADKEY_RING_ABOVE; #endif #ifdef DEGREE_SIGN_BITS if (keycode == DEGREE_SIGN_BITS) return DEADKEY_DEGREE_SIGN; #endif #ifdef CARON_BITS if (keycode == CARON_BITS) return DEADKEY_CARON; #endif #ifdef BREVE_BITS if (keycode == BREVE_BITS) return DEADKEY_BREVE; #endif #ifdef OGONEK_BITS if (keycode == OGONEK_BITS) return DEADKEY_OGONEK; #endif #ifdef DOT_ABOVE_BITS if (keycode == DOT_ABOVE_BITS) return DEADKEY_DOT_ABOVE; #endif #ifdef DOUBLE_ACUTE_BITS if (keycode == DOUBLE_ACUTE_BITS) return DEADKEY_DOUBLE_ACUTE; #endif return 0; } #endif void usb_keyboard_write_unicode(uint16_t cpoint) { KEYCODE_TYPE keycode; keycode = unicode_to_keycode(cpoint); if (keycode) { #ifdef DEADKEYS_MASK KEYCODE_TYPE deadkeycode = deadkey_to_keycode(keycode); if (deadkeycode) write_key(deadkeycode); #endif write_key(keycode); } } // Step #4: do each keystroke // static void write_key(KEYCODE_TYPE keycode) { /* uint8_t key, modifier=0; #ifdef SHIFT_MASK if (keycode & SHIFT_MASK) modifier |= MODIFIERKEY_SHIFT; #endif #ifdef ALTGR_MASK if (keycode & ALTGR_MASK) modifier |= MODIFIERKEY_RIGHT_ALT; #endif #ifdef RCTRL_MASK if (keycode & RCTRL_MASK) modifier |= MODIFIERKEY_RIGHT_CTRL; #endif key = keycode & 0x3F; #ifdef KEY_NON_US_100 if (key == KEY_NON_US_100) key = 100; #endif usb_keyboard_press(key, modifier); */ usb_keyboard_press(keycode_to_key(keycode), keycode_to_modifier(keycode)); } static uint8_t keycode_to_modifier(KEYCODE_TYPE keycode) { uint8_t modifier=0; #ifdef SHIFT_MASK if (keycode & SHIFT_MASK) modifier |= MODIFIERKEY_SHIFT; #endif #ifdef ALTGR_MASK if (keycode & ALTGR_MASK) modifier |= MODIFIERKEY_RIGHT_ALT; #endif #ifdef RCTRL_MASK if (keycode & RCTRL_MASK) modifier |= MODIFIERKEY_RIGHT_CTRL; #endif return modifier; } static uint8_t keycode_to_key(KEYCODE_TYPE keycode) { uint8_t key = keycode & 0x3F; #ifdef KEY_NON_US_100 if (key == KEY_NON_US_100) key = 100; #endif return key; } // Input can be: // 32 - 127 ASCII direct (U+0020 to U+007F) <-- uses layout // 128 - 0xC1FF Unicode direct (U+0080 to U+C1FF) <-- uses layout // 0xC200 - 0xDFFF Unicode UTF8 packed (U+0080 to U+07FF) <-- uses layout // 0xE000 - 0xE0FF Modifier key (bitmap, 8 keys, shift/ctrl/alt/gui) // 0xE200 - 0xE2FF System key (HID usage code, within usage page 1) // 0xE400 - 0xE7FF Media/Consumer key (HID usage code, within usage page 12) // 0xF000 - 0xFFFF Normal key (HID usage code, within usage page 7) void usb_keyboard_press_keycode(uint16_t n) { uint8_t key, mod, msb, modrestore=0; KEYCODE_TYPE keycode; #ifdef DEADKEYS_MASK KEYCODE_TYPE deadkeycode; #endif msb = n >> 8; if (msb >= 0xC2) { if (msb <= 0xDF) { n = (n & 0x3F) | ((uint16_t)(msb & 0x1F) << 6); } else if (msb == 0xF0) { usb_keyboard_press_key(n, 0); return; } else if (msb == 0xE0) { usb_keyboard_press_key(0, n); return; #ifdef KEYMEDIA_INTERFACE } else if (msb == 0xE2) { usb_keymedia_press_system_key(n); return; } else if (msb >= 0xE4 && msb <= 0xE7) { usb_keymedia_press_consumer_key(n & 0x3FF); return; #endif } else { return; } } keycode = unicode_to_keycode(n); if (!keycode) return; #ifdef DEADKEYS_MASK deadkeycode = deadkey_to_keycode(keycode); if (deadkeycode) { modrestore = keyboard_modifier_keys; if (modrestore) { keyboard_modifier_keys = 0; usb_keyboard_send(); } // TODO: test if operating systems recognize // deadkey sequences when other keys are held mod = keycode_to_modifier(deadkeycode); key = keycode_to_key(deadkeycode); usb_keyboard_press_key(key, mod); usb_keyboard_release_key(key, mod); } #endif mod = keycode_to_modifier(keycode); key = keycode_to_key(keycode); usb_keyboard_press_key(key, mod | modrestore); } void usb_keyboard_release_keycode(uint16_t n) { uint8_t key, mod, msb; msb = n >> 8; if (msb >= 0xC2) { if (msb <= 0xDF) { n = (n & 0x3F) | ((uint16_t)(msb & 0x1F) << 6); } else if (msb == 0xF0) { usb_keyboard_release_key(n, 0); return; } else if (msb == 0xE0) { usb_keyboard_release_key(0, n); return; #ifdef KEYMEDIA_INTERFACE } else if (msb == 0xE2) { usb_keymedia_release_system_key(n); return; } else if (msb >= 0xE4 && msb <= 0xE7) { usb_keymedia_release_consumer_key(n & 0x3FF); return; #endif } else { return; } } KEYCODE_TYPE keycode = unicode_to_keycode(n); if (!keycode) return; mod = keycode_to_modifier(keycode); key = keycode_to_key(keycode); usb_keyboard_release_key(key, mod); } static void usb_keyboard_press_key(uint8_t key, uint8_t modifier) { int i, send_required = 0; if (modifier) { if ((keyboard_modifier_keys & modifier) != modifier) { keyboard_modifier_keys |= modifier; send_required = 1; } } if (key) { for (i=0; i < 6; i++) { if (keyboard_keys[i] == key) goto end; } for (i=0; i < 6; i++) { if (keyboard_keys[i] == 0) { keyboard_keys[i] = key; send_required = 1; goto end; } } } end: if (send_required) usb_keyboard_send(); } static void usb_keyboard_release_key(uint8_t key, uint8_t modifier) { int i, send_required = 0; if (modifier) { if ((keyboard_modifier_keys & modifier) != 0) { keyboard_modifier_keys &= ~modifier; send_required = 1; } } if (key) { for (i=0; i < 6; i++) { if (keyboard_keys[i] == key) { keyboard_keys[i] = 0; send_required = 1; } } } if (send_required) usb_keyboard_send(); } void usb_keyboard_release_all(void) { uint8_t i, anybits; anybits = keyboard_modifier_keys; keyboard_modifier_keys = 0; for (i=0; i < 6; i++) { anybits |= keyboard_keys[i]; keyboard_keys[i] = 0; } if (anybits) usb_keyboard_send(); #ifdef KEYMEDIA_INTERFACE anybits = 0; for (i=0; i < 4; i++) { if (keymedia_consumer_keys[i] != 0) anybits = 1; keymedia_consumer_keys[i] = 0; } for (i=0; i < 3; i++) { if (keymedia_system_keys[i] != 0) anybits = 1; keymedia_system_keys[i] = 0; } if (anybits) usb_keymedia_send(); #endif } int usb_keyboard_press(uint8_t key, uint8_t modifier) { int r; keyboard_modifier_keys = modifier; keyboard_keys[0] = key; keyboard_keys[1] = 0; keyboard_keys[2] = 0; keyboard_keys[3] = 0; keyboard_keys[4] = 0; keyboard_keys[5] = 0; r = usb_keyboard_send(); if (r) return r; keyboard_modifier_keys = 0; keyboard_keys[0] = 0; return usb_keyboard_send(); } // Maximum number of transmit packets to queue so we don't starve other endpoints for memory #define TX_PACKET_LIMIT 4 static uint8_t transmit_previous_timeout=0; // When the PC isn't listening, how long do we wait before discarding data? #define TX_TIMEOUT_MSEC 50 #if F_CPU == 256000000 #define TX_TIMEOUT (TX_TIMEOUT_MSEC * 1706) #elif F_CPU == 240000000 #define TX_TIMEOUT (TX_TIMEOUT_MSEC * 1600) #elif F_CPU == 216000000 #define TX_TIMEOUT (TX_TIMEOUT_MSEC * 1440) #elif F_CPU == 192000000 #define TX_TIMEOUT (TX_TIMEOUT_MSEC * 1280) #elif F_CPU == 180000000 #define TX_TIMEOUT (TX_TIMEOUT_MSEC * 1200) #elif F_CPU == 168000000 #define TX_TIMEOUT (TX_TIMEOUT_MSEC * 1100) #elif F_CPU == 144000000 #define TX_TIMEOUT (TX_TIMEOUT_MSEC * 932) #elif F_CPU == 120000000 #define TX_TIMEOUT (TX_TIMEOUT_MSEC * 764) #elif F_CPU == 96000000 #define TX_TIMEOUT (TX_TIMEOUT_MSEC * 596) #elif F_CPU == 72000000 #define TX_TIMEOUT (TX_TIMEOUT_MSEC * 512) #elif F_CPU == 48000000 #define TX_TIMEOUT (TX_TIMEOUT_MSEC * 428) #elif F_CPU == 24000000 #define TX_TIMEOUT (TX_TIMEOUT_MSEC * 262) #endif // send the contents of keyboard_keys and keyboard_modifier_keys int usb_keyboard_send(void) { #if 0 serial_print("Send:"); serial_phex(keyboard_modifier_keys); serial_phex(keyboard_keys[0]); serial_phex(keyboard_keys[1]); serial_phex(keyboard_keys[2]); serial_phex(keyboard_keys[3]); serial_phex(keyboard_keys[4]); serial_phex(keyboard_keys[5]); serial_print("\n"); #endif #if 1 uint32_t wait_count=0; usb_packet_t *tx_packet; while (1) { if (!usb_configuration) { return -1; } if (usb_tx_packet_count(KEYBOARD_ENDPOINT) < TX_PACKET_LIMIT) { tx_packet = usb_malloc(); if (tx_packet) break; } if (++wait_count > TX_TIMEOUT || transmit_previous_timeout) { transmit_previous_timeout = 1; return -1; } yield(); } *(tx_packet->buf) = keyboard_modifier_keys; *(tx_packet->buf + 1) = 0; memcpy(tx_packet->buf + 2, keyboard_keys, 6); tx_packet->len = 8; usb_tx(KEYBOARD_ENDPOINT, tx_packet); #endif return 0; } #ifdef KEYMEDIA_INTERFACE static void usb_keymedia_press_consumer_key(uint16_t key) { int i; if (key == 0) return; for (i=0; i < 4; i++) { if (keymedia_consumer_keys[i] == key) return; } for (i=0; i < 4; i++) { if (keymedia_consumer_keys[i] == 0) { keymedia_consumer_keys[i] = key; usb_keymedia_send(); return; } } } static void usb_keymedia_release_consumer_key(uint16_t key) { int i; if (key == 0) return; for (i=0; i < 4; i++) { if (keymedia_consumer_keys[i] == key) { keymedia_consumer_keys[i] = 0; usb_keymedia_send(); return; } } } static void usb_keymedia_press_system_key(uint8_t key) { int i; if (key == 0) return; for (i=0; i < 3; i++) { if (keymedia_system_keys[i] == key) return; } for (i=0; i < 3; i++) { if (keymedia_system_keys[i] == 0) { keymedia_system_keys[i] = key; usb_keymedia_send(); return; } } } static void usb_keymedia_release_system_key(uint8_t key) { int i; if (key == 0) return; for (i=0; i < 3; i++) { if (keymedia_system_keys[i] == key) { keymedia_system_keys[i] = 0; usb_keymedia_send(); return; } } } void usb_keymedia_release_all(void) { uint8_t i, anybits; anybits = 0; for (i=0; i < 4; i++) { if (keymedia_consumer_keys[i] != 0) anybits = 1; keymedia_consumer_keys[i] = 0; } for (i=0; i < 3; i++) { if (keymedia_system_keys[i] != 0) anybits = 1; keymedia_system_keys[i] = 0; } if (anybits) usb_keymedia_send(); } // send the contents of keyboard_keys and keyboard_modifier_keys static int usb_keymedia_send(void) { uint32_t wait_count=0; usb_packet_t *tx_packet; const uint16_t *consumer; while (1) { if (!usb_configuration) { return -1; } if (usb_tx_packet_count(KEYMEDIA_ENDPOINT) < TX_PACKET_LIMIT) { tx_packet = usb_malloc(); if (tx_packet) break; } if (++wait_count > TX_TIMEOUT || transmit_previous_timeout) { transmit_previous_timeout = 1; return -1; } yield(); } // 44444444 44333333 33332222 22222211 11111111 // 98765432 10987654 32109876 54321098 76543210 consumer = keymedia_consumer_keys; *(tx_packet->buf + 0) = consumer[0]; *(tx_packet->buf + 1) = (consumer[1] << 2) | ((consumer[0] >> 8) & 0x03); *(tx_packet->buf + 2) = (consumer[2] << 4) | ((consumer[1] >> 6) & 0x0F); *(tx_packet->buf + 3) = (consumer[3] << 6) | ((consumer[2] >> 4) & 0x3F); *(tx_packet->buf + 4) = consumer[3] >> 2; *(tx_packet->buf + 5) = keymedia_system_keys[0]; *(tx_packet->buf + 6) = keymedia_system_keys[1]; *(tx_packet->buf + 7) = keymedia_system_keys[2]; tx_packet->len = 8; usb_tx(KEYMEDIA_ENDPOINT, tx_packet); return 0; } #endif // KEYMEDIA_INTERFACE #endif // F_CPU #endif // KEYBOARD_INTERFACE