RC_Simulator.....By Jafar Qutteineh with mods to connect my Futaba 9C to \'RC Helicopter\' by http://www.alphamacsoftware.com/

Dependencies:   mbed

USBHID/usbhid.cpp

Committer:
cbayley
Date:
2011-12-15
Revision:
0:65b9d8f621d2

File content as of revision 0:65b9d8f621d2:

/* usbhid.cpp */
/* USB HID class device */
/* Copyright (c) Phil Wright 2008 */

/* modified by Shinichiro Oba <http://mbed.org/users/bricklife/> */

#include "mbed.h"
#include "usbhid.h"
#include "asciihid.h"

/* Endpoint packet sizes */
#define MAX_PACKET_SIZE_EP1 (64)

/* HID Class */
#define HID_CLASS         (3)
#define HID_SUBCLASS_NONE (0)
#define HID_PROTOCOL_NONE (0)
#define HID_DESCRIPTOR    (33)
#define REPORT_DESCRIPTOR (34)

/* Class requests */
#define GET_REPORT (0x1)
#define GET_IDLE   (0x2)
#define SET_REPORT (0x9)
#define SET_IDLE   (0xa)

/* Descriptors */
unsigned char deviceDescriptor[] = {
    0x12,                    /* bLength */
    DEVICE_DESCRIPTOR,       /* bDescriptorType */
    0x00,                    /* bcdUSB (LSB) */
    0x02,                    /* bcdUSB (MSB) */
    0x00,                    /* bDeviceClass */
    0x00,                    /* bDeviceSubClass */
    0x00,                    /* bDeviceprotocol */
    MAX_PACKET_SIZE_EP0,     /* bMaxPacketSize0 */
    0x28,                    /* idVendor (LSB) */
    0x0d,                    /* idVendor (MSB) */
    0x05,                    /* idProduct (LSB) */
    0x02,                    /* idProduct (MSB) */
    0x00,                    /* bcdDevice (LSB) */
    0x00,                    /* bcdDevice (MSB) */
    0x00,                    /* iManufacturer */
    0x00,                    /* iProduct */
    0x00,                    /* iSerialNumber */
    0x01                     /* bNumConfigurations */
};

unsigned char configurationDescriptor[] = {
    0x09,                        /* bLength */
    CONFIGURATION_DESCRIPTOR,    /* bDescriptorType */
    0x09+0x09+0x09+0x07,         /* wTotalLength (LSB) */
    0x00,                        /* wTotalLength (MSB) */
    0x01,                        /* bNumInterfaces */
    0x01,                        /* bConfigurationValue */
    0x00,                        /* iConfiguration */
    0xc0,                        /* bmAttributes */
    0x00,                        /* bMaxPower */

    0x09,                        /* bLength */
    INTERFACE_DESCRIPTOR,        /* bDescriptorType */
    0x00,                        /* bInterfaceNumber */
    0x00,                        /* bAlternateSetting */
    0x01,                        /* bNumEndpoints */
    HID_CLASS,                   /* bInterfaceClass */
    HID_SUBCLASS_NONE,           /* bInterfaceSubClass */
    HID_PROTOCOL_NONE,           /* bInterfaceProtocol */
    0x00,                        /* iInterface */

    0x09,                        /* bLength */
    HID_DESCRIPTOR,              /* bDescriptorType */
    0x11,                        /* bcdHID (LSB) */
    0x01,                        /* bcdHID (MSB) */
    0x00,                        /* bCountryCode */
    0x01,                        /* bNumDescriptors */
    REPORT_DESCRIPTOR,           /* bDescriptorType */
    0x79,                        /* wDescriptorLength (LSB) */
    0x00,                        /* wDescriptorLength (MSB) */

    0x07,                        /* bLength */
    ENDPOINT_DESCRIPTOR,         /* bDescriptorType */
    0x81,                        /* bEndpointAddress */
    0x03,                        /* bmAttributes */
    MAX_PACKET_SIZE_EP1,         /* wMaxPacketSize (LSB) */
    0x00,                        /* wMaxPacketSize (MSB) */
    0x0a,                        /* bInterval */
};

