Arnaud VALLEY / Mbed 2 deprecated Pinscape_Controller_V2_arnoz

Dependencies:   mbed FastIO FastPWM USBDevice

USBJoystick/USBJoystick.cpp

Committer:
mjr
Date:
2016-06-02
Revision:
62:f071ccde32a0
Parent:
61:3c7e6e9ec355
Child:
63:5cd1a5f3a41b

File content as of revision 62:f071ccde32a0:

/* Copyright (c) 2010-2011 mbed.org, MIT License
* Modified Mouse code for Joystick - WH 2012
*
* Permission is hereby granted, free of charge, to any person obtaining a copy of this software
* and associated documentation files (the "Software"), to deal in the Software without
* restriction, including without limitation the rights to use, copy, modify, merge, publish,
* distribute, sublicense, and/or sell copies of the Software, and to permit persons to whom the
* Software is furnished to do so, subject to the following conditions:
*
* The above copyright notice and this permission notice shall be included in all copies or
* substantial portions of the Software.
*
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING
* BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
* NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM,
* DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
*/
 
#include "stdint.h"
#include "USBJoystick.h"

#include "config.h"  // Pinscape configuration



// Length of our joystick reports.  Important: This must be kept in sync 
// with the actual joystick report format sent in update().
const int reportLen = 14;

// Maximum report sizes
const int MAX_REPORT_JS_TX = reportLen;
const int MAX_REPORT_JS_RX = 8;

bool USBJoystick::update(int16_t x, int16_t y, int16_t z, uint32_t buttons, uint16_t status) 
{
   _x = x;
   _y = y;
   _z = z;
   _buttonsLo = (uint16_t)(buttons & 0xffff);
   _buttonsHi = (uint16_t)((buttons >> 16) & 0xffff);
   _status = status;
 
   // send the report
   return update();
}

bool USBJoystick::update() 
{
   // start the report with the report ID
   HID_REPORT report;
   report.data[0] = REPORT_ID_JS;
   
   // Fill the report according to the Joystick Descriptor
#define put(idx, val) (report.data[idx] = (val) & 0xff, report.data[(idx)+1] = ((val) >> 8) & 0xff)
#define putbe(idx, val) (report.data[(idx)+1] = (val) & 0xff, report.data[idx] = ((val) >> 8) & 0xff)
#define putl(idx, val) (put(idx, val), put((idx)+2, (val) >> 16))
#define putlbe(idx, val) (putbe((idx)+2, val), putbe(idx, (val) >> 16))
   put(1, _status);
   put(3, 0);  // second word of status - zero in high bit identifies as normal joystick report
   put(5, _buttonsLo);
   put(7, _buttonsHi);
   put(9, _x);
   put(11, _y);
   put(13, _z);
   
   // important: keep reportLen in sync with the actual byte length of
   // the reports we build here
   report.length = reportLen + 1;
 
   // send the report
   return sendTO(&report, 100);
}

bool USBJoystick::kbUpdate(uint8_t data[8])
{
    // set up the report
    HID_REPORT report;
    report.data[0] = REPORT_ID_KB;      // report ID = keyboard
    memcpy(&report.data[1], data, 8);   // copy the kb report data
    report.length = 9;                  // length = ID prefix + kb report length
    
    // send it to endpoint 4 (the keyboard interface endpoint)
    return writeTO(EP4IN, report.data, report.length, MAX_PACKET_SIZE_EPINT, 100);
}

bool USBJoystick::mediaUpdate(uint8_t data)
{
    // set up the report
    HID_REPORT report;
    report.data[0] = REPORT_ID_MEDIA;   // report ID = media
    report.data[1] = data;              // key pressed bits
    report.length = 2;
    
    // send it
    return writeTO(EP4IN, report.data, report.length, MAX_PACKET_SIZE_EPINT, 100);
}
 
