mini-led-cube/firmware/usb.c

/* Name: usb.h by Kai Lauterbach
 * Based on Project: hid-custom-rq example
 * Revision: $Id: main.c 790 2010-05-30 21:00:26Z cs $
 * Author: Christian Starkjohann
 * Copyright: (c) 2008 by OBJECTIVE DEVELOPMENT Software GmbH
 * License: GNU GPL v2 (see License.txt), GNU GPL v3 or proprietary (CommercialLicense.txt)
 */

#include "usb.h"

/* ------------------------------------------------------------------------- */

usbMsgLen_t usbFunctionSetup(uchar data[8])
{
    usbRequest_t *rq = (void *)data;

    if ( (rq->bmRequestType & USBRQ_TYPE_MASK) == USBRQ_TYPE_VENDOR )
    {
        if ( rq->bRequest == CUSTOM_RQ_SET_LED )
        {
            if ( rq->wValue.bytes[0] == 1 )
                cube |= ((uint32_t)1 << rq->wIndex.bytes[0]);
            else
                cube &= ~((uint32_t)1 << rq->wIndex.bytes[0]);
        } else if ( rq->bRequest == CUSTOM_RQ_SET_FRAME )
        {

            if ( rq->wIndex.bytes[0] == 0 )
            {
                cube = (cube & (uint32_t)0xffff0000) |
                       ( rq->wValue.bytes[0] +
                        (rq->wValue.bytes[1] << 8));
            } else {
                cube = (cube & (uint32_t)0x0000ffff) |
                       ((uint32_t)(rq->wValue.bytes[0] +
                        (rq->wValue.bytes[1] << 8)) << 16);
            }

        }
    }
    return 0;   /* default for not implemented requests: return no data back to host */
}

/* ------------------------------------------------------------------------- */

void init_usb(void)
{

    uint8_t i, j, k;

    usbInit();
    usbDeviceDisconnect();  /* enforce re-enumeration, do this while interrupts are disabled! */

    i = 0;
    j = 0;
    k = 50;
    while(--i) {             /* fake USB disconnect for > 250 ms */
        while(--k)
            while(--j) { asm volatile("nop"::); }
    }

    usbDeviceConnect();

}

/* ------------------------------------------------------------------------- */