/* HID Class Report Descriptor */
/* Short items: size is 0, 1, 2 or 3 specifying 0, 1, 2 or 4 (four) bytes of data as per HID Class standard */

/* Main items */
#define INPUT(size)             (0x80 | size)
#define OUTPUT(size)            (0x90 | size)
#define FEATURE(size)           (0xb0 | size)
#define COLLECTION(size)        (0xa0 | size)
#define END_COLLECTION(size)    (0xc0 | size)

/* Global items */
#define USAGE_PAGE(size)        (0x04 | size)
#define LOGICAL_MIN(size)       (0x14 | size)
#define LOGICAL_MAX(size)       (0x24 | size)
#define PHYSICAL_MIN(size)      (0x34 | size)
#define PHYSICAL_MAX(size)      (0x44 | size)
#define UNIT_EXPONENT(size)     (0x54 | size)
#define UNIT(size)              (0x64 | size)
#define REPORT_SIZE(size)       (0x74 | size)
#define REPORT_ID(size)         (0x84 | size)
#define REPORT_COUNT(size)      (0x94 | size)
#define PUSH(size)              (0xa4 | size)
#define POP(size)               (0xb4 | size)

/* Local items */
#define USAGE(size)             (0x08 | size)
#define USAGE_MIN(size)         (0x18 | size)
#define USAGE_MAX(size)         (0x28 | size)
#define DESIGNATOR_INDEX(size)  (0x38 | size)
#define DESIGNATOR_MIN(size)    (0x48 | size)
#define DESIGNATOR_MAX(size)    (0x58 | size)
#define STRING_INDEX(size)      (0x78 | size)
#define STRING_MIN(size)        (0x88 | size)
#define STRING_MAX(size)        (0x98 | size)
#define DELIMITER(size)         (0xa8 | size)

#define REPORT_ID_KEYBOARD      (1)
#define REPORT_ID_MOUSE         (2)

#define MAX_REPORT_SIZE         (8)

unsigned char reportDescriptor[] = {
    /* Keyboard */
    USAGE_PAGE(1),      0x01,
    USAGE(1),           0x06,
    COLLECTION(1),      0x01,
    REPORT_ID(1),       REPORT_ID_KEYBOARD,
    USAGE_PAGE(1),      0x07,
    USAGE_MIN(1),       0xE0,
    USAGE_MAX(1),       0xE7,
    LOGICAL_MIN(1),     0x00,
    LOGICAL_MAX(1),     0x01,
    REPORT_SIZE(1),     0x01,
    REPORT_COUNT(1),    0x08,
    INPUT(1),           0x02,
    REPORT_COUNT(1),    0x01,
    REPORT_SIZE(1),     0x08,
    INPUT(1),           0x01,
    REPORT_COUNT(1),    0x05,
    REPORT_SIZE(1),     0x01,
    USAGE_PAGE(1),      0x08,
    USAGE_MIN(1),       0x01,
    USAGE_MAX(1),       0x05,
    OUTPUT(1),          0x02,
    REPORT_COUNT(1),    0x01,
    REPORT_SIZE(1),     0x03,
    OUTPUT(1),          0x01,
    REPORT_COUNT(1),    0x06,
    REPORT_SIZE(1),     0x08,
    LOGICAL_MIN(1),     0x00,
    LOGICAL_MAX(2),     0xff, 0x00,
    USAGE_PAGE(1),      0x07,
    USAGE_MIN(1),       0x00,
    USAGE_MAX(2),       0xff, 0x00,
    INPUT(1),           0x00,
    END_COLLECTION(0),

    /* Mouse */
    USAGE_PAGE(1),      0x01,
    USAGE(1),           0x02,
    COLLECTION(1),      0x01,
    USAGE(1),           0x01,
    COLLECTION(1),      0x00,
    REPORT_ID(1),       REPORT_ID_MOUSE,
    REPORT_COUNT(1),    0x03,
    REPORT_SIZE(1),     0x01,
    USAGE_PAGE(1),      0x09,
    USAGE_MIN(1),       0x1,
    USAGE_MAX(1),       0x3,
    LOGICAL_MIN(1),     0x00,
    LOGICAL_MAX(1),     0x01,
    INPUT(1),           0x02,
    REPORT_COUNT(1),    0x01,
    REPORT_SIZE(1),     0x05,
    INPUT(1),           0x01,
    REPORT_COUNT(1),    0x03,
    REPORT_SIZE(1),     0x08,
    USAGE_PAGE(1),      0x01,
    USAGE(1),           0x30,
    USAGE(1),           0x31,
    USAGE(1),           0x38,
    LOGICAL_MIN(1),     0x81,
    LOGICAL_MAX(1),     0x7f,
    INPUT(1),           0x06,
    END_COLLECTION(0),
    END_COLLECTION(0),
};