bool USBJoystick::sendPlungerStatus(
    int npix, int edgePos, int dir, uint32_t avgScanTime, uint32_t processingTime)
{
    // set up the report ID
    HID_REPORT report;
    report.data[0] = REPORT_ID_STAT;
    
    // Set the special status bits to indicate it's an extended
    // exposure report.
    put(1, 0x87FF);
    
    // start at the second byte
    int ofs = 3;
    
    // write the report subtype (0) to byte 2
    report.data[ofs++] = 0;

    // write the number of pixels to bytes 3-4
    put(ofs, uint16_t(npix));
    ofs += 2;
    
    // write the shadow edge position to bytes 5-6
    put(ofs, uint16_t(edgePos));
    ofs += 2;
    
    // write the flags to byte 7
    extern bool plungerCalMode;
    uint8_t flags = 0;
    if (dir == 1) 
        flags |= 0x01; 
    else if (dir == -1)
        flags |= 0x02;
    if (plungerCalMode)
        flags |= 0x04;
    report.data[ofs++] = flags;
    
    // write the average scan time in 10us intervals to bytes 8-10
    uint32_t t = uint32_t(avgScanTime / 10);
    report.data[ofs++] = t & 0xff;
    report.data[ofs++] = (t >> 8) & 0xff;
    report.data[ofs++] = (t >> 16) & 0xff;
    
    // write the processing time to bytes 11-13
    t = uint32_t(processingTime / 10);
    report.data[ofs++] = t & 0xff;
    report.data[ofs++] = (t >> 8) & 0xff;
    report.data[ofs++] = (t >> 16) & 0xff;
    
    // send the report
    report.length = reportLen + 1;
    return sendTO(&report, 100);
}

bool USBJoystick::sendPlungerPix(int &idx, int npix, const uint8_t *pix)
{
    HID_REPORT report;
    report.data[0] = REPORT_ID_STAT;
    
    // Set the special status bits to indicate it's an exposure report.
    // The high 5 bits of the status word are set to 10000, and the
    // low 11 bits are the current pixel index.
    uint16_t s = idx | 0x8000;
    put(1, s);
    
    // start at the second byte
    int ofs = 3;
    
    // now fill out the remaining bytes with exposure values
    report.length = reportLen + 1;
    for ( ; ofs < report.length ; ++ofs)
        report.data[ofs] = (idx < npix ? pix[idx++] : 0);
    
    // send the report
    return sendTO(&report, 100);
}

bool USBJoystick::reportID(int index)
{
    HID_REPORT report;

    // initially fill the report with zeros
    memset(report.data, 0, sizeof(report.data));
    
    // set the report ID
    report.data[0] = REPORT_ID_STAT;
    
    // Set the special status bits to indicate that it's an ID report
    uint16_t s = 0x9000;
    put(1, s);
    
    // add the requested ID index
    report.data[3] = (uint8_t)index;
    
    // figure out which ID we're reporting
    switch (index)
    {
    case 1:
        // KL25Z CPU ID
        putbe(4, SIM->UIDMH);
        putlbe(6, SIM->UIDML);
        putlbe(10, SIM->UIDL);
        break;
        
    case 2:
        // OpenSDA ID.  Copy the low-order 80 bits of the OpenSDA ID.
        // (The stored value is 128 bits = 16 bytes; we only want the last
        // 80 bits = 10 bytes.  So skip ahead 16 and back up 10 to get
        // the starting point.)
        extern const char *getOpenSDAID();
        memcpy(&report.data[4], getOpenSDAID() + 16 - 10, 10);
        break;
    }
    
    // send the report
    report.length = reportLen + 1;
    return sendTO(&report, 100);
}

bool USBJoystick::reportBuildInfo(const char *date)
{
    HID_REPORT report;

    // initially fill the report with zeros
    memset(report.data, 0, sizeof(report.data));
    
    // set the report ID
    report.data[0] = REPORT_ID_STAT;
    
    // Set the special status bits to indicate that it's a build
    // info report
    uint16_t s = 0xA000;
    put(1, s);
    
    // Parse the date.  This is given in the standard __DATE__ " " __TIME
    // macro format, "Mon dd yyyy hh:mm:ss" (e.g., "Feb 16 2016 12:15:06").
    static const char mon[][4] = {
        "Jan", "Feb", "Mar", "Apr", "May", "Jun", 
        "Jul", "Aug", "Sep", "Oct", "Nov", "Dec" 
    };
    long dd = (atol(date + 7) * 10000L) // YYYY0000
        + (atol(date + 4));             // 000000DD
    for (int i = 0 ; i < 12 ; ++i)
    {
        if (memcmp(mon[i], date, 3) == 0)
        {
            dd += (i+1)*100;         // 0000MM00
            break;
        }
    }
    
    // parse the time into a long formatted as decimal HHMMSS (e.g.,
    // "12:15:06" turns into 121506 decimal)
    long tt = (atol(date+12)*10000)
        + (atol(date+15)*100)
        + (atol(date+18));
    
    // store the build date and time
    putl(3, dd);
    putl(7, tt);
    
    // send the report
    report.length = reportLen + 1;
    return sendTO(&report, 100);
}

