1024 lines
No EOL
29 KiB
C++
1024 lines
No EOL
29 KiB
C++
/*
|
|
Copyright (c) 2014 NicoHood
|
|
See the readme for credit to other people.
|
|
|
|
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:
|
|
|
|
The above copyright notice and this permission notice shall be included in
|
|
all copies or substantial portions of the Software.
|
|
|
|
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 "HID.h"
|
|
|
|
//================================================================================
|
|
// HID Leonardo/Micro
|
|
//================================================================================
|
|
|
|
#if defined(USBCON)
|
|
|
|
HID_ HID;
|
|
|
|
HID_::HID_(void){
|
|
// empty
|
|
}
|
|
|
|
void HID_::begin(void){
|
|
// empty
|
|
}
|
|
|
|
void HID_::end(void){
|
|
// empty
|
|
}
|
|
|
|
void HID_::sendReport(uint8_t ReportID, const void* HIDReport, uint8_t length){
|
|
HID_SendReport(ReportID, HIDReport, length);
|
|
}
|
|
|
|
|
|
#ifdef HID_ENABLED
|
|
|
|
//================================================================================
|
|
//================================================================================
|
|
|
|
// HID report descriptor
|
|
|
|
extern const u8 _hidReportDescriptor[] PROGMEM;
|
|
const u8 _hidReportDescriptor[] = {
|
|
|
|
#ifdef HID_MOUSE_ENABLE
|
|
// Mouse
|
|
0x05, 0x01, // USAGE_PAGE (Generic Desktop) // 54
|
|
0x09, 0x02, // USAGE (Mouse)
|
|
0xa1, 0x01, // COLLECTION (Application)
|
|
0x09, 0x01, // USAGE (Pointer)
|
|
0xa1, 0x00, // COLLECTION (Physical)
|
|
0x85, HID_REPORTID_MouseReport,// REPORT_ID
|
|
// 5 buttons
|
|
0x05, 0x09, // USAGE_PAGE (Button)
|
|
0x19, 0x01, // USAGE_MINIMUM (Button 1)
|
|
0x29, 0x05, // USAGE_MAXIMUM (Button 5)
|
|
0x15, 0x00, // LOGICAL_MINIMUM (0)
|
|
0x25, 0x01, // LOGICAL_MAXIMUM (1)
|
|
0x95, 0x05, // REPORT_COUNT (5)
|
|
0x75, 0x01, // REPORT_SIZE (1)
|
|
0x81, 0x02, // INPUT (Data,Var,Abs)
|
|
// reserved
|
|
0x95, 0x01, // REPORT_COUNT (1)
|
|
0x75, 0x03, // REPORT_SIZE (3)
|
|
0x81, 0x03, // INPUT (Cnst,Var,Abs)
|
|
// x, y, wheel
|
|
0x05, 0x01, // USAGE_PAGE (Generic Desktop)
|
|
0x09, 0x30, // USAGE (X)
|
|
0x09, 0x31, // USAGE (Y)
|
|
0x09, 0x38, // USAGE (Wheel)
|
|
0x15, 0x81, // LOGICAL_MINIMUM (-127)
|
|
0x25, 0x7f, // LOGICAL_MAXIMUM (127)
|
|
0x75, 0x08, // REPORT_SIZE (8)
|
|
0x95, 0x03, // REPORT_COUNT (3)
|
|
0x81, 0x06, // INPUT (Data,Var,Rel)
|
|
// end
|
|
0xc0, // END_COLLECTION
|
|
0xc0, // END_COLLECTION
|
|
#endif
|
|
|
|
#ifdef HID_KEYBOARD_ENABLE
|
|
// Keyboard
|
|
0x05, 0x01, // USAGE_PAGE (Generic Desktop)
|
|
0x09, 0x06, // USAGE (Keyboard)
|
|
0xa1, 0x01, // COLLECTION (Application)
|
|
0x85, HID_REPORTID_KeyboardReport, // REPORT_ID
|
|
0x05, 0x07, // USAGE_PAGE (Keyboard)
|
|
// modifiers
|
|
0x19, 0xe0, // USAGE_MINIMUM (Keyboard LeftControl)
|
|
0x29, 0xe7, // USAGE_MAXIMUM (Keyboard Right GUI)
|
|
0x15, 0x00, // LOGICAL_MINIMUM (0)
|
|
0x25, 0x01, // LOGICAL_MAXIMUM (1)
|
|
0x75, 0x01, // REPORT_SIZE (1)
|
|
0x95, 0x08, // REPORT_COUNT (8)
|
|
0x81, 0x02, // INPUT (Data,Var,Abs)
|
|
// reserved byte
|
|
0x95, 0x01, // REPORT_COUNT (1)
|
|
0x75, 0x08, // REPORT_SIZE (8)
|
|
0x81, 0x03, // INPUT (Cnst,Var,Abs)
|
|
// Key[6] Array
|
|
0x95, 0x06, // REPORT_COUNT (6)
|
|
0x75, 0x08, // REPORT_SIZE (8)
|
|
0x15, 0x00, // LOGICAL_MINIMUM (0)
|
|
0x25, 0x65, // LOGICAL_MAXIMUM (101)
|
|
0x05, 0x07, // USAGE_PAGE (Keyboard)
|
|
0x19, 0x00, // USAGE_MINIMUM (Reserved (no event indicated))
|
|
0x29, 0x65, // USAGE_MAXIMUM (Keyboard Application)
|
|
0x81, 0x00, // INPUT (Data,Ary,Abs)
|
|
// LEDs for num lock etc
|
|
//0x05, 0x08, /* USAGE_PAGE (LEDs) */
|
|
//0x19, 0x01, /* USAGE_MINIMUM (Num Lock) */
|
|
//0x29, 0x05, /* USAGE_MAXIMUM (Kana) */
|
|
//0x95, 0x05, /* REPORT_COUNT (5) */
|
|
//0x75, 0x01, /* REPORT_SIZE (1) */
|
|
//0x91, 0x02, /* OUTPUT (Data,Var,Abs) */
|
|
// Reserved 3 bits
|
|
//0x95, 0x01, /* REPORT_COUNT (1) */
|
|
//0x75, 0x03, /* REPORT_SIZE (3) */
|
|
//0x91, 0x03, /* OUTPUT (Cnst,Var,Abs) */
|
|
// end
|
|
0xc0, // END_COLLECTION
|
|
#endif
|
|
|
|
#ifdef HID_RAWKEYBOARD_ENABLE
|
|
// RAW HID
|
|
0x06, LSB(RAWHID_USAGE_PAGE), MSB(RAWHID_USAGE_PAGE), // 30
|
|
0x0A, LSB(RAWHID_USAGE), MSB(RAWHID_USAGE),
|
|
|
|
0xA1, 0x01, // Collection 0x01
|
|
0x85, HID_REPORTID_RawKeyboardReport, // REPORT_ID
|
|
0x75, 0x08, // report size = 8 bits
|
|
0x15, 0x00, // logical minimum = 0
|
|
0x26, 0xFF, 0x00, // logical maximum = 255
|
|
|
|
0x95, RAWHID_TX_SIZE, // report count TX
|
|
0x09, 0x01, // usage
|
|
0x81, 0x02, // Input (array)
|
|
|
|
0x95, RAWHID_RX_SIZE, // report count RX
|
|
0x09, 0x02, // usage
|
|
0x91, 0x02, // Output (array)
|
|
0xC0, // end collection
|
|
#endif
|
|
|
|
#ifdef HID_MEDIA_ENABLE
|
|
// Media
|
|
0x05, 0x0C, // usage page (consumer device)
|
|
0x09, 0x01, // usage -- consumer control
|
|
0xA1, 0x01, // collection (application)
|
|
0x85, HID_REPORTID_MediaReport, // report id
|
|
// 4 media Keys
|
|
0x15, 0x00, //logical minimum
|
|
0x26, 0xFF, 0xFF, //logical maximum (3ff)
|
|
0x19, 0x00, // usage minimum (0)
|
|
0x2A, 0xFF, 0xFF, //usage maximum (3ff)
|
|
0x95, 0x04, //report count (4)
|
|
0x75, 0x10, //report size (16)
|
|
0x81, 0x00, //input
|
|
0xC0, //end collection
|
|
#endif
|
|
|
|
#ifdef HID_SYSTEM_ENABLE
|
|
// System
|
|
0x05, 0x01, // USAGE_PAGE (Generic Desktop)
|
|
0x09, 0x80, // USAGE (System Control)
|
|
0xa1, 0x01, // COLLECTION (Application)
|
|
0x85, HID_REPORTID_SystemReport, // REPORT_ID
|
|
// 1 system key
|
|
0x15, 0x00, // LOGICAL_MINIMUM (0)
|
|
0x26, 0xff, 0x00, // LOGICAL_MAXIMUM (255)
|
|
0x19, 0x00, // USAGE_MINIMUM (Undefined)
|
|
0x29, 0xff, // USAGE_MAXIMUM (System Menu Down)
|
|
0x95, 0x01, // REPORT_COUNT (1)
|
|
0x75, 0x08, // REPORT_SIZE (8)
|
|
0x81, 0x00, // INPUT (Data,Ary,Abs)
|
|
0xc0, // END_COLLECTION
|
|
#endif
|
|
|
|
#ifdef HID_GAMEPAD1_ENABLE
|
|
// Gamepad1
|
|
0x05, 0x01, // USAGE_PAGE (Generic Desktop)
|
|
0x09, 0x05, // USAGE (Game Pad)
|
|
0xa1, 0x01, // COLLECTION (Application)
|
|
0x85, HID_REPORTID_Gamepad1Report, // REPORT_ID
|
|
// 32 Buttons
|
|
0x05, 0x09, // USAGE_PAGE (Button)
|
|
0x19, 0x01, // USAGE_MINIMUM (Button 1)
|
|
0x29, 0x20, // USAGE_MAXIMUM (Button 32)
|
|
0x15, 0x00, // LOGICAL_MINIMUM (0)
|
|
0x25, 0x01, // LOGICAL_MAXIMUM (1)
|
|
0x75, 0x01, // REPORT_SIZE (1)
|
|
0x95, 0x20, // REPORT_COUNT (32)
|
|
0x81, 0x02, // INPUT (Data,Var,Abs)
|
|
// 6 16bit Axis
|
|
0x05, 0x01, // USAGE_PAGE (Generic Desktop)
|
|
0xa1, 0x00, // COLLECTION (Physical)
|
|
0x09, 0x30, // USAGE (X)
|
|
0x09, 0x31, // USAGE (Y)
|
|
0x09, 0x32, // USAGE (Z)
|
|
0x09, 0x33, // USAGE (Rx)
|
|
0x09, 0x34, // USAGE (Ry)
|
|
0x09, 0x35, // USAGE (Rz)
|
|
0x15, 0x00, // LOGICAL_MINIMUM (0)
|
|
0x27, 0xff, 0xff, 0x00, 0x00, // LOGICAL_MAXIMUM (65535)
|
|
0x75, 0x10, // REPORT_SIZE (16)
|
|
0x95, 0x06, // REPORT_COUNT (6)
|
|
0x81, 0x02, // INPUT (Data,Var,Abs)
|
|
0xc0, // END_COLLECTION
|
|
// 2 Hat Switches
|
|
0x05, 0x01, // USAGE_PAGE (Generic Desktop)
|
|
0x09, 0x39, // USAGE (Hat switch)
|
|
0x09, 0x39, // USAGE (Hat switch)
|
|
0x15, 0x01, // LOGICAL_MINIMUM (1)
|
|
0x25, 0x08, // LOGICAL_MAXIMUM (8)
|
|
0x95, 0x02, // REPORT_COUNT (2)
|
|
0x75, 0x04, // REPORT_SIZE (4)
|
|
0x81, 0x02, // INPUT (Data,Var,Abs)
|
|
// 8bit Throttle + Rudder
|
|
//0x05, 0x02, // USAGE_PAGE (Simulation Controls)
|
|
//0xa1, 0x00, // COLLECTION (Physical)
|
|
//0x15, 0x00, // LOGICAL_MINIMUM (0)
|
|
//0x26, 0xff, 0x00, // LOGICAL_MAXIMUM (255)
|
|
//0x09, 0xbb, // USAGE (Throttle)
|
|
//0x09, 0xba, // USAGE (Rudder)
|
|
//0x75, 0x08, // REPORT_SIZE (8)
|
|
//0x95, 0x02, // REPORT_COUNT (2)
|
|
//0x81, 0x02, // INPUT (Data,Var,Abs)
|
|
//0xc0, // END_COLLECTION
|
|
0xc0, // END_COLLECTION
|
|
#endif
|
|
|
|
#ifdef HID_GAMEPAD2_ENABLE
|
|
// Gamepad2
|
|
0x05, 0x01, // USAGE_PAGE (Generic Desktop)
|
|
0x09, 0x05, // USAGE (Game Pad)
|
|
0xa1, 0x01, // COLLECTION (Application)
|
|
0x85, HID_REPORTID_Gamepad2Report, // REPORT_ID
|
|
// 32 Buttons
|
|
0x05, 0x09, // USAGE_PAGE (Button)
|
|
0x19, 0x01, // USAGE_MINIMUM (Button 1)
|
|
0x29, 0x20, // USAGE_MAXIMUM (Button 32)
|
|
0x15, 0x00, // LOGICAL_MINIMUM (0)
|
|
0x25, 0x01, // LOGICAL_MAXIMUM (1)
|
|
0x75, 0x01, // REPORT_SIZE (1)
|
|
0x95, 0x20, // REPORT_COUNT (32)
|
|
0x81, 0x02, // INPUT (Data,Var,Abs)
|
|
// 6 16bit Axis
|
|
0x05, 0x01, // USAGE_PAGE (Generic Desktop)
|
|
0xa1, 0x00, // COLLECTION (Physical)
|
|
0x09, 0x30, // USAGE (X)
|
|
0x09, 0x31, // USAGE (Y)
|
|
0x09, 0x32, // USAGE (Z)
|
|
0x09, 0x33, // USAGE (Rx)
|
|
0x09, 0x34, // USAGE (Ry)
|
|
0x09, 0x35, // USAGE (Rz)
|
|
0x15, 0x00, // LOGICAL_MINIMUM (0)
|
|
0x27, 0xff, 0xff, 0x00, 0x00, // LOGICAL_MAXIMUM (65535)
|
|
0x75, 0x10, // REPORT_SIZE (16)
|
|
0x95, 0x06, // REPORT_COUNT (6)
|
|
0x81, 0x02, // INPUT (Data,Var,Abs)
|
|
0xc0, // END_COLLECTION
|
|
// 2 Hat Switches
|
|
0x09, 0x39, // USAGE (Hat switch)
|
|
0x09, 0x39, // USAGE (Hat switch)
|
|
0x15, 0x01, // LOGICAL_MINIMUM (1)
|
|
0x25, 0x08, // LOGICAL_MAXIMUM (8)
|
|
0x95, 0x02, // REPORT_COUNT (2)
|
|
0x75, 0x04, // REPORT_SIZE (4)
|
|
0x81, 0x02, // INPUT (Data,Var,Abs)
|
|
// 8bit Throttle + Rudder
|
|
//0x05, 0x02, // USAGE_PAGE (Simulation Controls)
|
|
//0xa1, 0x00, // COLLECTION (Physical)
|
|
//0x15, 0x00, // LOGICAL_MINIMUM (0)
|
|
//0x26, 0xff, 0x00, // LOGICAL_MAXIMUM (255)
|
|
//0x09, 0xbb, // USAGE (Throttle)
|
|
//0x09, 0xba, // USAGE (Rudder)
|
|
//0x75, 0x08, // REPORT_SIZE (8)
|
|
//0x95, 0x02, // REPORT_COUNT (2)
|
|
//0x81, 0x02, // INPUT (Data,Var,Abs)
|
|
//0xc0, // END_COLLECTION
|
|
0xc0, // END_COLLECTION
|
|
#endif
|
|
|
|
#ifdef HID_JOYSTICK1_ENABLE
|
|
// Joystick1
|
|
0x05, 0x01, // USAGE_PAGE (Generic Desktop)
|
|
0x09, 0x04, // USAGE (Joystick)
|
|
0xa1, 0x01, // COLLECTION (Application)
|
|
0x85, HID_REPORTID_Joystick1Report, // REPORT_ID
|
|
0xa1, 0x00, // COLLECTION (Physical)
|
|
0x05, 0x09, // USAGE_PAGE (Button)
|
|
0x19, 0x01, // USAGE_MINIMUM (Button 1)
|
|
0x29, 0x02, // USAGE_MAXIMUM (Button 2)
|
|
0x15, 0x00, // LOGICAL_MINIMUM (0)
|
|
0x25, 0x01, // LOGICAL_MAXIMUM (1)
|
|
0x75, 0x01, // REPORT_SIZE (1)
|
|
0x95, 0x02, // REPORT_COUNT (2)
|
|
0x81, 0x02, // INPUT (Data,Var,Abs)
|
|
0x05, 0x01, // USAGE_PAGE (Generic Desktop)
|
|
0x09, 0x30, // USAGE (X)
|
|
0x09, 0x31, // USAGE (Y)
|
|
0x15, 0x00, // LOGICAL_MINIMUM (0)
|
|
0x26, 0xff, 0x03, // LOGICAL_MAXIMUM (1023)
|
|
0x75, 0x0a, // REPORT_SIZE (10)
|
|
0x95, 0x02, // REPORT_COUNT (2)
|
|
0x81, 0x02, // INPUT (Data,Var,Abs)
|
|
0x75, 0x02, // REPORT_SIZE (2)
|
|
0x95, 0x01, // REPORT_COUNT (1)
|
|
0x81, 0x03, // INPUT (Cnst,Var,Abs)
|
|
0xc0, // END_COLLECTION
|
|
0xc0, // END_COLLECTION
|
|
#endif
|
|
|
|
#ifdef HID_JOYSTICK2_ENABLE
|
|
// Joystick2
|
|
0x05, 0x01, // USAGE_PAGE (Generic Desktop)
|
|
0x09, 0x04, // USAGE (Joystick)
|
|
0xa1, 0x01, // COLLECTION (Application)
|
|
0x85, HID_REPORTID_Joystick2Report, // REPORT_ID
|
|
0xa1, 0x00, // COLLECTION (Physical)
|
|
0x05, 0x09, // USAGE_PAGE (Button)
|
|
0x19, 0x01, // USAGE_MINIMUM (Button 1)
|
|
0x29, 0x02, // USAGE_MAXIMUM (Button 2)
|
|
0x15, 0x00, // LOGICAL_MINIMUM (0)
|
|
0x25, 0x01, // LOGICAL_MAXIMUM (1)
|
|
0x75, 0x01, // REPORT_SIZE (1)
|
|
0x95, 0x02, // REPORT_COUNT (2)
|
|
0x81, 0x02, // INPUT (Data,Var,Abs)
|
|
0x05, 0x01, // USAGE_PAGE (Generic Desktop)
|
|
0x09, 0x30, // USAGE (X)
|
|
0x09, 0x31, // USAGE (Y)
|
|
0x15, 0x00, // LOGICAL_MINIMUM (0)
|
|
0x26, 0xff, 0x03, // LOGICAL_MAXIMUM (1023)
|
|
0x75, 0x0a, // REPORT_SIZE (10)
|
|
0x95, 0x02, // REPORT_COUNT (2)
|
|
0x81, 0x02, // INPUT (Data,Var,Abs)
|
|
0x75, 0x02, // REPORT_SIZE (2)
|
|
0x95, 0x01, // REPORT_COUNT (1)
|
|
0x81, 0x03, // INPUT (Cnst,Var,Abs)
|
|
0xc0, // END_COLLECTION
|
|
0xc0 // END_COLLECTION
|
|
#endif
|
|
};
|
|
|
|
extern const HIDDescriptor _hidInterface PROGMEM;
|
|
const HIDDescriptor _hidInterface =
|
|
{
|
|
D_INTERFACE(HID_INTERFACE, 1, 3, 0, 0),
|
|
D_HIDREPORT(sizeof(_hidReportDescriptor)),
|
|
D_ENDPOINT(USB_ENDPOINT_IN(HID_ENDPOINT_INT), USB_ENDPOINT_TYPE_INTERRUPT, 0x40, 0x01)
|
|
};
|
|
|
|
//================================================================================
|
|
//================================================================================
|
|
// Driver
|
|
|
|
u8 _hid_protocol = 1;
|
|
u8 _hid_idle = 1;
|
|
|
|
#define WEAK __attribute__ ((weak))
|
|
|
|
int WEAK HID_GetInterface(u8* interfaceNum)
|
|
{
|
|
interfaceNum[0] += 1; // uses 1
|
|
return USB_SendControl(TRANSFER_PGM, &_hidInterface, sizeof(_hidInterface));
|
|
}
|
|
|
|
int WEAK HID_GetDescriptor(int /* i */)
|
|
{
|
|
return USB_SendControl(TRANSFER_PGM, _hidReportDescriptor, sizeof(_hidReportDescriptor));
|
|
}
|
|
|
|
void WEAK HID_SendReport(u8 id, const void* data, int len)
|
|
{
|
|
USB_Send(HID_TX, &id, 1);
|
|
USB_Send(HID_TX | TRANSFER_RELEASE, data, len);
|
|
}
|
|
|
|
bool WEAK HID_Setup(Setup& setup)
|
|
{
|
|
u8 r = setup.bRequest;
|
|
u8 requestType = setup.bmRequestType;
|
|
if (REQUEST_DEVICETOHOST_CLASS_INTERFACE == requestType)
|
|
{
|
|
if (HID_GET_REPORT == r)
|
|
{
|
|
//HID_GetReport();
|
|
return true;
|
|
}
|
|
if (HID_GET_PROTOCOL == r)
|
|
{
|
|
//Send8(_hid_protocol); // TODO
|
|
return true;
|
|
}
|
|
}
|
|
|
|
if (REQUEST_HOSTTODEVICE_CLASS_INTERFACE == requestType)
|
|
{
|
|
if (HID_SET_PROTOCOL == r)
|
|
{
|
|
_hid_protocol = setup.wValueL;
|
|
return true;
|
|
}
|
|
|
|
if (HID_SET_IDLE == r)
|
|
{
|
|
_hid_idle = setup.wValueL;
|
|
return true;
|
|
}
|
|
}
|
|
return false;
|
|
}
|
|
|
|
#endif
|
|
|
|
//================================================================================
|
|
// HID Uno/Mega
|
|
//================================================================================
|
|
|
|
#else /* if defined(USBCON) */
|
|
|
|
HID_ HID;
|
|
|
|
HID_::HID_(void){
|
|
// empty
|
|
}
|
|
|
|
void HID_::begin(void){
|
|
HID_SERIAL.begin(115200);
|
|
}
|
|
|
|
void HID_::end(void){
|
|
HID_SERIAL.end();
|
|
}
|
|
|
|
void HID_::sendReport(uint8_t ReportID, const void* HIDReport, uint8_t length){
|
|
// write the Report via Protocol and checksum. 16bit for each sending
|
|
// send control address
|
|
NHPwriteChecksum(NHP_ADDRESS_CONTROL, (NHP_USAGE_ARDUINOHID << 8) | ReportID);
|
|
const uint8_t* report = (const uint8_t*)HIDReport;
|
|
for (int i = 0; i < length; i++){
|
|
uint8_t data0 = report[i++];
|
|
uint8_t data1 = 0;
|
|
if (i != length)
|
|
data1 = report[i];
|
|
// valid HID reports start at Address 2
|
|
NHPwriteChecksum(2 + i / 2, (data1 << 8) | data0);
|
|
}
|
|
}
|
|
#endif /* if defined(USBCON) */
|
|
|
|
// simple copy/modification of the NicoHoodProtocol writechecksum function
|
|
void HID_::NHPwriteChecksum(uint8_t address, uint16_t indata){
|
|
// writes two bytes with its inverse
|
|
uint32_t temp = ~indata;
|
|
uint32_t data = (temp << 16) | indata;
|
|
|
|
// buffer for write operation
|
|
uint8_t writebuffer[6];
|
|
|
|
// start with the maximum size of blocks
|
|
uint8_t blocks = 7;
|
|
|
|
// check for the first 7 bit block that doesnt fit into the first 3 bits
|
|
while (blocks > 2){
|
|
uint8_t nextvalue = (data >> (7 * (blocks - 3)));
|
|
|
|
if (nextvalue > NHP_MASK_DATA_3BIT){
|
|
// special case for the MSB
|
|
if (blocks == 7) {
|
|
writebuffer[0] = nextvalue;
|
|
blocks--;
|
|
}
|
|
// this block is too big, write this into the next data block
|
|
break;
|
|
}
|
|
else{
|
|
// write the possible first 3 bits and check again after if zero
|
|
writebuffer[0] = nextvalue;
|
|
blocks--;
|
|
// we have our first bits, stop (nonzero)
|
|
if (nextvalue)
|
|
break;
|
|
}
|
|
}
|
|
|
|
// write the rest of the data bits
|
|
uint8_t datablocks = blocks - 2;
|
|
while (datablocks > 0){
|
|
writebuffer[datablocks] = data & NHP_MASK_DATA_7BIT;
|
|
data >>= 7;
|
|
datablocks--;
|
|
}
|
|
|
|
// write lead + length mask
|
|
writebuffer[0] |= NHP_MASK_LEAD | (blocks << 3);
|
|
|
|
// write end mask
|
|
writebuffer[blocks - 1] = NHP_MASK_END | ((address - 1) & NHP_MASK_ADDRESS);
|
|
|
|
// write the buffer
|
|
HID_SERIAL.write(writebuffer, blocks);
|
|
}
|
|
|
|
//================================================================================
|
|
// Mouse
|
|
//================================================================================
|
|
|
|
Mouse_ Mouse;
|
|
|
|
Mouse_::Mouse_(void){
|
|
// empty
|
|
}
|
|
|
|
void Mouse_::begin(void){
|
|
memset(&_report, 0, sizeof(_report));
|
|
HID.sendReport(HID_REPORTID_MouseReport, &_report, sizeof(_report));
|
|
}
|
|
|
|
void Mouse_::end(void){
|
|
begin();
|
|
}
|
|
|
|
void Mouse_::click(uint8_t b){
|
|
_report.buttons = b;
|
|
move(0, 0, 0);
|
|
_report.buttons = 0;
|
|
move(0, 0, 0);
|
|
}
|
|
|
|
void Mouse_::move(signed char x, signed char y, signed char wheel){
|
|
_report.xAxis = x;
|
|
_report.yAxis = y;
|
|
_report.wheel = wheel;
|
|
HID.sendReport(HID_REPORTID_MouseReport, &_report, sizeof(HID_MouseReport_Data_t));
|
|
}
|
|
|
|
void Mouse_::buttons(uint8_t b){
|
|
if (b != _report.buttons) {
|
|
_report.buttons = b;
|
|
move(0, 0, 0);
|
|
}
|
|
}
|
|
|
|
void Mouse_::press(uint8_t b){
|
|
buttons(_report.buttons | b);
|
|
}
|
|
|
|
void Mouse_::release(uint8_t b){
|
|
buttons(_report.buttons & ~b);
|
|
}
|
|
|
|
void Mouse_::releaseAll(void){
|
|
begin();
|
|
}
|
|
|
|
bool Mouse_::isPressed(uint8_t b){
|
|
if ((b & _report.buttons) > 0)
|
|
return true;
|
|
return false;
|
|
}
|
|
|
|
//================================================================================
|
|
// Keyboard
|
|
//================================================================================
|
|
|
|
Keyboard_ Keyboard;
|
|
|
|
Keyboard_::Keyboard_(void){
|
|
// empty
|
|
}
|
|
|
|
void Keyboard_::begin(void){
|
|
memset(&_report, 0, sizeof(_report));
|
|
HID.sendReport(HID_REPORTID_KeyboardReport, &_report, sizeof(_report));
|
|
}
|
|
|
|
void Keyboard_::end(void){
|
|
begin();
|
|
}
|
|
|
|
extern
|
|
const uint8_t _asciimap[128] PROGMEM;
|
|
|
|
#define SHIFT 0x80
|
|
const uint8_t _asciimap[128] =
|
|
{
|
|
0x00, // NUL
|
|
0x00, // SOH
|
|
0x00, // STX
|
|
0x00, // ETX
|
|
0x00, // EOT
|
|
0x00, // ENQ
|
|
0x00, // ACK
|
|
0x00, // BEL
|
|
0x2a, // BS Backspace
|
|
0x2b, // TAB Tab
|
|
0x28, // LF Enter
|
|
0x00, // VT
|
|
0x00, // FF
|
|
0x00, // CR
|
|
0x00, // SO
|
|
0x00, // SI
|
|
0x00, // DEL
|
|
0x00, // DC1
|
|
0x00, // DC2
|
|
0x00, // DC3
|
|
0x00, // DC4
|
|
0x00, // NAK
|
|
0x00, // SYN
|
|
0x00, // ETB
|
|
0x00, // CAN
|
|
0x00, // EM
|
|
0x00, // SUB
|
|
0x00, // ESC
|
|
0x00, // FS
|
|
0x00, // GS
|
|
0x00, // RS
|
|
0x00, // US
|
|
|
|
0x2c, // ' '
|
|
0x1e | SHIFT, // !
|
|
0x34 | SHIFT, // "
|
|
0x20 | SHIFT, // #
|
|
0x21 | SHIFT, // $
|
|
0x22 | SHIFT, // %
|
|
0x24 | SHIFT, // &
|
|
0x34, // '
|
|
0x26 | SHIFT, // (
|
|
0x27 | SHIFT, // )
|
|
0x25 | SHIFT, // *
|
|
0x2e | SHIFT, // +
|
|
0x36, // ,
|
|
0x2d, // -
|
|
0x37, // .
|
|
0x38, // /
|
|
0x27, // 0
|
|
0x1e, // 1
|
|
0x1f, // 2
|
|
0x20, // 3
|
|
0x21, // 4
|
|
0x22, // 5
|
|
0x23, // 6
|
|
0x24, // 7
|
|
0x25, // 8
|
|
0x26, // 9
|
|
0x33 | SHIFT, // :
|
|
0x33, // ;
|
|
0x36 | SHIFT, // <
|
|
0x2e, // =
|
|
0x37 | SHIFT, // >
|
|
0x38 | SHIFT, // ?
|
|
0x1f | SHIFT, // @
|
|
0x04 | SHIFT, // A
|
|
0x05 | SHIFT, // B
|
|
0x06 | SHIFT, // C
|
|
0x07 | SHIFT, // D
|
|
0x08 | SHIFT, // E
|
|
0x09 | SHIFT, // F
|
|
0x0a | SHIFT, // G
|
|
0x0b | SHIFT, // H
|
|
0x0c | SHIFT, // I
|
|
0x0d | SHIFT, // J
|
|
0x0e | SHIFT, // K
|
|
0x0f | SHIFT, // L
|
|
0x10 | SHIFT, // M
|
|
0x11 | SHIFT, // N
|
|
0x12 | SHIFT, // O
|
|
0x13 | SHIFT, // P
|
|
0x14 | SHIFT, // Q
|
|
0x15 | SHIFT, // R
|
|
0x16 | SHIFT, // S
|
|
0x17 | SHIFT, // T
|
|
0x18 | SHIFT, // U
|
|
0x19 | SHIFT, // V
|
|
0x1a | SHIFT, // W
|
|
0x1b | SHIFT, // X
|
|
0x1c | SHIFT, // Y
|
|
0x1d | SHIFT, // Z
|
|
0x2f, // [
|
|
0x31, // bslash
|
|
0x30, // ]
|
|
0x23 | SHIFT, // ^
|
|
0x2d | SHIFT, // _
|
|
0x35, // `
|
|
0x04, // a
|
|
0x05, // b
|
|
0x06, // c
|
|
0x07, // d
|
|
0x08, // e
|
|
0x09, // f
|
|
0x0a, // g
|
|
0x0b, // h
|
|
0x0c, // i
|
|
0x0d, // j
|
|
0x0e, // k
|
|
0x0f, // l
|
|
0x10, // m
|
|
0x11, // n
|
|
0x12, // o
|
|
0x13, // p
|
|
0x14, // q
|
|
0x15, // r
|
|
0x16, // s
|
|
0x17, // t
|
|
0x18, // u
|
|
0x19, // v
|
|
0x1a, // w
|
|
0x1b, // x
|
|
0x1c, // y
|
|
0x1d, // z
|
|
0x2f | SHIFT, //
|
|
0x31 | SHIFT, // |
|
|
0x30 | SHIFT, // }
|
|
0x35 | SHIFT, // ~
|
|
0 // DEL
|
|
};
|
|
|
|
// removed <--
|
|
//uint8_t USBPutChar(uint8_t c);
|
|
|
|
size_t Keyboard_::write(uint8_t c)
|
|
{
|
|
uint8_t p = press(c); // Keydown
|
|
//uint8_t r =
|
|
release(c); // Keyup
|
|
return (p); // just return the result of press() since release() almost always returns 1
|
|
}
|
|
|
|
// press() adds the specified key (printing, non-printing, or modifier)
|
|
// to the persistent key report and sends the report. Because of the way
|
|
// USB HID works, the host acts like the key remains pressed until we
|
|
// call release(), releaseAll(), or otherwise clear the report and resend.
|
|
size_t Keyboard_::press(uint8_t k)
|
|
{
|
|
uint8_t i;
|
|
if (k >= 136) { // it's a non-printing key (not a modifier)
|
|
k = k - 136;
|
|
}
|
|
else if (k >= 128) { // it's a modifier key
|
|
_report.modifiers |= (1 << (k - 128));
|
|
k = 0;
|
|
}
|
|
else { // it's a printing key
|
|
k = pgm_read_byte(_asciimap + k);
|
|
if (!k) {
|
|
setWriteError();
|
|
return 0;
|
|
}
|
|
if (k & 0x80) { // it's a capital letter or other character reached with shift
|
|
_report.modifiers |= 0x02; // the left shift modifier
|
|
k &= 0x7F;
|
|
}
|
|
}
|
|
|
|
// Add k to the key report only if it's not already present
|
|
// and if there is an empty slot.
|
|
if (_report.keys[0] != k && _report.keys[1] != k &&
|
|
_report.keys[2] != k && _report.keys[3] != k &&
|
|
_report.keys[4] != k && _report.keys[5] != k) {
|
|
|
|
for (i = 0; i < 6; i++) {
|
|
if (_report.keys[i] == 0x00) {
|
|
_report.keys[i] = k;
|
|
break;
|
|
}
|
|
}
|
|
if (i == 6) {
|
|
setWriteError();
|
|
return 0;
|
|
}
|
|
}
|
|
HID.sendReport(HID_REPORTID_KeyboardReport, &_report, sizeof(_report));
|
|
return 1;
|
|
}
|
|
|
|
// release() takes the specified key out of the persistent key report and
|
|
// sends the report. This tells the OS the key is no longer pressed and that
|
|
// it shouldn't be repeated any more.
|
|
size_t Keyboard_::release(uint8_t k)
|
|
{
|
|
uint8_t i;
|
|
if (k >= 136) { // it's a non-printing key (not a modifier)
|
|
k = k - 136;
|
|
}
|
|
else if (k >= 128) { // it's a modifier key
|
|
_report.modifiers &= ~(1 << (k - 128));
|
|
k = 0;
|
|
}
|
|
else { // it's a printing key
|
|
k = pgm_read_byte(_asciimap + k);
|
|
if (!k) {
|
|
return 0;
|
|
}
|
|
if (k & 0x80) { // it's a capital letter or other character reached with shift
|
|
_report.modifiers &= ~(0x02); // the left shift modifier
|
|
k &= 0x7F;
|
|
}
|
|
}
|
|
|
|
// Test the key report to see if k is present. Clear it if it exists.
|
|
// Check all positions in case the key is present more than once (which it shouldn't be)
|
|
for (i = 0; i < 6; i++) {
|
|
if (0 != k && _report.keys[i] == k) {
|
|
_report.keys[i] = 0x00;
|
|
}
|
|
}
|
|
|
|
HID.sendReport(HID_REPORTID_KeyboardReport, &_report, sizeof(_report));
|
|
return 1;
|
|
}
|
|
|
|
void Keyboard_::releaseAll(void){
|
|
begin();
|
|
}
|
|
|
|
//================================================================================
|
|
// RawHID
|
|
//================================================================================
|
|
|
|
RawHID_ RawHID;
|
|
|
|
RawHID_::RawHID_(void){
|
|
// empty
|
|
}
|
|
|
|
size_t RawHID_::write(uint8_t b){
|
|
write(&b, 1);
|
|
}
|
|
|
|
size_t RawHID_::write(const uint8_t *buffer, size_t size){
|
|
size_t bytesleft = size;
|
|
// first work through the buffer thats already there
|
|
while (bytesleft >= RAWHID_RX_SIZE){
|
|
HID.sendReport(HID_REPORTID_RawKeyboardReport, &buffer[size - bytesleft], RAWHID_RX_SIZE);
|
|
bytesleft -= RAWHID_RX_SIZE;
|
|
}
|
|
// write down the other bytes and fill with zeros
|
|
if (bytesleft){
|
|
uint8_t rest[RAWHID_RX_SIZE];
|
|
memcpy(rest, &buffer[size - bytesleft], bytesleft);
|
|
memset(&rest[bytesleft], 0, RAWHID_RX_SIZE - bytesleft);
|
|
HID.sendReport(HID_REPORTID_RawKeyboardReport, &rest, RAWHID_RX_SIZE);
|
|
}
|
|
}
|
|
|
|
//================================================================================
|
|
// Media
|
|
//================================================================================
|
|
|
|
Media_ Media;
|
|
|
|
Media_::Media_(void){
|
|
// empty
|
|
}
|
|
|
|
void Media_::begin(void){
|
|
memset(&_report, 0, sizeof(_report));
|
|
HID.sendReport(HID_REPORTID_MediaReport, &_report, sizeof(_report));
|
|
}
|
|
|
|
void Media_::end(void){
|
|
begin();
|
|
}
|
|
|
|
void Media_::write(uint16_t m){
|
|
press(m);
|
|
release(m);
|
|
}
|
|
|
|
void Media_::press(uint16_t m){
|
|
// search for a free spot
|
|
for (int i = 0; i < sizeof(HID_MediaReport_Data_t) / 2; i++) {
|
|
if (_report.whole16[i] == 0x00) {
|
|
_report.whole16[i] = m;
|
|
break;
|
|
}
|
|
}
|
|
HID.sendReport(HID_REPORTID_MediaReport, &_report, sizeof(_report));
|
|
}
|
|
|
|
void Media_::release(uint16_t m){
|
|
// search and release the keypress
|
|
for (int i = 0; i < sizeof(HID_MediaReport_Data_t) / 2; i++) {
|
|
if (_report.whole16[i] == m) {
|
|
_report.whole16[i] = 0x00;
|
|
// no break to delete multiple keys
|
|
}
|
|
}
|
|
HID.sendReport(HID_REPORTID_MediaReport, &_report, sizeof(_report));
|
|
}
|
|
|
|
void Media_::releaseAll(void){
|
|
begin();
|
|
}
|
|
|
|
//================================================================================
|
|
// System
|
|
//================================================================================
|
|
|
|
System_ System;
|
|
|
|
System_::System_(void){
|
|
// empty
|
|
}
|
|
|
|
void System_::begin(void){
|
|
uint8_t _report = 0;
|
|
HID.sendReport(HID_REPORTID_SystemReport, &_report, sizeof(_report));
|
|
}
|
|
|
|
void System_::end(void){
|
|
begin();
|
|
}
|
|
|
|
void System_::write(uint8_t s){
|
|
press(s);
|
|
release();
|
|
}
|
|
|
|
void System_::press(uint8_t s){
|
|
HID.sendReport(HID_REPORTID_SystemReport, &s, sizeof(s));
|
|
}
|
|
|
|
void System_::release(void){
|
|
begin();
|
|
}
|
|
|
|
void System_::releaseAll(void){
|
|
begin();
|
|
}
|
|
|
|
//================================================================================
|
|
// Gamepad
|
|
//================================================================================
|
|
|
|
Gamepad_ Gamepad1(HID_REPORTID_Gamepad1Report);
|
|
Gamepad_ Gamepad2(HID_REPORTID_Gamepad2Report);
|
|
|
|
Gamepad_::Gamepad_(uint8_t reportID){
|
|
_reportID = reportID;
|
|
// empty
|
|
}
|
|
|
|
void Gamepad_::begin(void){
|
|
memset(&_report, 0, sizeof(_report));
|
|
HID.sendReport(_reportID, &_report, sizeof(_report));
|
|
}
|
|
|
|
void Gamepad_::end(void){
|
|
begin();
|
|
}
|
|
|
|
void Gamepad_::write(void){
|
|
HID.sendReport(_reportID, &_report, sizeof(_report));
|
|
}
|
|
|
|
void Gamepad_::press(uint8_t b){
|
|
_report.buttons |= (uint32_t)1 << (b - 1);
|
|
}
|
|
|
|
void Gamepad_::release(uint8_t b){
|
|
_report.buttons &= ~((uint32_t)1 << (b - 1));
|
|
}
|
|
|
|
void Gamepad_::releaseAll(void){
|
|
_report.buttons = 0;
|
|
}
|
|
|
|
//================================================================================
|
|
// Joystick
|
|
//================================================================================
|
|
|
|
Joystick_ Joystick1(HID_REPORTID_Joystick1Report);
|
|
Joystick_ Joystick2(HID_REPORTID_Joystick2Report);
|
|
|
|
Joystick_::Joystick_(uint8_t reportID){
|
|
_reportID = reportID;
|
|
// empty
|
|
}
|
|
|
|
void Joystick_::begin(void){
|
|
memset(&_report, 0, sizeof(_report));
|
|
HID.sendReport(_reportID, &_report, sizeof(_report));
|
|
}
|
|
|
|
void Joystick_::end(void){
|
|
begin();
|
|
}
|
|
|
|
void Joystick_::write(void){
|
|
HID.sendReport(_reportID, &_report, sizeof(_report));;
|
|
}
|
|
|
|
void Joystick_::press(uint8_t b){
|
|
if (b == 1) _report.button1 = 1;
|
|
else if (b == 2) _report.button2 = 1;
|
|
}
|
|
|
|
void Joystick_::release(uint8_t b){
|
|
if (b == 1) _report.button1 = 0;
|
|
else if (b == 2) _report.button2 = 0;
|
|
}
|
|
|
|
void Joystick_::releaseAll(void){
|
|
_report.button1 = 0;
|
|
_report.button2 = 0;
|
|
} |