volatile bool complete;
volatile bool configured;
unsigned char outputReport[MAX_REPORT_SIZE];
DigitalOut errorLED (LED1);
DigitalOut okLED (LED2);

usbhid::usbhid() {
    configured = false;
    connect();

}

void usbhid::deviceEventReset() {
    configured = false;

    /* Must call base class */
    usbdevice::deviceEventReset();
}

bool usbhid::requestSetConfiguration(void) {
    bool result;

    /* Configure IN interrupt endpoint */
    realiseEndpoint(EP1IN, MAX_PACKET_SIZE_EP1);
    enableEndpointEvent(EP1IN);

    /* Must call base class */
    result = usbdevice::requestSetConfiguration();

    if (result) {
        /* Now configured */
        configured = true;
    }

    return result;
}

bool usbhid::requestGetDescriptor(void) {
    bool success = false;

    switch (DESCRIPTOR_TYPE(transfer.setup.wValue)) {
        case DEVICE_DESCRIPTOR:
            transfer.remaining = sizeof(deviceDescriptor);
            transfer.ptr = deviceDescriptor;
            transfer.direction = DEVICE_TO_HOST;
            success = true;
            break;
        case CONFIGURATION_DESCRIPTOR:
            transfer.remaining =  sizeof(configurationDescriptor);
            transfer.ptr = configurationDescriptor;
            transfer.direction = DEVICE_TO_HOST;
            success = true;
            break;
        case STRING_DESCRIPTOR:
        case INTERFACE_DESCRIPTOR:
        case ENDPOINT_DESCRIPTOR:
            /* TODO: Support is optional, not implemented here */
            break;
        case HID_DESCRIPTOR:
            transfer.remaining = 0x09; /* TODO: Fix hard coded size/offset */
            transfer.ptr = &configurationDescriptor[18];
            transfer.direction = DEVICE_TO_HOST;
            success = true;
            break;
        case REPORT_DESCRIPTOR:
            transfer.remaining = sizeof(reportDescriptor);
            transfer.ptr = reportDescriptor;
            transfer.direction = DEVICE_TO_HOST;
            success = true;
            break;
        default:
            break;
    }

    return success;
}

bool usbhid::requestSetup(void) {
    /* Process class requests */
    bool success = false;

    if (transfer.setup.bmRequestType.Type == CLASS_TYPE) {
        switch (transfer.setup.bRequest) {
            case SET_REPORT:
                switch (transfer.setup.wValue & 0xff) {
                    case REPORT_ID_KEYBOARD:
                        /* TODO: LED state */
                        transfer.remaining = sizeof(outputReport);
                        transfer.ptr = outputReport;
                        transfer.direction = HOST_TO_DEVICE;
                        success = true;
                        break;
                    default:
                        break;
                }
                break;
            default:
                break;
        }
    }

    if (success) {
        /* We've handled this request */
        return true;
    }

    return usbdevice::requestSetup();
}