bool USBJoystick::reportConfigVar(const uint8_t *data)
{
    HID_REPORT report;

    // initially fill the report with zeros
    memset(report.data, 0, sizeof(report.data));
    
    // set the report ID
    report.data[0] = REPORT_ID_STAT;
    
    // Set the special status bits to indicate that it's a config 
    // variable report
    uint16_t s = 0x9800;
    put(1, s);
    
    // Copy the variable data (7 bytes, starting with the variable ID)
    memcpy(report.data + 3, data, 7);
    
    // send the report
    report.length = reportLen + 1;
    return sendTO(&report, 100);
}

bool USBJoystick::reportConfig(
    int numOutputs, int unitNo, 
    int plungerZero, int plungerMax, int plungerRlsTime,
    bool configured)
{
    HID_REPORT report;

    // initially fill the report with zeros
    memset(report.data, 0, sizeof(report.data));
    
    // set the report ID
    report.data[0] = REPORT_ID_STAT;
    
    // Set the special status bits to indicate that it's a config report.
    uint16_t s = 0x8800;
    put(1, s);
    
    // write the number of configured outputs
    put(3, numOutputs);
    
    // write the unit number
    put(5, unitNo);
    
    // write the plunger zero and max values
    put(7, plungerZero);
    put(9, plungerMax);
    report.data[11] = uint8_t(plungerRlsTime);
    
    // write the status bits: 
    //  0x01  -> configuration loaded
    report.data[12] = (configured ? 0x01 : 0x00);
    
    // send the report
    report.length = reportLen + 1;
    return sendTO(&report, 100);
}

bool USBJoystick::move(int16_t x, int16_t y) 
{
     _x = x;
     _y = y;
     return update();
}

bool USBJoystick::setZ(int16_t z) 
{
    _z = z;
    return update();
}
 
bool USBJoystick::buttons(uint32_t buttons) 
{
     _buttonsLo = (uint16_t)(buttons & 0xffff);
     _buttonsHi = (uint16_t)((buttons >> 16) & 0xffff);
     return update();
}

bool USBJoystick::updateStatus(uint32_t status)
{
   HID_REPORT report;

   // clear the report
   memset(report.data, 0,  sizeof(report.data));
   
   // set the report ID
   report.data[0] = REPORT_ID_STAT;
   
   // Indicate that it's a status report
   put(1, status);
   report.length = reportLen + 1;
 
   // send the report
   return sendTO(&report, 100);
}

void USBJoystick::_init() {
 
   _x = 0;                       
   _y = 0;     
   _z = 0;
   _buttonsLo = 0x0000;
   _buttonsHi = 0x0000;
   _status = 0;
}
 
 
// --------------------------------------------------------------------------
//
// USB HID Report Descriptors
//

