hidjoystickrptparser.cpp

Go to the documentation of this file.

#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);
}