mirror of
https://github.com/felis/USB_Host_Shield_2.0.git
synced 2024-03-22 11:31:26 +01:00
95 lines
2 KiB
C++
95 lines
2 KiB
C++
|
#include "hidjoystickrptparser.h"
|
||
|
|
||
|
JoystickReportParser::JoystickReportParser(JoystickEvents *evt) :
|
||
|
joyEvents(evt),
|
||
|
oldHat(0xDE),
|
||
|
oldButtons(0)
|
||
|
{
|
||
|
for (uint8_t i=0; i<RPT_GEMEPAD_LEN; i++)
|
||
|
oldPad[i] = 0xD;
|
||
|
}
|
||
|
|
||
|
void JoystickReportParser::Parse(HID *hid, bool is_rpt_id, uint8_t len, uint8_t *buf)
|
||
|
{
|
||
|
bool match = true;
|
||
|
|
||
|
// Checking if there are changes in report since the method was last called
|
||
|
for (uint8_t i=0; i<RPT_GEMEPAD_LEN; i++)
|
||
|
if (buf[i] != oldPad[i])
|
||
|
{
|
||
|
match = false;
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
// Calling Game Pad event handler
|
||
|
if (!match && joyEvents)
|
||
|
{
|
||
|
joyEvents->OnGamePadChanged((const GamePadEventData*)buf);
|
||
|
|
||
|
for (uint8_t i=0; i<RPT_GEMEPAD_LEN; i++) oldPad[i] = buf[i];
|
||
|
}
|
||
|
|
||
|
uint8_t hat = (buf[5] & 0xF);
|
||
|
|
||
|
// Calling Hat Switch event handler
|
||
|
if (hat != oldHat && joyEvents)
|
||
|
{
|
||
|
joyEvents->OnHatSwitch(hat);
|
||
|
oldHat = hat;
|
||
|
}
|
||
|
|
||
|
uint16_t buttons = (0x0000 | buf[6]);
|
||
|
buttons <<= 4;
|
||
|
buttons |= (buf[5] >> 4);
|
||
|
uint16_t changes = (buttons ^ oldButtons);
|
||
|
|
||
|
// Calling Button Event Handler for every button changed
|
||
|
if (changes)
|
||
|
{
|
||
|
for (uint8_t i=0; i<0x0C; i++)
|
||
|
{
|
||
|
uint16_t mask = (0x0001 << i);
|
||
|
|
||
|
if (((mask & changes) > 0) && joyEvents)
|
||
|
if ((buttons & mask) > 0)
|
||
|
joyEvents->OnButtonDn(i+1);
|
||
|
else
|
||
|
joyEvents->OnButtonUp(i+1);
|
||
|
}
|
||
|
oldButtons = buttons;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
void JoystickEvents::OnGamePadChanged(const GamePadEventData *evt)
|
||
|
{
|
||
|
Serial.print("X: ");
|
||
|
PrintHex<uint8_t>(evt->X);
|
||
|
Serial.print("\tY: ");
|
||
|
PrintHex<uint8_t>(evt->Y);
|
||
|
Serial.print("\tZ: ");
|
||
|
PrintHex<uint8_t>(evt->Z1);
|
||
|
Serial.print("\tZ: ");
|
||
|
PrintHex<uint8_t>(evt->Z2);
|
||
|
Serial.print("\tRz: ");
|
||
|
PrintHex<uint8_t>(evt->Rz);
|
||
|
Serial.println("");
|
||
|
}
|
||
|
|
||
|
void JoystickEvents::OnHatSwitch(uint8_t hat)
|
||
|
{
|
||
|
Serial.print("Hat Switch: ");
|
||
|
PrintHex<uint8_t>(hat);
|
||
|
Serial.println("");
|
||
|
}
|
||
|
|
||
|
void JoystickEvents::OnButtonUp(uint8_t but_id)
|
||
|
{
|
||
|
Serial.print("Up: ");
|
||
|
Serial.println(but_id, DEC);
|
||
|
}
|
||
|
|
||
|
void JoystickEvents::OnButtonDn(uint8_t but_id)
|
||
|
{
|
||
|
Serial.print("Dn: ");
|
||
|
Serial.println(but_id, DEC);
|
||
|
}
|