#define HID_REPORT_JS \
    USAGE_PAGE(1), 0x01,            /* Generic desktop */ \
    USAGE(1), 0x04,                 /* Joystick */ \
    COLLECTION(1), 0x01,            /* Application */ \
        /* input report (device to host) */ \
        REPORT_ID(1), REPORT_ID_JS, \
        USAGE_PAGE(1), 0x06,        /* generic device controls - for config status */ \
        USAGE(1), 0x00,             /* undefined device control */ \
        LOGICAL_MINIMUM(1), 0x00,   /* 8-bit values */ \
        LOGICAL_MAXIMUM(1), 0xFF, \
        REPORT_SIZE(1), 0x08,       /* 8 bits per report */ \
        REPORT_COUNT(1), 0x04,      /* 4 reports (4 bytes) */ \
        INPUT(1), 0x02,             /* Data, Variable, Absolute */ \
        \
        USAGE_PAGE(1), 0x09,        /* Buttons */ \
        USAGE_MINIMUM(1), 0x01,     /* { buttons } */ \
        USAGE_MAXIMUM(1), 0x20,     /* {  1-32   } */ \
        LOGICAL_MINIMUM(1), 0x00,   /* 1-bit buttons - 0... */ \
        LOGICAL_MAXIMUM(1), 0x01,   /* ...to 1 */ \
        REPORT_SIZE(1), 0x01,       /* 1 bit per report */ \
        REPORT_COUNT(1), 0x20,      /* 32 reports */ \
        UNIT_EXPONENT(1), 0x00,     /* Unit_Exponent (0) */ \
        UNIT(1), 0x00,              /* Unit (None) */ \
        INPUT(1), 0x02,             /* Data, Variable, Absolute */ \
         \
        USAGE_PAGE(1), 0x01,        /* Generic desktop */ \
        USAGE(1), 0x30,             /* X axis */ \
        USAGE(1), 0x31,             /* Y axis */ \
        USAGE(1), 0x32,             /* Z axis */ \
        LOGICAL_MINIMUM(2), 0x00,0xF0,   /* each value ranges -4096 */ \
        LOGICAL_MAXIMUM(2), 0x00,0x10,   /* ...to +4096 */ \
        REPORT_SIZE(1), 0x10,       /* 16 bits per report */ \
        REPORT_COUNT(1), 0x03,      /* 3 reports (X, Y, Z) */ \
        INPUT(1), 0x02,             /* Data, Variable, Absolute */ \
        \
        /* output report (host to device) */ \
        REPORT_ID(1), REPORT_ID_JS, \
        REPORT_SIZE(1), 0x08,       /* 8 bits per report */ \
        REPORT_COUNT(1), 0x08,      /* output report count - 8-byte LedWiz format */ \
        0x09, 0x01,                 /* usage */ \
        0x91, 0x01,                 /* Output (array) */ \
        \
    END_COLLECTION(0)


#define HID_REPORT_STAT \
    USAGE_PAGE(1), 0x01,            /* Generic desktop */ \
    USAGE(1), 0x00,                 /* Undefined */ \
    COLLECTION(1), 0x01,            /* Application */ \
        REPORT_ID(1), REPORT_ID_STAT, \
        USAGE_PAGE(1), 0x06,        /* generic device controls */ \
        USAGE(1), 0x00,             /* undefined device control */ \
        LOGICAL_MINIMUM(1), 0x00,   /* 8-bit value range */ \
        LOGICAL_MAXIMUM(1), 0xFF, \
        REPORT_SIZE(1), 0x08,       /* 8 bits per report */ \
        REPORT_COUNT(1), reportLen, /* 'reportLen' reports==bytes */ \
        INPUT(1), 0x02,             /* Data, Variable, Absolute */ \
    END_COLLECTION(0)

