Xbox 360 Wireless Controller for Windows library. sample: http://mbed.org/users/okini3939/code/USBHostXpad_HelloWorld/

Dependents:   x4180_Tank Totaleprogramma Handmatig Totaleprogramma1

Fork of USBHostXpad by Suga koubou

USBHostXpad.cpp

Committer:
okini3939
Date:
2013-12-10
Revision:
0:bd0f6bf72a8b
Child:
1:5bb153989f33

File content as of revision 0:bd0f6bf72a8b:

/*
 * Xbox 360 Wireless Controller for Windows library
 * for mbed USBHost library
 * Copyright (c) 2013 Hiroshi Suga
 *
 * VID=0x045e PID=0x0719
 *
 * Note: 2012-12-10
 *   The library has some problems.
 *   - X-logo lamp remains flickering.
 *   - probe() function is irresponsible.
 */

#include "USBHostXpad.h"

#if 1 or USBHOST_XPAD

#include "dbg.h"

#define DEVICE_TO_HOST  0x80
#define HOST_TO_DEVICE  0x00

USBHostXpad::USBHostXpad()
{
    host = USBHost::getHostInst();
    init();
}

void USBHostXpad::init() {
    dev_connected = false;
    dev = NULL;
    int_in = NULL;
    int_out = NULL;
    xpad_intf = -1;
    xpad_device_found = false;
    nb_ep = 0;
}

bool USBHostXpad::connected()
{
    return dev_connected;
}

bool USBHostXpad::connect()
{

    if (dev_connected) {
        return true;
    }

    for (uint8_t i = 0; i < MAX_DEVICE_CONNECTED; i++) {
        if ((dev = host->getDevice(i)) != NULL) {
            
            USB_DBG("Trying to connect MSD device\r\n");
            
            if(host->enumerate(dev, this))
                break;

            if (xpad_device_found) {
                xpad_device_found = false;
                int_in = dev->getEndpoint(xpad_intf, INTERRUPT_ENDPOINT, IN);
                int_out = dev->getEndpoint(xpad_intf, INTERRUPT_ENDPOINT, OUT);
                
                if (!int_in || !int_out)
                    continue;

                USB_INFO("New MSD device: VID:%04x PID:%04x [dev: %p - intf: %d]", dev->getVid(), dev->getPid(), dev, xpad_intf);
                USB_INFO("endpoint in:%08x out:%08x", int_in, int_out);
                dev->setName("XPAD", xpad_intf);
                host->registerDriver(dev, xpad_intf, this, &USBHostXpad::init);

                int_in->attach(this, &USBHostXpad::rxHandler);
                probe(0x00, 0x00, 0x08, 0x40);
                probe(0x01, 0x03, 0x09, 0x01);
                probe(0x01, 0x03, 0x08, 0x01);
                probe(0x01, 0x03, 0x09, 0x00);
                probe(0x01, 0x03, 0x09, 0x01);
                probe(0x01, 0x03, 0x08, 0x01);
                probe(0x01, 0x03, 0x09, 0x00);
                probe(0x01, 0x03, 0x09, 0x01);
                probe(0x01, 0x03, 0x08, 0x01);
                probe(0x01, 0x03, 0x09, 0x00);
                probe(0x01, 0x03, 0x09, 0x01);
                probe(0x01, 0x03, 0x08, 0x01);
                probe(0x01, 0x03, 0x09, 0x00);
                host->interruptRead(dev, int_in, report, int_in->getSize(), false);
                dev_connected = true;
//                USB_INFO("RETURN TRUE");
                return true;
            }

        } //if()
    } //for()
//    USB_INFO("RETURN FALSE");
    init();
    return false;
}

