fork/GramFirmware
git clone https://git.julia.blue/fork/GramFirmware
38b67d3
WASD_NeutralSOCD
1#include "TUKeyboard.hpp" 2 3#include <Adafruit_TinyUSB.h> 4#include <TUCompositeHID.hpp> 5 6uint8_t TUKeyboard ::_descriptor []= {TUD_HID_REPORT_DESC_KEYBOARD (HID_REPORT_ID (_report_id )) }; 7 8#define MODIFIER_MASK (mod_kc ) (1 << (mod_kc & 0x0F)) 9 10TUKeyboard ::TUKeyboard () {} 11 12void TUKeyboard ::registerDescriptor () { 13TUCompositeHID ::addDescriptor (_descriptor ,sizeof (_descriptor )); 14} 15 16void TUKeyboard ::begin () { 17TUCompositeHID ::_usb_hid .begin (); 18releaseAll (); 19} 20 21void TUKeyboard ::press (uint8_t keycode ) { 22// If keycode >= E0 then it's a modifier key. 23if (keycode >=0xE0 ) { 24// Create bitmask from the modifier keycode to set the corresponding bit in the modifier 25// byte. 26uint8_t bitmask = MODIFIER_MASK (keycode ); 27_report .modifier |=bitmask ; 28return ; 29 } 30 31// Check if the key is already pressed so that we don't send the same keycode multiple times in 32// the same report. 33for (int i = 0 ;i < 6 ;i ++ ) { 34if (_report .keycode [i ]== keycode ) { 35return ; 36 } 37 } 38 39// Place this keycode in the report in place of the first empty keycode. 40for (int i = 0 ;i < 6 ;i ++ ) { 41if (_report .keycode [i ]== HID_KEY_NONE ) { 42_report .keycode [i ]= keycode ; 43return ; 44 } 45 } 46} 47 48void TUKeyboard ::release (uint8_t keycode ) { 49// If keycode >= E0 then it's a modifier key. 50if (keycode >=0xE0 ) { 51// Create bitmask from the modifier keycode to unset the corresponding bit in the modifier 52// byte. 53uint8_t bitmask = ~MODIFIER_MASK (keycode ); 54_report .modifier &=bitmask ; 55return ; 56 } 57 58// Loop through keycodes in report. If we find the specified key code, we clear it. 59for (int i = 0 ;i < 6 ;i ++ ) { 60if (_report .keycode [i ]== keycode ) { 61_report .keycode [i ]= HID_KEY_NONE ; 62 } 63 } 64} 65 66void TUKeyboard ::setPressed (uint8_t keycode ,bool pressed ) { 67if (pressed ) { 68press (keycode ); 69 }else { 70release (keycode ); 71 } 72} 73 74void TUKeyboard ::releaseAll () { 75for (int i = 0 ;i < 6 ;i ++ ) { 76_report .keycode [i ]= 0 ; 77 } 78_report .modifier = 0 ; 79} 80 81void TUKeyboard ::sendState () { 82while (!TUCompositeHID ::_usb_hid .ready ()) { 83tight_loop_contents (); 84 } 85TUCompositeHID ::_usb_hid .sendReport (_report_id ,& _report ,sizeof (hid_keyboard_report_t )); 86}