#define HID_REPORT_KB \
    USAGE_PAGE(1), 0x01,            /* Generic Desktop */ \
    USAGE(1), 0x06,                 /* Keyboard */ \
    \
    /* Keyboard keys */ \
    COLLECTION(1), 0x01,            /* Application */ \
        REPORT_ID(1), REPORT_ID_KB, \
        \
        /* input report (device to host) - regular keys */ \
        REPORT_COUNT(1), 0x06, \
        REPORT_SIZE(1), 0x08, \
        LOGICAL_MINIMUM(1), 0x00, \
        LOGICAL_MAXIMUM(1), 0x65, \
        USAGE_PAGE(1), 0x07,        /* Key Codes */ \
        USAGE_MINIMUM(1), 0x00, \
        USAGE_MAXIMUM(1), 0x65, \
        INPUT(1), 0x00,             /* Data, Array */ \
        \
        /* input report (device to host) - modifier keys */ \
        USAGE_PAGE(1), 0x07,        /* Key Codes */ \
        USAGE_MINIMUM(1), 0xE0, \
        USAGE_MAXIMUM(1), 0xE7, \
        LOGICAL_MINIMUM(1), 0x00, \
        LOGICAL_MAXIMUM(1), 0x01, \
        REPORT_SIZE(1), 0x01, \
        REPORT_COUNT(1), 0x08, \
        INPUT(1), 0x02,             /* Data, Variable, Absolute */ \
        REPORT_COUNT(1), 0x01, \
        REPORT_SIZE(1), 0x08, \
        INPUT(1), 0x01,             /* Constant */ \
        \
        /* output report (host to device) - LED status */ \
        REPORT_COUNT(1), 0x05, \
        REPORT_SIZE(1), 0x01, \
        USAGE_PAGE(1), 0x08,        /* LEDs */ \
        USAGE_MINIMUM(1), 0x01, \
        USAGE_MAXIMUM(1), 0x05, \
        OUTPUT(1), 0x02,            /* Data, Variable, Absolute */ \
        REPORT_COUNT(1), 0x01, \
        REPORT_SIZE(1), 0x03, \
        OUTPUT(1), 0x01,            /* Constant */ \
    END_COLLECTION(0), \
    \
    /* Media Control Keys */ \
    USAGE_PAGE(1), 0x0C, \
    USAGE(1), 0x01, \
    COLLECTION(1), 0x01, \
        /* input report (device to host) */ \
        REPORT_ID(1), REPORT_ID_MEDIA, \
        USAGE_PAGE(1), 0x0C, \
        LOGICAL_MINIMUM(1), 0x00, \
        LOGICAL_MAXIMUM(1), 0x01, \
        REPORT_SIZE(1), 0x01, \
        REPORT_COUNT(1), 0x07, \
        USAGE(1), 0xE2,             /* Mute -> 0x01 */ \
        USAGE(1), 0xE9,             /* Volume Up -> 0x02 */ \
        USAGE(1), 0xEA,             /* Volume Down -> 0x04 */ \
        USAGE(1), 0xB5,             /* Next Track -> 0x08 */ \
        USAGE(1), 0xB6,             /* Previous Track -> 0x10 */ \
        USAGE(1), 0xB7,             /* Stop -> 0x20 */ \
        USAGE(1), 0xCD,             /* Play / Pause -> 0x40 */ \
        INPUT(1), 0x02,             /* Input (Data, Variable, Absolute) -> 0x80 */ \
        REPORT_COUNT(1), 0x01, \
        INPUT(1), 0x01, \
    END_COLLECTION(0)

#define HID_REPORT_LW \
    USAGE_PAGE(1), 0x01,            /* Generic desktop */ \
    USAGE(1), 0x00,                 /* Undefined */ \
    COLLECTION(1), 0x01,            /* Application */ \
        /* output report (host to device) */ \
        REPORT_ID(1), REPORT_ID_JS, \
        REPORT_SIZE(1), 0x08,       /* 8 bits per report */ \
        REPORT_COUNT(1), 0x08,      /* output report count (LEDWiz messages) */ \
        0x09, 0x01,                 /* usage */ \
        0x91, 0x01,                 /* Output (array) */ \
    END_COLLECTION(0)


// Joystick + Keyboard + LedWiz
static const uint8_t reportDescriptorJS[] = 
{
    USAGE_PAGE(1), 0x01,            /* Generic desktop */ \
    USAGE(1), 0x04,                 /* Joystick */ \
    COLLECTION(1), 0x01,            /* Application */ \

    HID_REPORT_JS,
    HID_REPORT_STAT,
    HID_REPORT_KB,
    
    END_COLLECTION(0)
};

// Keyboard + LedWiz
static const uint8_t reportDescriptorKB[] = 
{
    HID_REPORT_LW,
    HID_REPORT_STAT,
    HID_REPORT_KB
};

// LedWiz only
static const uint8_t reportDescriptorLW[] =
{
    HID_REPORT_LW,
    HID_REPORT_STAT
};

const uint8_t *USBJoystick::reportDesc(int idx, uint16_t &len) 
{    
    // we only have one interface (#0)
    if (idx != 0)
    {
        len = 0;
        return 0;
    }
    
    // figure which type of reports we generate according to which
    // features are enabled
    if (enableJoystick)
    {
        // joystick enabled - use the JS + KB + LW descriptor
        len = sizeof(reportDescriptorJS);
        return reportDescriptorJS;
    }
    else if (useKB)
    {
        // joystick disabled, keyboard enabled - use KB + LW
        len = sizeof(reportDescriptorKB);
        return reportDescriptorKB;
    }
    else
    {
        // joystick and keyboard disabled - LW only
        len = sizeof(reportDescriptorLW);
        return reportDescriptorLW;
    }
} 
 
 const uint8_t *USBJoystick::stringImanufacturerDesc() {
    static const uint8_t stringImanufacturerDescriptor[] = {
        0x0E,                                            /* bLength */
        STRING_DESCRIPTOR,                               /* bDescriptorType 0x03 (String Descriptor) */
        'm',0,'j',0,'r',0,'n',0,'e',0,'t',0              /* bString iManufacturer - mjrnet */
    };
    return stringImanufacturerDescriptor;
}