bool usbhid::sendInputReport(unsigned char id, unsigned char *data, unsigned char size) {
    /* Send an Input Report */
    /* If data is NULL an all zero report is sent */

    static unsigned char report[MAX_REPORT_SIZE+1]; /* +1 for report ID */
    unsigned char i;

    if (size > MAX_REPORT_SIZE) {
        return false;
    }

    /* Add report ID */
    report[0]=id;

    /* Add report data */
    if (data != NULL) {
        for (i=0; i<size; i++) {
            report[i+1] = *data++;
        }
    } else {
        for (i=0; i<size; i++) {
            report[i+1] = 0;
        }
    }

    /* Block if not configured */
    while (!configured);

    /* Send report */
    complete = false;
    disableEvents();
    endpointWrite(EP1IN, report, size+1); /* +1 for report ID */
    enableEvents();

    /* Wait for completion */
    while (!complete && configured);
    return true;
}

void usbhid::endpointEventEP1In(void) {
    complete = true;
}

bool usbhid::keyboard(char c) {
    /* Send a simulated keyboard keypress. Returns true if successful. */
    unsigned char report[8]={0,0,0,0,0,0,0,0};

    report[0] = keymap[c].modifier;
    report[2] = keymap[c].usage;

    /* Key down */
    if (!sendInputReport(REPORT_ID_KEYBOARD, report, 8)) {
        return false;
    }

    /* Key up */
    if (!sendInputReport(REPORT_ID_KEYBOARD, NULL, 8)) {
        return false;
    }

    return true;
}

bool usbhid::keyboard(char *string) {
    /* Send a string of characters. Returns true if successful. */
    do {
        if (!keyboard(*string++)) {
            return false;
        }
    } while (*string != '\0');

    return true;
}

bool usbhid::mouse(signed char x, signed char y, unsigned char buttons, signed char wheel) {
    /* Send a simulated mouse event. Returns true if successful. */
    unsigned char report[4]={0,0,0,0};

    report[0] = buttons;
    report[1] = x;
    report[2] = y;
    report[3] = wheel;

    if (!sendInputReport(REPORT_ID_MOUSE, report, 4)) {
        return false;
    }

    return true;
}


//
// USBJoystick
// Edit for different configurations (channels)

