#include "mbed.h"
#include "rtos.h"
#include "USBHID.h"

//LED objects
DigitalOut led1(LED1);
DigitalOut led2(LED2);
DigitalOut led3(LED3);

//USB objects
USBHID hid(8, 8);
HID_REPORT send_report;
HID_REPORT recv_report;

void led1_thread(void const *args)
{
    while (true) {
        led1 = !led1;
        Thread::wait(500);
    }
}

void led2_thread(void const *args)
{
    while (true) {
        led2 = !led2;
        Thread::wait(1000);
    }
}

int main()
{
    send_report.length = 8;

    Thread thread1(led1_thread);
    Thread thread2(led2_thread);

    while (true) {
        //Fill the report
        for (int i = 0; i < send_report.length; i++)
            send_report.data[i] = rand() & 0xff;

        //Send the report
        hid.send(&send_report);

        //try to read a msg
        if(hid.readNB(&recv_report)) {
            led3 = !led3;
            for(int i = 0; i < recv_report.length; i++) {
                printf("%d ", recv_report.data[i]);
            }
            printf("\r\n");
        }

        Thread::wait(100);
    }
}