const uint8_t *USBJoystick::stringIserialDesc() 
{
    // set up a buffer with the length prefix and descriptor type
    const int numChars = 3 + 16 + 1 + 3;
    static uint8_t buf[2 + numChars*2];
    uint8_t *dst = buf;
    *dst++ = sizeof(buf);
    *dst++ = STRING_DESCRIPTOR;

    // Create an ASCII version of our unique serial number string:
    //
    //   PSCxxxxxxxxxxxxxxxxivvv
    //
    // where:
    //   
    //   xxx... = decimal representation of low 64 bits of CPU ID (16 hex digits)
    //   i      = interface type:  first character is J if joystick is enabled,
    //             L = LedWiz/control interface only, no input
    //             J = Joystick + LedWiz
    //             K = Keyboard + LedWiz
    //             C = Joystick + Keyboard + LedWiz ("C" for combo)
    //   vvv    = version suffix
    //
    // The suffix for the interface type resolves a problem on some Windows systems
    // when switching between interface types.  Windows can cache device information
    // that includes the interface descriptors, and it won't recognize a change in
    // the interfaces once the information is cached, causing connection failures.
    // The cache key includes the device serial number, though, so this can be 
    // resolved by changing the serial number when the interface setup changes.
    //
    // The version suffix serves a similar purpose, to force a new Windows cache
    // key whenever we make changes in the USB descriptors that require a refresh
    // on the Windows side.  The version here is completely unrelated to any other
    // version numbers throughout the system; it's purely internal to this class
    // and doesn't have to be synced to anything else.  There aren't any particular 
    // rules about when it needs to be changed; we'll change it as needed when we
    // observe the need for it due to caching problems on Windows.
    char xbuf[numChars + 1];
    uint32_t x = SIM->UIDML;
    static char ifcCode[] = "LJKC";
    sprintf(xbuf, "PSC%08lX%08lX%c009",
        SIM->UIDML, 
        SIM->UIDL, 
        ifcCode[(enableJoystick ? 0x01 : 0x00) | (useKB ? 0x02 : 0x00)]);

    // copy the ascii bytes into the descriptor buffer, converting to unicode
    // 16-bit little-endian characters
    for (char *src = xbuf ; *src != '\0' && dst < buf + sizeof(buf) ; )
    {
        *dst++ = *src++;
        *dst++ = '\0';
    }
    
    // return the buffer    
    return buf;
}

const uint8_t *USBJoystick::stringIproductDesc() {
    static const uint8_t stringIproductDescriptor[] = {
        0x28,                                                       /*bLength*/
        STRING_DESCRIPTOR,                                          /*bDescriptorType 0x03*/
        'P',0,'i',0,'n',0,'s',0,'c',0,'a',0,'p',0,'e',0,
        ' ',0,'C',0,'o',0,'n',0,'t',0,'r',0,'o',0,'l',0,
        'l',0,'e',0,'r',0                                           /*String iProduct */
    };
    return stringIproductDescriptor;
}

#define DEFAULT_CONFIGURATION (1)