void USBHostXpad::rxHandler() {
    int len_listen = int_in->getSize();
    int len = int_in->getLengthTransferred();

    USB_INFO("rxHandler len:%d data:%02x %02x", len, report[0], report[1]);
    for (int i = 0; i < len_listen; i ++) {
        std::printf(" %02x", report[i]);
    }
    std::printf("\r\n");

    if (report[0] == 0x08 && report[1] == 0x80) {
        probe(0x00, 0x00, 0x00, 0x40);
        goto exit;
    } else
    if (report[0] == 0x00 && report[1] == 0x0f) {
        probe(0x00, 0x00, 0x08, 0x46);
        probe(0x00, 0x00, 0x00, 0x40);
        goto exit;
    } else
    if (report[0] == 0x00 && report[1] == 0x00 && report[2] == 0x00 && report[3] == 0x0f) {
        //
        goto exit;
    } else
    if (report[0] != 0x00 || !(report[1] & 1)) { // Check if it's the correct report - the controller also sends different status reports
        goto exit;
    }

    buttons = ((uint32_t)report[7] << 8) | report[6];
    trigger_l = report[8];
    trigger_r = report[9];

    stick_lx = ((int16_t)report[11] << 8) | report[10];
    stick_ly = ((int16_t)report[13] << 8) | report[12];
    stick_rx = ((int16_t)report[15] << 8) | report[14];
    stick_ry = ((int16_t)report[17] << 8) | report[16];

    if (onUpdate) {
        (*onUpdate)(buttons, stick_lx, stick_ly, stick_rx, stick_ry, trigger_l, trigger_r);
    }
exit:
    if (dev)
        host->interruptRead(dev, int_in, report, len_listen, false);
}

/*virtual*/ void USBHostXpad::setVidPid(uint16_t vid, uint16_t pid)
{
    // we don't check VID/PID for MSD driver
}

/*virtual*/ bool USBHostXpad::parseInterface(uint8_t intf_nb, uint8_t intf_class, uint8_t intf_subclass, uint8_t intf_protocol) //Must return true if the interface should be parsed
{
    USB_INFO("parseInterface class:%02x subclass:%02x protocol:%02x [nb: %d - intf: %d]", intf_class, intf_subclass, intf_protocol, intf_nb, xpad_intf);
    if ((xpad_intf == -1) &&
        (intf_class == 0xff) &&
        (intf_subclass == 0x5d) &&
        (intf_protocol == 0x81)) {
        xpad_intf = intf_nb;
        return true;
    }
    return false;
}

/*virtual*/ bool USBHostXpad::useEndpoint(uint8_t intf_nb, ENDPOINT_TYPE type, ENDPOINT_DIRECTION dir) //Must return true if the endpoint will be used
{
    USB_INFO("useEndpoint nb:%d type:%d dir:%d", intf_nb, type, dir);
    if (intf_nb == xpad_intf) {
        if (type == INTERRUPT_ENDPOINT) {
            nb_ep ++;
            if (nb_ep == 2)
                xpad_device_found = true;
            return true;
        }
    }
    return false;
}

void USBHostXpad::poll ()
{
    probe(0x08, 0x00, 0x0f, 0xc0);
    probe(0x08, 0x00, 0x0f, 0xc0);
    probe(0x08, 0x00, 0x0f, 0xc0);
    probe(0x08, 0x00, 0x0f, 0xc0);
}

bool USBHostXpad::probe(int val1, int val2, int val3, int val4)
{
    unsigned char bdata[32];
    memset(bdata, 0, sizeof(bdata));
    bdata[0] = val1;
    bdata[1] = val2;
    bdata[2] = val3;
    bdata[3] = val4;
    if (dev)
        host->interruptWrite(dev, int_out, bdata, 12, false);
    return true;
}

bool USBHostXpad::effect(uint8_t strong, uint8_t weak)
{
    unsigned char odata[32];

    odata[0] = 0x00;
    odata[1] = 0x01;
    odata[2] = 0x0F;
    odata[3] = 0xC0;
    odata[4] = 0x00;
    odata[5] = strong;
    odata[6] = weak;
    odata[7] = 0x00;
    odata[8] = 0x00;
    odata[9] = 0x00;
    odata[10] = 0x00;
    odata[11] = 0x00;
    host->interruptWrite(dev, int_in, odata, 12, false);
    return true;
}

#endif