unsigned char reportDescriptorJoystick[] = {
    USAGE_PAGE(1),      0x01, //Generic Desktop
    USAGE(1),           0x04, //Joystiq
    COLLECTION(1),      0x01, //Application
    USAGE(1),           0x01,//Pointer
    COLLECTION(1),      0x00,//Physical

    USAGE_PAGE(1),      0x09,//Buttons
    USAGE_MIN(1),       0x01,//Button 1
    USAGE_MAX(1),       0x02,//Button 12  .....Changed here
    LOGICAL_MIN(1),     0x00,//00
    LOGICAL_MAX(1),     0x01,//01
    PHYSICAL_MIN(1),    0x00,//00
    PHYSICAL_MAX(1),    0x01,//01
    REPORT_SIZE(1),     0x01,// 1 Bit size
    REPORT_COUNT(1),    0x02,// 2 report
    INPUT(1),           0x02,// Data , Var , Abs

    REPORT_SIZE(1),     0x06,// 6 padding bits
    REPORT_COUNT(1),    0x01,
    INPUT(1),           0x03,// cnst , Vsr , Abs

//USAGE_PAGE(1),      0x01, //Generic Desktop
//USAGE(1),           0x39,// Hat switch
//LOGICAL_MIN(1),     0x00,// 00
//LOGICAL_MAX(1),     0x07,//07
//PHYSICAL_MIN(1),    0x00,//00
//PHYSICAL_MAX(2),    0x3B, 0x01,//315
//UNIT(1),            0x14,//English Rotation : Angular Position
//REPORT_SIZE(1),     0x04,//04
//REPORT_COUNT(1),    0x01,//01
//INPUT(1),           0x42,//Data, Var, Abs, Null
/*
    0x05, 0x02,                    //   USAGE_PAGE (Simulation Controls)
    0x09, 0xbb,                    //   USAGE (Throttle)
    0x09, 0xba,                    // USAGE (rudder)
    0x15, 0x00,                    //   LOGICAL_MINIMUM (0)
    0x26, 0xff,0x00,               //   LOGICAL_MAXIMUM (255)
    0x75, 0x08,                    //   REPORT_SIZE (8)
    0x95, 0x02,                    //   REPORT_COUNT (2)
    0x81, 0x02,                    //   INPUT (Data,Var,Abs)
*/
    USAGE_PAGE(1),      0x01,//Generic Desktop
    USAGE(1),           0x32,//z
    USAGE(1),           0x35,//Rz
    USAGE(1),           0x30,//x
    USAGE(1),           0x31,//y
    LOGICAL_MIN(1),     0x00,//00
    LOGICAL_MAX(2),     0xff, 0x00,//255
    PHYSICAL_MIN(1),    0x00,//00
    PHYSICAL_MAX(2),    0xff, 0x00,//255
    UNIT(2),            0x00, 0x00,//None 2 bytes
    REPORT_SIZE(1),     0x08,//8 bits
    REPORT_COUNT(1),    0x04,//4 reports (channels)
    INPUT(1),           0x02,//Data, Var , Abs

    END_COLLECTION(0),
    END_COLLECTION(0),
};

USBJoystick::USBJoystick() {
    int reportDescriptorSize = sizeof(reportDescriptorJoystick);
    configurationDescriptor[25] = reportDescriptorSize & 0xff;
    configurationDescriptor[26] = (reportDescriptorSize >> 8) & 0xff;

}

bool USBJoystick::requestGetDescriptor(void) {

    bool success = false;

    switch (DESCRIPTOR_TYPE(transfer.setup.wValue)) {
        case REPORT_DESCRIPTOR:
            transfer.remaining = sizeof(reportDescriptorJoystick);
            transfer.ptr = reportDescriptorJoystick;
            transfer.direction = DEVICE_TO_HOST;
            success = true;
            break;
        default:
            success = usbhid::requestGetDescriptor();
            break;
    }

    return success;
}

bool USBJoystick::sendInputReport(unsigned char *data, unsigned char size) {
    /* Send an Input Report */
    /* If data is NULL an all zero report is sent */

    static unsigned char report[MAX_REPORT_SIZE];
    unsigned char i;

    if (size > MAX_REPORT_SIZE) {
        return false;
    }

    /* Add report data */
    if (data != NULL) {
        for (i=0; i<size; i++) {
            report[i] = *data++;
        }
    } else {
        for (i=0; i<size; i++) {
            report[i] = 0;
        }
    }

    /* Block if not configured */
    while (!configured) {
        //errorLED=1; delete here
    }
    //okLED=1; delete here
    /* Send report */
    complete = false;
    disableEvents();
    endpointWrite(EP1IN, report, size);
    enableEvents();

    /* Wait for completion */
    while (!complete && configured);
    return true;
}

bool USBJoystick::joystick(unsigned char throttle, unsigned char rudder, unsigned char x, unsigned char y, bool button1, bool button2) {

    unsigned char report[6] = {0, 0, 0, 0, 0,0};
    unsigned char buttons=0x00;

    if (button1) buttons= buttons | 0x01;
    if (button2) buttons= buttons | 0x02;
    report[0] = buttons;//Buttons
    report[1] = throttle; //Throttle
    report[2] = rudder; //Rudder
    report[3] = x; //X
    report[4] = y;//Y
    


    if (!sendInputReport(report, 5)) {
       
        return false;

    }
    // okLED=1;.....Delete here
    return true;
}