#define ARD_UTILS_DELAYMS
#include "ArdUtils/ArdUtils.h"

#include "UsbRaw.h"

#define ledPin 13

uchar buffer[50];

void callback(CALLBACK_ARGS)
{
    if (rq->bRequest == 0)
    {
        digitalWrite(ledPin, !digitalRead(ledPin));
    }
    else if (rq->bRequest == 1)
    {
        digitalWrite(ledPin, 1);
    }
    else if (rq->bRequest == 4)
    {
        digitalWrite(ledPin, !digitalRead(ledPin));
        /*if (!data)
        {
            dev->setData(0, USB_NO_MSG);
        }
        else
        {
            dev->setData(data, sizeof(data));
        }*/
        if (data)
        {
            dev->setDataString("response");
        }
    }
    else
    {
        dev->setData(data, strlen((const char*)data) + 1);
    }
}

void setup()
{
    strcpy((char*)buffer, "test");
    UsbRaw.init();
    UsbRaw.setCallback(callback);
    pinMode(ledPin, OUTPUT);
    digitalWrite(ledPin, HIGH);
}

void loop()
{
    UsbRaw.poll();
    //WAIT_USB;

    //UsbRawHid.sendData("test", 4);

    //ArdUtils::delayMs(1000);
    //digitalWrite(ledPin, !digitalRead(ledPin));
}