d s / Mbed 2 deprecated PS3_BlueUSB

for PS3 Controller Special thanks to robo8080 http://blog.goo.ne.jp/roboz80/e/10e7bf38d3a63b996ca2894e9fb5e3b6

Dependencies:   FatFileSystem mbed

Fork of PS3_BlueUSB by Bart Janssens

Ps3USB.cpp@1:469717149e71, 2015-09-23 (annotated)

Committer:
ds074704261
Date:
Wed Sep 23 09:02:41 2015 +0000
Revision:
1:469717149e71
Parent:
0:99a111b75cb4 
hotfix

Who changed what in which revision?

UserRevisionLine numberNew contents of line
BartJanssens 0:99a111b75cb4 1 /*
BartJanssens 0:99a111b75cb4 2 Copyright (c) 2011 Bart Janssens
BartJanssens 0:99a111b75cb4 3
BartJanssens 0:99a111b75cb4 4 Permission is hereby granted, free of charge, to any person obtaining a copy
BartJanssens 0:99a111b75cb4 5 of this software and associated documentation files (the "Software"), to deal
BartJanssens 0:99a111b75cb4 6 in the Software without restriction, including without limitation the rights
BartJanssens 0:99a111b75cb4 7 to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
BartJanssens 0:99a111b75cb4 8 copies of the Software, and to permit persons to whom the Software is
BartJanssens 0:99a111b75cb4 9 furnished to do so, subject to the following conditions:
BartJanssens 0:99a111b75cb4 10
BartJanssens 0:99a111b75cb4 11 The above copyright notice and this permission notice shall be included in
BartJanssens 0:99a111b75cb4 12 all copies or substantial portions of the Software.
BartJanssens 0:99a111b75cb4 13
BartJanssens 0:99a111b75cb4 14 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
BartJanssens 0:99a111b75cb4 15 IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
BartJanssens 0:99a111b75cb4 16 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
BartJanssens 0:99a111b75cb4 17 AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
BartJanssens 0:99a111b75cb4 18 LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
BartJanssens 0:99a111b75cb4 19 OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
BartJanssens 0:99a111b75cb4 20 THE SOFTWARE.
BartJanssens 0:99a111b75cb4 21 */
BartJanssens 0:99a111b75cb4 22
BartJanssens 0:99a111b75cb4 23 #include <stdio.h>
BartJanssens 0:99a111b75cb4 24 #include <stdlib.h>
BartJanssens 0:99a111b75cb4 25 #include <string.h>
BartJanssens 0:99a111b75cb4 26
BartJanssens 0:99a111b75cb4 27 #include "USBHost.h"
BartJanssens 0:99a111b75cb4 28 #include "hci.h"
BartJanssens 0:99a111b75cb4 29 #include "Utils.h"
BartJanssens 0:99a111b75cb4 30 #include "ps3.h"
BartJanssens 0:99a111b75cb4 31
BartJanssens 0:99a111b75cb4 32 #include "mbed.h"
BartJanssens 0:99a111b75cb4 33
BartJanssens 0:99a111b75cb4 34
BartJanssens 0:99a111b75cb4 35
BartJanssens 0:99a111b75cb4 36 #define AUTOEVT(_class,_subclass,_protocol) (((_class) << 16) | ((_subclass) << 8) | _protocol)
BartJanssens 0:99a111b75cb4 37 #define PS3EVT AUTOEVT(CLASS_HID,0,0)
BartJanssens 0:99a111b75cb4 38 #define byteswap(x) ((x >> 8) | (x << 8))
BartJanssens 0:99a111b75cb4 39
BartJanssens 0:99a111b75cb4 40 u8 ps3_data[48];
BartJanssens 0:99a111b75cb4 41
BartJanssens 0:99a111b75cb4 42
BartJanssens 0:99a111b75cb4 43 Ps3USB::Ps3USB(int device, int configuration, int interfaceNumber)
BartJanssens 0:99a111b75cb4 44 {
BartJanssens 0:99a111b75cb4 45 printf("Creating new sixaxis \r\n");
BartJanssens 0:99a111b75cb4 46 _device = device;
BartJanssens 0:99a111b75cb4 47 _configuration = configuration;
BartJanssens 0:99a111b75cb4 48 _interfaceNumber = interfaceNumber;
BartJanssens 0:99a111b75cb4 49 printf("device = %d configuration = %d interfaceNumber = %d\r\n", device, configuration, interfaceNumber);
BartJanssens 0:99a111b75cb4 50 int result;
BartJanssens 0:99a111b75cb4 51 int err;
BartJanssens 0:99a111b75cb4 52
BartJanssens 0:99a111b75cb4 53 _count = 1;
BartJanssens 0:99a111b75cb4 54
BartJanssens 0:99a111b75cb4 55 u8 abuffer[48] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
BartJanssens 0:99a111b75cb4 56 0x00, 0x02, 0xff, 0x27, 0x10, 0x00, 0x32, 0xff,
BartJanssens 0:99a111b75cb4 57 0x27, 0x10, 0x00, 0x32, 0xff, 0x27, 0x10, 0x00,
BartJanssens 0:99a111b75cb4 58 0x32, 0xff, 0x27, 0x10, 0x00, 0x32, 0x00, 0x00,
BartJanssens 0:99a111b75cb4 59 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
BartJanssens 0:99a111b75cb4 60 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00};
BartJanssens 0:99a111b75cb4 61 memcpy(ledrumble,abuffer,48);
BartJanssens 0:99a111b75cb4 62
BartJanssens 0:99a111b75cb4 63 EndpointDescriptor* ep;
BartJanssens 0:99a111b75cb4 64
BartJanssens 0:99a111b75cb4 65 u8 buffer[255];
BartJanssens 0:99a111b75cb4 66 err = GetDescriptor(_device,DESCRIPTOR_TYPE_CONFIGURATION,0,buffer,255);
BartJanssens 0:99a111b75cb4 67 if (err < 0)
BartJanssens 0:99a111b75cb4 68 printf("Failed to get descriptor\r\n");
BartJanssens 0:99a111b75cb4 69
BartJanssens 0:99a111b75cb4 70
BartJanssens 0:99a111b75cb4 71 int len = buffer[2] | (buffer[3] << 8);
BartJanssens 0:99a111b75cb4 72 u8* d = buffer;
BartJanssens 0:99a111b75cb4 73 u8* end = d + len;
BartJanssens 0:99a111b75cb4 74 while (d < end)
BartJanssens 0:99a111b75cb4 75 {
BartJanssens 0:99a111b75cb4 76 if (d[1] == DESCRIPTOR_TYPE_INTERFACE)
BartJanssens 0:99a111b75cb4 77 {
BartJanssens 0:99a111b75cb4 78 InterfaceDescriptor* id = (InterfaceDescriptor*)d;
BartJanssens 0:99a111b75cb4 79 if (id->bInterfaceNumber == _interfaceNumber)
BartJanssens 0:99a111b75cb4 80 {
BartJanssens 0:99a111b75cb4 81 d += d[0];
BartJanssens 0:99a111b75cb4 82 while (d < end && d[1] != DESCRIPTOR_TYPE_INTERFACE)
BartJanssens 0:99a111b75cb4 83 {
BartJanssens 0:99a111b75cb4 84 if (d[1] == DESCRIPTOR_TYPE_ENDPOINT)
BartJanssens 0:99a111b75cb4 85 ep = (EndpointDescriptor*)d;
BartJanssens 0:99a111b75cb4 86
BartJanssens 0:99a111b75cb4 87 if (ep->bEndpointAddress == 0x02) {
BartJanssens 0:99a111b75cb4 88 printf("PS3 input endpoint (0x02) found\r\n");
BartJanssens 0:99a111b75cb4 89 input_ep = 0x02;
BartJanssens 0:99a111b75cb4 90
BartJanssens 0:99a111b75cb4 91 }
BartJanssens 0:99a111b75cb4 92 if (ep->bEndpointAddress == 0x81) {
BartJanssens 0:99a111b75cb4 93 printf("PS3 output endpoint (0x81) found\r\n");
BartJanssens 0:99a111b75cb4 94 output_ep = 0x81;
BartJanssens 0:99a111b75cb4 95 //AddAutoEvent(device,id,(EndpointDescriptor*)d);
BartJanssens 0:99a111b75cb4 96 }
BartJanssens 0:99a111b75cb4 97 d += d[0];
BartJanssens 0:99a111b75cb4 98 }
BartJanssens 0:99a111b75cb4 99 }
BartJanssens 0:99a111b75cb4 100 }
BartJanssens 0:99a111b75cb4 101 d += d[0];
BartJanssens 0:99a111b75cb4 102 }
BartJanssens 0:99a111b75cb4 103
BartJanssens 0:99a111b75cb4 104 }
BartJanssens 0:99a111b75cb4 105
BartJanssens 0:99a111b75cb4 106 int Ps3USB::Enable()
BartJanssens 0:99a111b75cb4 107 {
BartJanssens 0:99a111b75cb4 108 int err;
BartJanssens 0:99a111b75cb4 109
BartJanssens 0:99a111b75cb4 110 u8 enable[4] = {0x42,0x0c,0x00,0x00};
BartJanssens 0:99a111b75cb4 111
BartJanssens 0:99a111b75cb4 112
BartJanssens 0:99a111b75cb4 113 err = USBControlTransfer(_device, HOST_TO_DEVICE|REQUEST_TYPE_CLASS|RECIPIENT_INTERFACE, HID_REQUEST_SET_REPORT, 0x03f4,0, enable, sizeof(enable), 0, 0 );
BartJanssens 0:99a111b75cb4 114 //printf("set report result = %d\r\n", err);
BartJanssens 0:99a111b75cb4 115 _count ++;
BartJanssens 0:99a111b75cb4 116 if (_count == 25) _count = 1;
BartJanssens 0:99a111b75cb4 117
BartJanssens 0:99a111b75cb4 118 err = USBInterruptTransfer(_device,output_ep,ps3_data,sizeof(ps3_data),PS3EventCallback,this);
BartJanssens 0:99a111b75cb4 119 wait_ms(4);
BartJanssens 0:99a111b75cb4 120
BartJanssens 0:99a111b75cb4 121 return 0;
BartJanssens 0:99a111b75cb4 122
BartJanssens 0:99a111b75cb4 123 }
BartJanssens 0:99a111b75cb4 124
BartJanssens 0:99a111b75cb4 125
BartJanssens 0:99a111b75cb4 126
BartJanssens 0:99a111b75cb4 127
BartJanssens 0:99a111b75cb4 128 int Ps3USB::SetPair(u8* bdAddr)
BartJanssens 0:99a111b75cb4 129 {
BartJanssens 0:99a111b75cb4 130 int err;
BartJanssens 0:99a111b75cb4 131
BartJanssens 0:99a111b75cb4 132 u8 buf[8];
BartJanssens 0:99a111b75cb4 133 u8 buf2[6];
BartJanssens 0:99a111b75cb4 134
BartJanssens 0:99a111b75cb4 135 memcpy(buf2,bdAddr,6);
BartJanssens 0:99a111b75cb4 136
BartJanssens 0:99a111b75cb4 137 buf[0] = 0x01;
BartJanssens 0:99a111b75cb4 138 buf[1] = 0x00;
BartJanssens 0:99a111b75cb4 139 buf[2] = buf2[0];
BartJanssens 0:99a111b75cb4 140 buf[3] = buf2[1];
BartJanssens 0:99a111b75cb4 141 buf[4] = buf2[2];
BartJanssens 0:99a111b75cb4 142 buf[5] = buf2[3];
BartJanssens 0:99a111b75cb4 143 buf[6] = buf2[4];
BartJanssens 0:99a111b75cb4 144 buf[7] = buf2[5];
BartJanssens 0:99a111b75cb4 145
BartJanssens 0:99a111b75cb4 146 //set Mac address
BartJanssens 0:99a111b75cb4 147 err = USBControlTransfer(_device, HOST_TO_DEVICE|REQUEST_TYPE_CLASS|RECIPIENT_INTERFACE, HID_REQUEST_SET_REPORT, 0x03f5, 0, buf, sizeof(buf), 0, 0 );
BartJanssens 0:99a111b75cb4 148 wait_ms(4);
BartJanssens 0:99a111b75cb4 149 printf("set Mac address to %02X:%02X:%02X:%02X:%02X:%02X , result = %d\r\n", buf[2], buf[3], buf[4], buf[5], buf[6], buf[7], err);
BartJanssens 0:99a111b75cb4 150
BartJanssens 0:99a111b75cb4 151 return 0;
BartJanssens 0:99a111b75cb4 152 }
BartJanssens 0:99a111b75cb4 153
BartJanssens 0:99a111b75cb4 154 int Ps3USB::ShowPair()
BartJanssens 0:99a111b75cb4 155 {
BartJanssens 0:99a111b75cb4 156 int err;
BartJanssens 0:99a111b75cb4 157
BartJanssens 0:99a111b75cb4 158 u8 buf[8];
BartJanssens 0:99a111b75cb4 159 //get Mac address
BartJanssens 0:99a111b75cb4 160 err = USBControlTransfer(_device, DEVICE_TO_HOST|REQUEST_TYPE_CLASS|RECIPIENT_INTERFACE, HID_REQUEST_GET_REPORT, 0x03f5, 0, buf, sizeof(buf), 0, 0 );
BartJanssens 0:99a111b75cb4 161 wait_ms(4);
BartJanssens 0:99a111b75cb4 162 printf("Mac address is set to %02X:%02X:%02X:%02X:%02X:%02X , result = %d\r\n",buf[2], buf[3], buf[4], buf[5], buf[6], buf[7], err);
BartJanssens 0:99a111b75cb4 163
BartJanssens 0:99a111b75cb4 164
BartJanssens 0:99a111b75cb4 165 return 0;
BartJanssens 0:99a111b75cb4 166 }
BartJanssens 0:99a111b75cb4 167
BartJanssens 0:99a111b75cb4 168 int Ps3USB::Led(int i)
BartJanssens 0:99a111b75cb4 169 {
BartJanssens 0:99a111b75cb4 170 int err;
BartJanssens 0:99a111b75cb4 171 u8 ledpattern[7] = {0x02, 0x04, 0x08, 0x10, 0x12, 0x14, 0x18 };
BartJanssens 0:99a111b75cb4 172 u8 buf[48];
BartJanssens 0:99a111b75cb4 173
BartJanssens 0:99a111b75cb4 174 if (i < 7) ledrumble[9] = ledpattern[i];
BartJanssens 0:99a111b75cb4 175 memcpy(buf, ledrumble, 48);
BartJanssens 0:99a111b75cb4 176
BartJanssens 0:99a111b75cb4 177 err = USBControlTransfer(_device, HOST_TO_DEVICE|REQUEST_TYPE_CLASS|RECIPIENT_INTERFACE, HID_REQUEST_SET_REPORT, 0x0201,0, buf, sizeof(buf), 0, 0 );
BartJanssens 0:99a111b75cb4 178 wait_ms(4);
BartJanssens 0:99a111b75cb4 179
BartJanssens 0:99a111b75cb4 180 return 0;
BartJanssens 0:99a111b75cb4 181 }
BartJanssens 0:99a111b75cb4 182
BartJanssens 0:99a111b75cb4 183 // left and right: duration and power, both from 0 to 255
BartJanssens 0:99a111b75cb4 184 int Ps3USB::Rumble(u8 duration_right, u8 power_right, u8 duration_left, u8 power_left)
BartJanssens 0:99a111b75cb4 185 {
BartJanssens 0:99a111b75cb4 186 int err;
BartJanssens 0:99a111b75cb4 187 u8 buf[48];
BartJanssens 0:99a111b75cb4 188
BartJanssens 0:99a111b75cb4 189 memcpy(buf, ledrumble, 48);
BartJanssens 0:99a111b75cb4 190 buf[1] = duration_right;
BartJanssens 0:99a111b75cb4 191 buf[2] = power_right;
BartJanssens 0:99a111b75cb4 192 buf[3] = duration_left;
BartJanssens 0:99a111b75cb4 193 buf[4] = power_left;
BartJanssens 0:99a111b75cb4 194
BartJanssens 0:99a111b75cb4 195 err = USBControlTransfer(_device, HOST_TO_DEVICE|REQUEST_TYPE_CLASS|RECIPIENT_INTERFACE, HID_REQUEST_SET_REPORT, 0x0201,0, buf, sizeof(buf), 0, 0 );
BartJanssens 0:99a111b75cb4 196 wait_ms(4);
BartJanssens 0:99a111b75cb4 197
BartJanssens 0:99a111b75cb4 198 return 0;
BartJanssens 0:99a111b75cb4 199 }
BartJanssens 0:99a111b75cb4 200
BartJanssens 0:99a111b75cb4 201
BartJanssens 0:99a111b75cb4 202 void PS3EventCallback(int device, int endpoint, int status, u8* data, int len, void* userData)
BartJanssens 0:99a111b75cb4 203 {
BartJanssens 0:99a111b75cb4 204 Ps3USB* t = (Ps3USB*)userData;
BartJanssens 0:99a111b75cb4 205
BartJanssens 0:99a111b75cb4 206 t->_count ++;
BartJanssens 0:99a111b75cb4 207 if (t->_count == 25) t->_count = 1;
BartJanssens 0:99a111b75cb4 208
BartJanssens 0:99a111b75cb4 209 ParsePs3Result(data, sizeof(ps3report),t->_count);
BartJanssens 0:99a111b75cb4 210 USBInterruptTransfer(device, endpoint , data, len, PS3EventCallback, userData);
BartJanssens 0:99a111b75cb4 211 wait_ms(4);
BartJanssens 0:99a111b75cb4 212
BartJanssens 0:99a111b75cb4 213 }
BartJanssens 0:99a111b75cb4 214
BartJanssens 0:99a111b75cb4 215 int ParsePs3Result(const u8* data,int len,int count)
BartJanssens 0:99a111b75cb4 216 {
BartJanssens 0:99a111b75cb4 217 ps3report* _ps3report = (ps3report*)data;
BartJanssens 0:99a111b75cb4 218 if (count == 24) printf("LSX LSY RSX RSY UPA RPA DPA RPA L2 R2 L1 R1 TRI CIR CRO SQU ACX ACY ACZ GYZ \r\n");
BartJanssens 0:99a111b75cb4 219 printf("%3d %3d %3d %3d %3d %3d %3d %3d %3d %3d %3d %3d %3d %3d %3d %3d %4d %4d %4d %4d \r\n",
BartJanssens 0:99a111b75cb4 220 _ps3report->LeftStickX,
BartJanssens 0:99a111b75cb4 221 _ps3report->LeftStickY,
BartJanssens 0:99a111b75cb4 222 _ps3report->RightStickX,
BartJanssens 0:99a111b75cb4 223 _ps3report->RightStickY,
BartJanssens 0:99a111b75cb4 224 _ps3report->PressureUp,
BartJanssens 0:99a111b75cb4 225 _ps3report->PressureRight,
BartJanssens 0:99a111b75cb4 226 _ps3report->PressureDown,
BartJanssens 0:99a111b75cb4 227 _ps3report->PressureLeft,
BartJanssens 0:99a111b75cb4 228 _ps3report->PressureL2,
BartJanssens 0:99a111b75cb4 229 _ps3report->PressureR2,
BartJanssens 0:99a111b75cb4 230 _ps3report->PressureL1,
BartJanssens 0:99a111b75cb4 231 _ps3report->PressureR1,
BartJanssens 0:99a111b75cb4 232 _ps3report->PressureTriangle,
BartJanssens 0:99a111b75cb4 233 _ps3report->PressureCircle,
BartJanssens 0:99a111b75cb4 234 _ps3report->PressureCross,
BartJanssens 0:99a111b75cb4 235 _ps3report->PressureSquare,
BartJanssens 0:99a111b75cb4 236 (_ps3report->AccelX),
BartJanssens 0:99a111b75cb4 237 (_ps3report->AccelY),
BartJanssens 0:99a111b75cb4 238 (_ps3report->AccelZ),
BartJanssens 0:99a111b75cb4 239 (_ps3report->GyroZ));
BartJanssens 0:99a111b75cb4 240 //printfBytes("data",data,len);
BartJanssens 0:99a111b75cb4 241 }
BartJanssens 0:99a111b75cb4 242
BartJanssens 0:99a111b75cb4 243