1 /* Copyright (C) 2014-2015 by Jacob Alexander
3 * Permission is hereby granted, free of charge, to any person obtaining a copy
4 * of this software and associated documentation files (the "Software"), to deal
5 * in the Software without restriction, including without limitation the rights
6 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
7 * copies of the Software, and to permit persons to whom the Software is
8 * furnished to do so, subject to the following conditions:
10 * The above copyright notice and this permission notice shall be included in
11 * all copies or substantial portions of the Software.
13 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
14 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
15 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
16 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
17 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
18 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
22 // ----- Includes -----
25 #include <Lib/OutputLib.h>
31 #include <scan_loop.h>
34 #if defined(_at90usb162_) || defined(_atmega32u4_) || defined(_at90usb646_) || defined(_at90usb1286_)
35 #elif defined(_mk20dx128_) || defined(_mk20dx128vlf5_) || defined(_mk20dx256_) || defined(_mk20dx256vlh7_)
36 #include <arm/uart_serial.h>
37 #include <arm/usb_dev.h>
38 #include <arm/usb_keyboard.h>
39 #include <arm/usb_serial.h>
43 #include "output_com.h"
49 // Used to build a bitmap lookup table from a byte addressable array
50 #define byteLookup( byte ) case (( byte ) * ( 8 )): bytePosition = byte; byteShift = 0; break; \
51 case (( byte ) * ( 8 ) + ( 1 )): bytePosition = byte; byteShift = 1; break; \
52 case (( byte ) * ( 8 ) + ( 2 )): bytePosition = byte; byteShift = 2; break; \
53 case (( byte ) * ( 8 ) + ( 3 )): bytePosition = byte; byteShift = 3; break; \
54 case (( byte ) * ( 8 ) + ( 4 )): bytePosition = byte; byteShift = 4; break; \
55 case (( byte ) * ( 8 ) + ( 5 )): bytePosition = byte; byteShift = 5; break; \
56 case (( byte ) * ( 8 ) + ( 6 )): bytePosition = byte; byteShift = 6; break; \
57 case (( byte ) * ( 8 ) + ( 7 )): bytePosition = byte; byteShift = 7; break
61 // ----- Function Declarations -----
63 void cliFunc_kbdProtocol( char* args );
64 void cliFunc_outputDebug( char* args );
65 void cliFunc_readLEDs ( char* args );
66 void cliFunc_readUART ( char* args );
67 void cliFunc_sendKeys ( char* args );
68 void cliFunc_sendUART ( char* args );
69 void cliFunc_setKeys ( char* args );
70 void cliFunc_setMod ( char* args );
74 // ----- Variables -----
76 // Output Module command dictionary
77 CLIDict_Entry( kbdProtocol, "Keyboard Protocol Mode: 0 - Boot, 1 - OS/NKRO Mode" );
78 CLIDict_Entry( outputDebug, "Toggle Output Debug mode." );
79 CLIDict_Entry( readLEDs, "Read LED byte:" NL "\t\t1 NumLck, 2 CapsLck, 4 ScrlLck, 16 Kana, etc." );
80 CLIDict_Entry( readUART, "Read UART buffer until empty." );
81 CLIDict_Entry( sendKeys, "Send the prepared list of USB codes and modifier byte." );
82 CLIDict_Entry( sendUART, "Send characters over UART0." );
83 CLIDict_Entry( setKeys, "Prepare a space separated list of USB codes (decimal). Waits until \033[35msendKeys\033[0m." );
84 CLIDict_Entry( setMod, "Set the modfier byte:" NL "\t\t1 LCtrl, 2 LShft, 4 LAlt, 8 LGUI, 16 RCtrl, 32 RShft, 64 RAlt, 128 RGUI" );
86 CLIDict_Def( outputCLIDict, "USB Module Commands" ) = {
87 CLIDict_Item( kbdProtocol ),
88 CLIDict_Item( outputDebug ),
89 CLIDict_Item( readLEDs ),
90 CLIDict_Item( readUART ),
91 CLIDict_Item( sendKeys ),
92 CLIDict_Item( sendUART ),
93 CLIDict_Item( setKeys ),
94 CLIDict_Item( setMod ),
95 { 0, 0, 0 } // Null entry for dictionary end
99 // Which modifier keys are currently pressed
100 // 1=left ctrl, 2=left shift, 4=left alt, 8=left gui
101 // 16=right ctrl, 32=right shift, 64=right alt, 128=right gui
102 uint8_t USBKeys_Modifiers = 0;
103 uint8_t USBKeys_ModifiersCLI = 0; // Separate CLI send buffer
105 // Currently pressed keys, max is defined by USB_MAX_KEY_SEND
106 uint8_t USBKeys_Keys [USB_NKRO_BITFIELD_SIZE_KEYS];
107 uint8_t USBKeys_KeysCLI[USB_NKRO_BITFIELD_SIZE_KEYS]; // Separate CLI send buffer
109 // System Control and Consumer Control 1KRO containers
110 uint8_t USBKeys_SysCtrl;
111 uint16_t USBKeys_ConsCtrl;
113 // The number of keys sent to the usb in the array
114 uint8_t USBKeys_Sent = 0;
115 uint8_t USBKeys_SentCLI = 0;
117 // 1=num lock, 2=caps lock, 4=scroll lock, 8=compose, 16=kana
118 volatile uint8_t USBKeys_LEDs = 0;
120 // Protocol setting from the host.
122 // 1 - NKRO Mode (Default, unless set by a BIOS or boot interface)
123 volatile uint8_t USBKeys_Protocol = 1;
125 // Indicate if USB should send update
126 // OS only needs update if there has been a change in state
127 USBKeyChangeState USBKeys_Changed = USBKeyChangeState_None;
129 // the idle configuration, how often we send the report to the
130 // host (ms * 4) even when it hasn't changed
131 uint8_t USBKeys_Idle_Config = 125;
133 // count until idle timeout
134 uint8_t USBKeys_Idle_Count = 0;
136 // Indicates whether the Output module is fully functional
137 // 0 - Not fully functional, 1 - Fully functional
138 // 0 is often used to show that a USB cable is not plugged in (but has power)
139 volatile uint8_t Output_Available = 0;
141 // Debug control variable for Output modules
142 // 0 - Debug disabled (default)
144 uint8_t Output_DebugMode = 0;
148 // ----- Capabilities -----
150 // Set Boot Keyboard Protocol
151 void Output_kbdProtocolBoot_capability( uint8_t state, uint8_t stateType, uint8_t *args )
153 // Display capability name
154 if ( stateType == 0xFF && state == 0xFF )
156 print("Output_kbdProtocolBoot()");
160 // Only set if necessary
161 if ( USBKeys_Protocol == 0 )
164 // TODO Analog inputs
165 // Only set on key press
166 if ( stateType != 0x01 )
169 // Flush the key buffers
170 Output_flushBuffers();
172 // Set the keyboard protocol to Boot Mode
173 USBKeys_Protocol = 0;
177 // Set NKRO Keyboard Protocol
178 void Output_kbdProtocolNKRO_capability( uint8_t state, uint8_t stateType, uint8_t *args )
180 // Display capability name
181 if ( stateType == 0xFF && state == 0xFF )
183 print("Output_kbdProtocolNKRO()");
187 // Only set if necessary
188 if ( USBKeys_Protocol == 1 )
191 // TODO Analog inputs
192 // Only set on key press
193 if ( stateType != 0x01 )
196 // Flush the key buffers
197 Output_flushBuffers();
199 // Set the keyboard protocol to NKRO Mode
200 USBKeys_Protocol = 1;
204 // Sends a Consumer Control code to the USB Output buffer
205 void Output_consCtrlSend_capability( uint8_t state, uint8_t stateType, uint8_t *args )
207 // Display capability name
208 if ( stateType == 0xFF && state == 0xFF )
210 print("Output_consCtrlSend(consCode)");
214 // Not implemented in Boot Mode
215 if ( USBKeys_Protocol == 0 )
217 warn_print("Consumer Control is not implemented for Boot Mode");
221 // TODO Analog inputs
222 // Only indicate USB has changed if either a press or release has occured
223 if ( state == 0x01 || state == 0x03 )
224 USBKeys_Changed |= USBKeyChangeState_Consumer;
226 // Only send keypresses if press or hold state
227 if ( stateType == 0x00 && state == 0x03 ) // Release state
229 USBKeys_ConsCtrl = 0;
233 // Set consumer control code
234 USBKeys_ConsCtrl = *(uint16_t*)(&args[0]);
238 // Ignores the given key status update
239 // Used to prevent fall-through, this is the None keyword in KLL
240 void Output_noneSend_capability( uint8_t state, uint8_t stateType, uint8_t *args )
242 // Display capability name
243 if ( stateType == 0xFF && state == 0xFF )
245 print("Output_noneSend()");
249 // Nothing to do, because that's the point :P
253 // Sends a System Control code to the USB Output buffer
254 void Output_sysCtrlSend_capability( uint8_t state, uint8_t stateType, uint8_t *args )
256 // Display capability name
257 if ( stateType == 0xFF && state == 0xFF )
259 print("Output_sysCtrlSend(sysCode)");
263 // Not implemented in Boot Mode
264 if ( USBKeys_Protocol == 0 )
266 warn_print("System Control is not implemented for Boot Mode");
270 // TODO Analog inputs
271 // Only indicate USB has changed if either a press or release has occured
272 if ( state == 0x01 || state == 0x03 )
273 USBKeys_Changed |= USBKeyChangeState_System;
275 // Only send keypresses if press or hold state
276 if ( stateType == 0x00 && state == 0x03 ) // Release state
282 // Set system control code
283 USBKeys_SysCtrl = args[0];
287 // Adds a single USB Code to the USB Output buffer
288 // Argument #1: USB Code
289 void Output_usbCodeSend_capability( uint8_t state, uint8_t stateType, uint8_t *args )
291 // Display capability name
292 if ( stateType == 0xFF && state == 0xFF )
294 print("Output_usbCodeSend(usbCode)");
298 // Depending on which mode the keyboard is in the USB needs Press/Hold/Release events
299 uint8_t keyPress = 0; // Default to key release, only used for NKRO
300 switch ( USBKeys_Protocol )
303 // TODO Analog inputs
304 // Only indicate USB has changed if either a press or release has occured
305 if ( state == 0x01 || state == 0x03 )
306 USBKeys_Changed = USBKeyChangeState_MainKeys;
308 // Only send keypresses if press or hold state
309 if ( stateType == 0x00 && state == 0x03 ) // Release state
313 // Only send press and release events
314 if ( stateType == 0x00 && state == 0x02 ) // Hold state
317 // Determine if setting or unsetting the bitfield (press == set)
318 if ( stateType == 0x00 && state == 0x01 ) // Press state
323 // Get the keycode from arguments
324 uint8_t key = args[0];
326 // Depending on which mode the keyboard is in, USBKeys_Keys array is used differently
327 // Boot mode - Maximum of 6 byte codes
328 // NKRO mode - Each bit of the 26 byte corresponds to a key
329 // Bits 0 - 45 (bytes 0 - 5) correspond to USB Codes 4 - 49 (Main)
330 // Bits 48 - 161 (bytes 6 - 20) correspond to USB Codes 51 - 164 (Secondary)
331 // Bits 168 - 213 (bytes 21 - 26) correspond to USB Codes 176 - 221 (Tertiary)
332 // Bits 214 - 216 unused
333 uint8_t bytePosition = 0;
334 uint8_t byteShift = 0;
335 switch ( USBKeys_Protocol )
338 // Set the modifier bit if this key is a modifier
339 if ( (key & 0xE0) == 0xE0 ) // AND with 0xE0 (Left Ctrl, first modifier)
341 USBKeys_Modifiers |= 1 << (key ^ 0xE0); // Left shift 1 by key XOR 0xE0
346 // USB Key limit reached
347 if ( USBKeys_Sent >= USB_BOOT_MAX_KEYS )
349 warn_print("USB Key limit reached");
353 // Make sure key is within the USB HID range
356 USBKeys_Keys[USBKeys_Sent++] = key;
361 warn_msg("USB Code above 104/0x68 in Boot Mode: ");
369 // Set the modifier bit if this key is a modifier
370 if ( (key & 0xE0) == 0xE0 ) // AND with 0xE0 (Left Ctrl, first modifier)
374 USBKeys_Modifiers |= 1 << (key ^ 0xE0); // Left shift 1 by key XOR 0xE0
378 USBKeys_Modifiers &= ~(1 << (key ^ 0xE0)); // Left shift 1 by key XOR 0xE0
381 USBKeys_Changed |= USBKeyChangeState_Modifiers;
385 else if ( key >= 4 && key <= 49 )
387 // Lookup (otherwise division or multiple checks are needed to do alignment)
388 // Starting at 0th position, each byte has 8 bits, starting at 4th bit
389 uint8_t keyPos = key + (0 * 8 - 4); // Starting position in array, Ignoring 4 keys
400 USBKeys_Changed |= USBKeyChangeState_MainKeys;
403 else if ( key >= 51 && key <= 155 )
405 // Lookup (otherwise division or multiple checks are needed to do alignment)
406 // Starting at 6th byte position, each byte has 8 bits, starting at 51st bit
407 uint8_t keyPos = key + (6 * 8 - 51); // Starting position in array
426 USBKeys_Changed |= USBKeyChangeState_SecondaryKeys;
429 else if ( key >= 157 && key <= 164 )
431 // Lookup (otherwise division or multiple checks are needed to do alignment)
432 uint8_t keyPos = key + (20 * 8 - 157); // Starting position in array, Ignoring 6 keys
438 USBKeys_Changed |= USBKeyChangeState_TertiaryKeys;
441 else if ( key >= 176 && key <= 221 )
443 // Lookup (otherwise division or multiple checks are needed to do alignment)
444 uint8_t keyPos = key + (21 * 8 - 176); // Starting position in array
455 USBKeys_Changed |= USBKeyChangeState_QuartiaryKeys;
458 // This is a special USB Code that internally indicates a "break"
459 // It is used to send "nothing" in order to break up sequences of USB Codes
460 else if ( key == 0x00 )
462 USBKeys_Changed |= USBKeyChangeState_MainKeys;
464 // Also flush out buffers just in case
465 Output_flushBuffers();
471 warn_msg("USB Code not within 4-49 (0x4-0x31), 51-155 (0x33-0x9B), 157-164 (0x9D-0xA4), 176-221 (0xB0-0xDD) or 224-231 (0xE0-0xE7) NKRO Mode: ");
480 USBKeys_Keys[bytePosition] |= (1 << byteShift);
485 USBKeys_Keys[bytePosition] &= ~(1 << byteShift);
495 // ----- Functions -----
498 void Output_flushBuffers()
500 // Zero out USBKeys_Keys array
501 for ( uint8_t c = 0; c < USB_NKRO_BITFIELD_SIZE_KEYS; c++ )
502 USBKeys_Keys[ c ] = 0;
504 // Zero out other key buffers
505 USBKeys_ConsCtrl = 0;
506 USBKeys_Modifiers = 0;
512 inline void Output_setup()
517 // Initialize the USB
518 // If a USB connection does not exist, just ignore it
519 // All usb related functions will non-fatally fail if called
520 // If the USB initialization is delayed, then functionality will just be delayed
523 // Register USB Output CLI dictionary
524 CLI_registerDictionary( outputCLIDict, outputCLIDictName );
527 Output_flushBuffers();
532 inline void Output_send()
534 // Boot Mode Only, unset stale keys
535 if ( USBKeys_Protocol == 0 )
536 for ( uint8_t c = USBKeys_Sent; c < USB_BOOT_MAX_KEYS; c++ )
539 // Send keypresses while there are pending changes
540 while ( USBKeys_Changed )
546 // Signal Scan Module we are finished
547 switch ( USBKeys_Protocol )
550 // Clear modifiers only in boot mode
551 USBKeys_Modifiers = 0;
552 Scan_finishedWithOutput( USBKeys_Sent <= USB_BOOT_MAX_KEYS ? USBKeys_Sent : USB_BOOT_MAX_KEYS );
555 Scan_finishedWithOutput( USBKeys_Sent );
561 // Sets the device into firmware reload mode
562 void Output_firmwareReload()
568 // USB Input buffer available
569 inline unsigned int Output_availablechar()
571 return usb_serial_available() + uart_serial_available();
575 // USB Get Character from input buffer
576 inline int Output_getchar()
578 // XXX Make sure to check output_availablechar() first! Information is lost with the cast (error codes) (AVR)
579 if ( usb_serial_available() > 0 )
581 return (int)usb_serial_getchar();
584 if ( uart_serial_available() > 0 )
586 return (int)uart_serial_getchar();
593 // USB Send Character to output buffer
594 inline int Output_putchar( char c )
596 // First send to UART
597 uart_serial_putchar( c );
600 return usb_serial_putchar( c );
604 // USB Send String to output buffer, null terminated
605 inline int Output_putstr( char* str )
607 #if defined(_at90usb162_) || defined(_atmega32u4_) || defined(_at90usb646_) || defined(_at90usb1286_) // AVR
609 #elif defined(_mk20dx128_) || defined(_mk20dx128vlf5_) || defined(_mk20dx256_) || defined(_mk20dx256vlh7_) // ARM
612 // Count characters until NULL character, then send the amount counted
613 while ( str[count] != '\0' )
616 // First send to UART
617 uart_serial_write( str, count );
620 return usb_serial_write( str, count );
625 inline void Output_softReset()
627 usb_device_software_reset();
631 // ----- CLI Command Functions -----
633 void cliFunc_kbdProtocol( char* args )
636 info_msg("Keyboard Protocol: ");
637 printInt8( USBKeys_Protocol );
641 void cliFunc_outputDebug( char* args )
643 // Parse number from argument
644 // NOTE: Only first argument is used
647 CLI_argumentIsolation( args, &arg1Ptr, &arg2Ptr );
649 // Default to 1 if no argument is given
650 Output_DebugMode = 1;
652 if ( arg1Ptr[0] != '\0' )
654 Output_DebugMode = (uint16_t)numToInt( arg1Ptr );
659 void cliFunc_readLEDs( char* args )
662 info_msg("LED State: ");
663 printInt8( USBKeys_LEDs );
667 void cliFunc_readUART( char* args )
671 // Read UART buffer until empty
672 while ( uart_serial_available() > 0 )
674 char out[] = { (char)uart_serial_getchar(), '\0' };
680 void cliFunc_sendKeys( char* args )
682 // Copy USBKeys_KeysCLI to USBKeys_Keys
683 for ( uint8_t key = 0; key < USBKeys_SentCLI; ++key )
686 //USBKeys_Keys[key] = USBKeys_KeysCLI[key];
688 USBKeys_Sent = USBKeys_SentCLI;
691 USBKeys_Modifiers = USBKeys_ModifiersCLI;
695 void cliFunc_sendUART( char* args )
697 // Write all args to UART
698 uart_serial_write( args, lenStr( args ) );
702 void cliFunc_setKeys( char* args )
706 char* arg2Ptr = args;
708 // Parse up to USBKeys_MaxSize args (whichever is least)
709 for ( USBKeys_SentCLI = 0; USBKeys_SentCLI < USB_BOOT_MAX_KEYS; ++USBKeys_SentCLI )
712 CLI_argumentIsolation( curArgs, &arg1Ptr, &arg2Ptr );
714 // Stop processing args if no more are found
715 if ( *arg1Ptr == '\0' )
718 // Add the USB code to be sent
720 //USBKeys_KeysCLI[USBKeys_SentCLI] = numToInt( arg1Ptr );
725 void cliFunc_setMod( char* args )
727 // Parse number from argument
728 // NOTE: Only first argument is used
731 CLI_argumentIsolation( args, &arg1Ptr, &arg2Ptr );
733 USBKeys_ModifiersCLI = numToInt( arg1Ptr );