Simons Wii controlled m3pi program

Dependencies:   mbed m3pi ID12RFIDIRQ

Committer:
chris
Date:
Wed May 18 14:50:46 2011 +0000
Revision:
0:0ab65a1aef12
Added some printing to the m3pi screen

Who changed what in which revision?

UserRevisionLine numberNew contents of line
chris 0:0ab65a1aef12 1
chris 0:0ab65a1aef12 2 /*
chris 0:0ab65a1aef12 3 Copyright (c) 2010 Peter Barrett
chris 0:0ab65a1aef12 4
chris 0:0ab65a1aef12 5 Permission is hereby granted, free of charge, to any person obtaining a copy
chris 0:0ab65a1aef12 6 of this software and associated documentation files (the "Software"), to deal
chris 0:0ab65a1aef12 7 in the Software without restriction, including without limitation the rights
chris 0:0ab65a1aef12 8 to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
chris 0:0ab65a1aef12 9 copies of the Software, and to permit persons to whom the Software is
chris 0:0ab65a1aef12 10 furnished to do so, subject to the following conditions:
chris 0:0ab65a1aef12 11
chris 0:0ab65a1aef12 12 The above copyright notice and this permission notice shall be included in
chris 0:0ab65a1aef12 13 all copies or substantial portions of the Software.
chris 0:0ab65a1aef12 14
chris 0:0ab65a1aef12 15 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
chris 0:0ab65a1aef12 16 IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
chris 0:0ab65a1aef12 17 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
chris 0:0ab65a1aef12 18 AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
chris 0:0ab65a1aef12 19 LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
chris 0:0ab65a1aef12 20 OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
chris 0:0ab65a1aef12 21 THE SOFTWARE.
chris 0:0ab65a1aef12 22 */
chris 0:0ab65a1aef12 23
chris 0:0ab65a1aef12 24 #include "mbed.h"
chris 0:0ab65a1aef12 25 #include "USBHost.h"
chris 0:0ab65a1aef12 26 #include "Utils.h"
chris 0:0ab65a1aef12 27
chris 0:0ab65a1aef12 28 #define AUTOEVT(_class,_subclass,_protocol) (((_class) << 16) | ((_subclass) << 8) | _protocol)
chris 0:0ab65a1aef12 29 #define AUTO_KEYBOARD AUTOEVT(CLASS_HID,1,1)
chris 0:0ab65a1aef12 30 #define AUTO_MOUSE AUTOEVT(CLASS_HID,1,2)
chris 0:0ab65a1aef12 31
chris 0:0ab65a1aef12 32 u8 auto_mouse[4]; // buttons,dx,dy,scroll
chris 0:0ab65a1aef12 33 u8 auto_keyboard[8]; // modifiers,reserved,keycode1..keycode6
chris 0:0ab65a1aef12 34 u8 auto_joystick[4]; // x,y,buttons,throttle
chris 0:0ab65a1aef12 35
chris 0:0ab65a1aef12 36 void AutoEventCallback(int device, int endpoint, int status, u8* data, int len, void* userData)
chris 0:0ab65a1aef12 37 {
chris 0:0ab65a1aef12 38 int evt = (int)userData;
chris 0:0ab65a1aef12 39 switch (evt)
chris 0:0ab65a1aef12 40 {
chris 0:0ab65a1aef12 41 case AUTO_KEYBOARD:
chris 0:0ab65a1aef12 42 printf("AUTO_KEYBOARD ");
chris 0:0ab65a1aef12 43 break;
chris 0:0ab65a1aef12 44 case AUTO_MOUSE:
chris 0:0ab65a1aef12 45 printf("AUTO_MOUSE ");
chris 0:0ab65a1aef12 46 break;
chris 0:0ab65a1aef12 47 default:
chris 0:0ab65a1aef12 48 printf("HUH ");
chris 0:0ab65a1aef12 49 }
chris 0:0ab65a1aef12 50 printfBytes("data",data,len);
chris 0:0ab65a1aef12 51 USBInterruptTransfer(device,endpoint,data,len,AutoEventCallback,userData);
chris 0:0ab65a1aef12 52 }
chris 0:0ab65a1aef12 53
chris 0:0ab65a1aef12 54 // Establish transfers for interrupt events
chris 0:0ab65a1aef12 55 void AddAutoEvent(int device, InterfaceDescriptor* id, EndpointDescriptor* ed)
chris 0:0ab65a1aef12 56 {
chris 0:0ab65a1aef12 57 if ((ed->bmAttributes & 3) != ENDPOINT_INTERRUPT || !(ed->bEndpointAddress & 0x80))
chris 0:0ab65a1aef12 58 return;
chris 0:0ab65a1aef12 59
chris 0:0ab65a1aef12 60 // Make automatic interrupt enpoints for known devices
chris 0:0ab65a1aef12 61 u32 evt = AUTOEVT(id->bInterfaceClass,id->bInterfaceSubClass,id->bInterfaceProtocol);
chris 0:0ab65a1aef12 62 u8* dst = 0;
chris 0:0ab65a1aef12 63 int len;
chris 0:0ab65a1aef12 64 switch (evt)
chris 0:0ab65a1aef12 65 {
chris 0:0ab65a1aef12 66 case AUTO_MOUSE:
chris 0:0ab65a1aef12 67 dst = auto_mouse;
chris 0:0ab65a1aef12 68 len = sizeof(auto_mouse);
chris 0:0ab65a1aef12 69 break;
chris 0:0ab65a1aef12 70 case AUTO_KEYBOARD:
chris 0:0ab65a1aef12 71 dst = auto_keyboard;
chris 0:0ab65a1aef12 72 len = sizeof(auto_keyboard);
chris 0:0ab65a1aef12 73 break;
chris 0:0ab65a1aef12 74 default:
chris 0:0ab65a1aef12 75 printf("Interrupt endpoint %02X %08X\n",ed->bEndpointAddress,evt);
chris 0:0ab65a1aef12 76 break;
chris 0:0ab65a1aef12 77 }
chris 0:0ab65a1aef12 78 if (dst)
chris 0:0ab65a1aef12 79 {
chris 0:0ab65a1aef12 80 printf("Auto Event for %02X %08X\n",ed->bEndpointAddress,evt);
chris 0:0ab65a1aef12 81 USBInterruptTransfer(device,ed->bEndpointAddress,dst,len,AutoEventCallback,(void*)evt);
chris 0:0ab65a1aef12 82 }
chris 0:0ab65a1aef12 83 }
chris 0:0ab65a1aef12 84
chris 0:0ab65a1aef12 85 void PrintString(int device, int i)
chris 0:0ab65a1aef12 86 {
chris 0:0ab65a1aef12 87 u8 buffer[256];
chris 0:0ab65a1aef12 88 int le = GetDescriptor(device,DESCRIPTOR_TYPE_STRING,i,buffer,255);
chris 0:0ab65a1aef12 89 if (le < 0)
chris 0:0ab65a1aef12 90 return;
chris 0:0ab65a1aef12 91 char* dst = (char*)buffer;
chris 0:0ab65a1aef12 92 for (int j = 2; j < le; j += 2)
chris 0:0ab65a1aef12 93 *dst++ = buffer[j];
chris 0:0ab65a1aef12 94 *dst = 0;
chris 0:0ab65a1aef12 95 printf("%d:%s\n",i,(const char*)buffer);
chris 0:0ab65a1aef12 96 }
chris 0:0ab65a1aef12 97
chris 0:0ab65a1aef12 98 // Walk descriptors and create endpoints for a given device
chris 0:0ab65a1aef12 99 int StartAutoEvent(int device, int configuration, int interfaceNumber)
chris 0:0ab65a1aef12 100 {
chris 0:0ab65a1aef12 101 u8 buffer[255];
chris 0:0ab65a1aef12 102 int err = GetDescriptor(device,DESCRIPTOR_TYPE_CONFIGURATION,0,buffer,255);
chris 0:0ab65a1aef12 103 if (err < 0)
chris 0:0ab65a1aef12 104 return err;
chris 0:0ab65a1aef12 105
chris 0:0ab65a1aef12 106 int len = buffer[2] | (buffer[3] << 8);
chris 0:0ab65a1aef12 107 u8* d = buffer;
chris 0:0ab65a1aef12 108 u8* end = d + len;
chris 0:0ab65a1aef12 109 while (d < end)
chris 0:0ab65a1aef12 110 {
chris 0:0ab65a1aef12 111 if (d[1] == DESCRIPTOR_TYPE_INTERFACE)
chris 0:0ab65a1aef12 112 {
chris 0:0ab65a1aef12 113 InterfaceDescriptor* id = (InterfaceDescriptor*)d;
chris 0:0ab65a1aef12 114 if (id->bInterfaceNumber == interfaceNumber)
chris 0:0ab65a1aef12 115 {
chris 0:0ab65a1aef12 116 d += d[0];
chris 0:0ab65a1aef12 117 while (d < end && d[1] != DESCRIPTOR_TYPE_INTERFACE)
chris 0:0ab65a1aef12 118 {
chris 0:0ab65a1aef12 119 if (d[1] == DESCRIPTOR_TYPE_ENDPOINT)
chris 0:0ab65a1aef12 120 AddAutoEvent(device,id,(EndpointDescriptor*)d);
chris 0:0ab65a1aef12 121 d += d[0];
chris 0:0ab65a1aef12 122 }
chris 0:0ab65a1aef12 123 }
chris 0:0ab65a1aef12 124 }
chris 0:0ab65a1aef12 125 d += d[0];
chris 0:0ab65a1aef12 126 }
chris 0:0ab65a1aef12 127 return 0;
chris 0:0ab65a1aef12 128 }
chris 0:0ab65a1aef12 129
chris 0:0ab65a1aef12 130 // Implemented in main.cpp
chris 0:0ab65a1aef12 131 /*
chris 0:0ab65a1aef12 132 int OnDiskInsert(int device);
chris 0:0ab65a1aef12 133 */
chris 0:0ab65a1aef12 134 // Implemented in TestShell.cpp
chris 0:0ab65a1aef12 135 int OnBluetoothInsert(int device);
chris 0:0ab65a1aef12 136
chris 0:0ab65a1aef12 137 void OnLoadDevice(int device, DeviceDescriptor* deviceDesc, InterfaceDescriptor* interfaceDesc)
chris 0:0ab65a1aef12 138 {
chris 0:0ab65a1aef12 139 printf("LoadDevice %d %02X:%02X:%02X\n",device,interfaceDesc->bInterfaceClass,interfaceDesc->bInterfaceSubClass,interfaceDesc->bInterfaceProtocol);
chris 0:0ab65a1aef12 140 char s[128];
chris 0:0ab65a1aef12 141 for (int i = 1; i < 3; i++)
chris 0:0ab65a1aef12 142 {
chris 0:0ab65a1aef12 143 if (GetString(device,i,s,sizeof(s)) < 0)
chris 0:0ab65a1aef12 144 break;
chris 0:0ab65a1aef12 145 printf("%d: %s\n",i,s);
chris 0:0ab65a1aef12 146 }
chris 0:0ab65a1aef12 147
chris 0:0ab65a1aef12 148 switch (interfaceDesc->bInterfaceClass)
chris 0:0ab65a1aef12 149 {
chris 0:0ab65a1aef12 150 // case CLASS_MASS_STORAGE:
chris 0:0ab65a1aef12 151 // if (interfaceDesc->bInterfaceSubClass == 0x06 && interfaceDesc->bInterfaceProtocol == 0x50)
chris 0:0ab65a1aef12 152 // OnDiskInsert(device); // it's SCSI!
chris 0:0ab65a1aef12 153 // break;
chris 0:0ab65a1aef12 154 case CLASS_WIRELESS_CONTROLLER:
chris 0:0ab65a1aef12 155 if (interfaceDesc->bInterfaceSubClass == 0x01 && interfaceDesc->bInterfaceProtocol == 0x01)
chris 0:0ab65a1aef12 156 OnBluetoothInsert(device); // it's bluetooth!
chris 0:0ab65a1aef12 157 break;
chris 0:0ab65a1aef12 158 default:
chris 0:0ab65a1aef12 159 StartAutoEvent(device,1,0);
chris 0:0ab65a1aef12 160 break;
chris 0:0ab65a1aef12 161 }
chris 0:0ab65a1aef12 162 }