const uint8_t *USBJoystick::configurationDesc() 
{
    int rptlen = reportDescLength(0);
    const int cfglen = 
        ((1 * CONFIGURATION_DESCRIPTOR_LENGTH)
         + (1 * INTERFACE_DESCRIPTOR_LENGTH)
         + (1 * HID_DESCRIPTOR_LENGTH)
         + (2 * ENDPOINT_DESCRIPTOR_LENGTH));
    static uint8_t configurationDescriptor[] = 
    {
        // Configuration descriptor
        CONFIGURATION_DESCRIPTOR_LENGTH,// bLength
        CONFIGURATION_DESCRIPTOR,       // bDescriptorType
        LSB(cfglen),                    // wTotalLength (LSB)
        MSB(cfglen),                    // wTotalLength (MSB)
        0x01,                           // bNumInterfaces
        DEFAULT_CONFIGURATION,          // bConfigurationValue
        0x00,                           // iConfiguration
        C_RESERVED | C_SELF_POWERED,    // bmAttributes
        C_POWER(0),                     // bMaxPower
    
        // Interface descriptor
        INTERFACE_DESCRIPTOR_LENGTH,    // bLength
        INTERFACE_DESCRIPTOR,           // bDescriptorType
        0x00,                           // bInterfaceNumber
        0x00,                           // bAlternateSetting
        0x02,                           // bNumEndpoints
        HID_CLASS,                      // bInterfaceClass
        HID_SUBCLASS_NONE,              // bInterfaceSubClass
        HID_PROTOCOL_NONE,              // bInterfaceProtocol
        0x00,                           // iInterface
    
        // HID descriptor, with link to report descriptor
        HID_DESCRIPTOR_LENGTH,          // bLength
        HID_DESCRIPTOR,                 // bDescriptorType
        LSB(HID_VERSION_1_11),          // bcdHID (LSB)
        MSB(HID_VERSION_1_11),          // bcdHID (MSB)
        0x00,                           // bCountryCode
        0x01,                           // bNumDescriptors
        REPORT_DESCRIPTOR,              // bDescriptorType
        LSB(rptlen),                    // wDescriptorLength (LSB)
        MSB(rptlen),                    // wDescriptorLength (MSB)
    
        // IN endpoint descriptor
        ENDPOINT_DESCRIPTOR_LENGTH,     // bLength
        ENDPOINT_DESCRIPTOR,            // bDescriptorType
        PHY_TO_DESC(EPINT_IN),          // bEndpointAddress - EPINT == EP1
        E_INTERRUPT,                    // bmAttributes
        LSB(MAX_PACKET_SIZE_EPINT),     // wMaxPacketSize (LSB)
        MSB(MAX_PACKET_SIZE_EPINT),     // wMaxPacketSize (MSB)
        1,                              // bInterval (milliseconds)
    
        // OUT endpoint descriptor
        ENDPOINT_DESCRIPTOR_LENGTH,     // bLength
        ENDPOINT_DESCRIPTOR,            // bDescriptorType
        PHY_TO_DESC(EPINT_OUT),         // bEndpointAddress - EPINT == EP1
        E_INTERRUPT,                    // bmAttributes
        LSB(MAX_PACKET_SIZE_EPINT),     // wMaxPacketSize (LSB)
        MSB(MAX_PACKET_SIZE_EPINT),     // wMaxPacketSize (MSB)
        1                               // bInterval (milliseconds)
    };

    return configurationDescriptor;
}

// Set the configuration.  We need to set up the endpoints for
// our active interfaces.
bool USBJoystick::USBCallback_setConfiguration(uint8_t configuration) 
{
    // we only have one valid configuration
    if (configuration != DEFAULT_CONFIGURATION)
        return false;
        
    // Configure endpoint 1
    addEndpoint(EPINT_IN, MAX_REPORT_JS_TX + 1);
    addEndpoint(EPINT_OUT, MAX_REPORT_JS_RX + 1);
    readStart(EPINT_OUT, MAX_REPORT_JS_TX + 1);

    // success
    return true;
}

// Handle incoming messages on the joystick/LedWiz interface = endpoint 1.
// This interface receives LedWiz protocol commands and commands using our
// custom LedWiz protocol extensions.
//
// We simply queue the messages in our circular buffer for processing in 
// the main loop.  The circular buffer object is designed for safe access
// from the interrupt handler using the rule that only the interrupt 
// handler can change the write pointer, and only the regular code can
// change the read pointer.
bool USBJoystick::EP1_OUT_callback()
{
    // Read this message
    uint8_t buf[MAX_HID_REPORT_SIZE];
    uint32_t bytesRead = 0;
    USBDevice::readEP(EP1OUT, buf, &bytesRead, MAX_HID_REPORT_SIZE);
    
    // check the report type
    switch (buf[0])
    {
    case REPORT_ID_JS:
        // Joystick/ledwiz.  These are LedWiz or private protocol command
        // messages.  Queue to the incoming LW command list.
        if (bytesRead == 9)
            lwbuf.write((LedWizMsg *)&buf[1]);
        break;
        
    case REPORT_ID_KB:
        // Keyboard.  These are standard USB keyboard protocol messages,
        // telling us the shift key LED status.  We don't do anything with
        // these; just accept and ignore them.
        break;
        
    default:
        // Other report types are unexpected; just ignore them.
        break;
    }

    // start the next read
    return readStart(EP1OUT, MAX_HID_REPORT_SIZE);
}