2018_Project-R / Mbed 2 deprecated PS3_BlueUSB_downstate

PS3下の階

Dependencies:   FatFileSystem PS3_BlueUSB QEI RoboClaw_mine_ mbed

Fork of PS3_BlueUSB by Bart Janssens

TestShell.cpp@1:b2063ffa4927, 2018-01-11 (annotated)

Committer:
e5115026
Date:
Thu Jan 11 07:47:26 2018 +0000
Revision:
1:b2063ffa4927
Parent:
0:99a111b75cb4 
???????

Who changed what in which revision?

UserRevisionLine numberNew contents of line
BartJanssens 0:99a111b75cb4 1
BartJanssens 0:99a111b75cb4 2 /*
BartJanssens 0:99a111b75cb4 3 Copyright (c) 2010 Peter Barrett
BartJanssens 0:99a111b75cb4 4
BartJanssens 0:99a111b75cb4 5 Permission is hereby granted, free of charge, to any person obtaining a copy
BartJanssens 0:99a111b75cb4 6 of this software and associated documentation files (the "Software"), to deal
BartJanssens 0:99a111b75cb4 7 in the Software without restriction, including without limitation the rights
BartJanssens 0:99a111b75cb4 8 to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
BartJanssens 0:99a111b75cb4 9 copies of the Software, and to permit persons to whom the Software is
BartJanssens 0:99a111b75cb4 10 furnished to do so, subject to the following conditions:
BartJanssens 0:99a111b75cb4 11
BartJanssens 0:99a111b75cb4 12 The above copyright notice and this permission notice shall be included in
BartJanssens 0:99a111b75cb4 13 all copies or substantial portions of the Software.
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 /*
BartJanssens 0:99a111b75cb4 24 Tue Apr 26 2011 Bart Janssens: added PS3 Bluetooth support
BartJanssens 0:99a111b75cb4 25 */
BartJanssens 0:99a111b75cb4 26
BartJanssens 0:99a111b75cb4 27 #include <stdio.h>
BartJanssens 0:99a111b75cb4 28 #include <stdlib.h>
BartJanssens 0:99a111b75cb4 29 #include <string.h>
BartJanssens 0:99a111b75cb4 30
BartJanssens 0:99a111b75cb4 31 #include "Utils.h"
BartJanssens 0:99a111b75cb4 32 #include "USBHost.h"
BartJanssens 0:99a111b75cb4 33 #include "hci.h"
BartJanssens 0:99a111b75cb4 34 #include "ps3.h"
BartJanssens 0:99a111b75cb4 35
BartJanssens 0:99a111b75cb4 36 #include "mbed.h"
e5115026 1:b2063ffa4927 37 /*
e5115026 1:b2063ffa4927 38 DigitalOut led1(LED1);
e5115026 1:b2063ffa4927 39 DigitalOut led2(LED2);
e5115026 1:b2063ffa4927 40 int joyL_x=0;
e5115026 1:b2063ffa4927 41 int joyL_y=0;
e5115026 1:b2063ffa4927 42 int angle_omni=0;
e5115026 1:b2063ffa4927 43 */
e5115026 1:b2063ffa4927 44 //サブ関数宣言
e5115026 1:b2063ffa4927 45 double d_r(double degree); //度数法→ラジアン
e5115026 1:b2063ffa4927 46 double r_d(double radian); //ラジアン→度数法
e5115026 1:b2063ffa4927 47 double max_min(double val,double max,double min); //最大最小値設定関数.math.hでいうmax関数とmin関数を統合した関数
e5115026 1:b2063ffa4927 48 double odo_way(int mode); //オドメトリ用エンコーダーからとったpulseをmmに変換
e5115026 1:b2063ffa4927 49 double mms_qpps(double millimeter_sec); //mmsからqpps(秒あたりのパルス数)に変換する関数
e5115026 1:b2063ffa4927 50 void omni_move(double x_speed,double y_speed,double angle);
e5115026 1:b2063ffa4927 51 void odometry(); //オドメトリ関数
e5115026 1:b2063ffa4927 52
BartJanssens 0:99a111b75cb4 53
BartJanssens 0:99a111b75cb4 54
BartJanssens 0:99a111b75cb4 55 void printf(const BD_ADDR* addr)
BartJanssens 0:99a111b75cb4 56 {
BartJanssens 0:99a111b75cb4 57 const u8* a = addr->addr;
BartJanssens 0:99a111b75cb4 58 printf("%02X:%02X:%02X:%02X:%02X:%02X",a[5],a[4],a[3],a[2],a[1],a[0]);
BartJanssens 0:99a111b75cb4 59 }
BartJanssens 0:99a111b75cb4 60
BartJanssens 0:99a111b75cb4 61 #define MAX_HCL_SIZE 260
BartJanssens 0:99a111b75cb4 62 #define MAX_ACL_SIZE 400
BartJanssens 0:99a111b75cb4 63
BartJanssens 0:99a111b75cb4 64 class HCITransportUSB : public HCITransport
BartJanssens 0:99a111b75cb4 65 {
BartJanssens 0:99a111b75cb4 66 int _device;
BartJanssens 0:99a111b75cb4 67 u8* _hciBuffer;
BartJanssens 0:99a111b75cb4 68 u8* _aclBuffer;
BartJanssens 0:99a111b75cb4 69
BartJanssens 0:99a111b75cb4 70 public:
BartJanssens 0:99a111b75cb4 71 void Open(int device, u8* hciBuffer, u8* aclBuffer)
BartJanssens 0:99a111b75cb4 72 {
BartJanssens 0:99a111b75cb4 73 _device = device;
BartJanssens 0:99a111b75cb4 74 _hciBuffer = hciBuffer;
BartJanssens 0:99a111b75cb4 75 _aclBuffer = aclBuffer;
BartJanssens 0:99a111b75cb4 76 USBInterruptTransfer(_device,0x81,_hciBuffer,MAX_HCL_SIZE,HciCallback,this);
BartJanssens 0:99a111b75cb4 77 USBBulkTransfer(_device,0x82,_aclBuffer,MAX_ACL_SIZE,AclCallback,this);
BartJanssens 0:99a111b75cb4 78 }
BartJanssens 0:99a111b75cb4 79
BartJanssens 0:99a111b75cb4 80 static void HciCallback(int device, int endpoint, int status, u8* data, int len, void* userData)
BartJanssens 0:99a111b75cb4 81 {
BartJanssens 0:99a111b75cb4 82 HCI* t = ((HCITransportUSB*)userData)->_target;
BartJanssens 0:99a111b75cb4 83 if (t)
BartJanssens 0:99a111b75cb4 84 t->HCIRecv(data,len);
BartJanssens 0:99a111b75cb4 85 USBInterruptTransfer(device,0x81,data,MAX_HCL_SIZE,HciCallback,userData);
BartJanssens 0:99a111b75cb4 86 }
BartJanssens 0:99a111b75cb4 87
BartJanssens 0:99a111b75cb4 88 static void AclCallback(int device, int endpoint, int status, u8* data, int len, void* userData)
BartJanssens 0:99a111b75cb4 89 {
BartJanssens 0:99a111b75cb4 90 HCI* t = ((HCITransportUSB*)userData)->_target;
BartJanssens 0:99a111b75cb4 91 if (t)
BartJanssens 0:99a111b75cb4 92 t->ACLRecv(data,len);
BartJanssens 0:99a111b75cb4 93 USBBulkTransfer(device,0x82,data,MAX_ACL_SIZE,AclCallback,userData);
BartJanssens 0:99a111b75cb4 94 }
BartJanssens 0:99a111b75cb4 95
BartJanssens 0:99a111b75cb4 96 virtual void HCISend(const u8* data, int len)
BartJanssens 0:99a111b75cb4 97 {
BartJanssens 0:99a111b75cb4 98 USBControlTransfer(_device,REQUEST_TYPE_CLASS, 0, 0, 0,(u8*)data,len);
BartJanssens 0:99a111b75cb4 99 }
BartJanssens 0:99a111b75cb4 100
BartJanssens 0:99a111b75cb4 101 virtual void ACLSend(const u8* data, int len)
BartJanssens 0:99a111b75cb4 102 {
BartJanssens 0:99a111b75cb4 103 USBBulkTransfer(_device,0x02,(u8*)data,len);
BartJanssens 0:99a111b75cb4 104 }
BartJanssens 0:99a111b75cb4 105 };
BartJanssens 0:99a111b75cb4 106
BartJanssens 0:99a111b75cb4 107
BartJanssens 0:99a111b75cb4 108 #define WII_REMOTE 0x042500
BartJanssens 0:99a111b75cb4 109 #define PS3_REMOTE 0x080500
BartJanssens 0:99a111b75cb4 110
BartJanssens 0:99a111b75cb4 111 class HIDBluetooth
BartJanssens 0:99a111b75cb4 112 {
BartJanssens 0:99a111b75cb4 113 int _control; // Sockets for control (out) and interrupt (in)
BartJanssens 0:99a111b75cb4 114 int _interrupt;
BartJanssens 0:99a111b75cb4 115 int _devClass;
BartJanssens 0:99a111b75cb4 116 BD_ADDR _addr;
BartJanssens 0:99a111b75cb4 117 u8 _pad[2]; // Struct align
BartJanssens 0:99a111b75cb4 118 int _ready;
BartJanssens 0:99a111b75cb4 119 Timeout _timeout;
BartJanssens 0:99a111b75cb4 120 int _count;
BartJanssens 0:99a111b75cb4 121
BartJanssens 0:99a111b75cb4 122 public:
BartJanssens 0:99a111b75cb4 123 HIDBluetooth() : _control(0),_interrupt(0),_devClass(0), _ready(1) {};
BartJanssens 0:99a111b75cb4 124
BartJanssens 0:99a111b75cb4 125
BartJanssens 0:99a111b75cb4 126 bool InUse()
BartJanssens 0:99a111b75cb4 127 {
BartJanssens 0:99a111b75cb4 128 return _control != 0;
BartJanssens 0:99a111b75cb4 129 }
BartJanssens 0:99a111b75cb4 130
BartJanssens 0:99a111b75cb4 131 void attimeout()
BartJanssens 0:99a111b75cb4 132 {
BartJanssens 0:99a111b75cb4 133 printf("Timeout reached\r\n");
BartJanssens 0:99a111b75cb4 134 }
BartJanssens 0:99a111b75cb4 135
BartJanssens 0:99a111b75cb4 136 static void OnHidInterrupt(int socket, SocketState state,const u8* data, int len, void* userData)
BartJanssens 0:99a111b75cb4 137 {
BartJanssens 0:99a111b75cb4 138 HIDBluetooth* t = (HIDBluetooth*)userData;
BartJanssens 0:99a111b75cb4 139 t->_ready = 0;
BartJanssens 0:99a111b75cb4 140 if (data)
BartJanssens 0:99a111b75cb4 141 {
BartJanssens 0:99a111b75cb4 142 //printf("devClass = %06X \r\n",t->_devClass);
BartJanssens 0:99a111b75cb4 143 if (t->_devClass == WII_REMOTE && data[1] == 0x30)
BartJanssens 0:99a111b75cb4 144 {
BartJanssens 0:99a111b75cb4 145 printf("================wii====================\r\n");
BartJanssens 0:99a111b75cb4 146 t->WIILed();
BartJanssens 0:99a111b75cb4 147 t->WIIHid(); // ask for accelerometer
BartJanssens 0:99a111b75cb4 148 t->_devClass = 0;
BartJanssens 0:99a111b75cb4 149
BartJanssens 0:99a111b75cb4 150
BartJanssens 0:99a111b75cb4 151 const u8* d = data;
BartJanssens 0:99a111b75cb4 152 switch (d[1])
BartJanssens 0:99a111b75cb4 153 {
BartJanssens 0:99a111b75cb4 154 case 0x02:
BartJanssens 0:99a111b75cb4 155 {
BartJanssens 0:99a111b75cb4 156 int x = (signed char)d[3];
BartJanssens 0:99a111b75cb4 157 int y = (signed char)d[4];
BartJanssens 0:99a111b75cb4 158 printf("Mouse %2X dx:%d dy:%d\r\n",d[2],x,y);
BartJanssens 0:99a111b75cb4 159 }
BartJanssens 0:99a111b75cb4 160 break;
BartJanssens 0:99a111b75cb4 161
BartJanssens 0:99a111b75cb4 162 case 0x37: // Accelerometer http://wiki.wiimoteproject.com/Reports
BartJanssens 0:99a111b75cb4 163 {
BartJanssens 0:99a111b75cb4 164 int pad = (d[2] & 0x9F) | ((d[3] & 0x9F) << 8);
BartJanssens 0:99a111b75cb4 165 int x = (d[2] & 0x60) >> 5 | d[4] << 2;
BartJanssens 0:99a111b75cb4 166 int y = (d[3] & 0x20) >> 4 | d[5] << 2;
BartJanssens 0:99a111b75cb4 167 int z = (d[3] & 0x40) >> 5 | d[6] << 2;
BartJanssens 0:99a111b75cb4 168 printf("WII %04X %d %d %d\r\n",pad,x,y,z);
BartJanssens 0:99a111b75cb4 169 }
BartJanssens 0:99a111b75cb4 170 break;
BartJanssens 0:99a111b75cb4 171 default:
e5115026 1:b2063ffa4927 172 printHex(data,len);
BartJanssens 0:99a111b75cb4 173 }
BartJanssens 0:99a111b75cb4 174 }
BartJanssens 0:99a111b75cb4 175 if (t->_devClass == PS3_REMOTE)
BartJanssens 0:99a111b75cb4 176 {
e5115026 1:b2063ffa4927 177 /*
e5115026 1:b2063ffa4927 178 joyL_x=((ps3report*)(data+1))->LeftStickX;
e5115026 1:b2063ffa4927 179 joyL_y=((ps3report*)(data+1))->LeftStickY;
e5115026 1:b2063ffa4927 180 angle_omni=((ps3report*)(data+1))->RightStickY;
e5115026 1:b2063ffa4927 181 omni_move(joyL_x,joyL_y,angle_omni);
e5115026 1:b2063ffa4927 182 printf("\nx_global:%d\ty_global:%d\tangle:%d\t\n",joyL_x,joyL_y,angle_omni);
e5115026 1:b2063ffa4927 183
e5115026 1:b2063ffa4927 184 if(joyL_x>200){
e5115026 1:b2063ffa4927 185 led1=1;
e5115026 1:b2063ffa4927 186 }
e5115026 1:b2063ffa4927 187 else{
e5115026 1:b2063ffa4927 188 led1=0;
e5115026 1:b2063ffa4927 189 }
e5115026 1:b2063ffa4927 190 if(joyL_y>200){
e5115026 1:b2063ffa4927 191 led2=1;
e5115026 1:b2063ffa4927 192 }
e5115026 1:b2063ffa4927 193 else{
e5115026 1:b2063ffa4927 194 led2=0;
e5115026 1:b2063ffa4927 195
e5115026 1:b2063ffa4927 196 }
e5115026 1:b2063ffa4927 197 */
e5115026 1:b2063ffa4927 198
BartJanssens 0:99a111b75cb4 199 t->_count ++;
e5115026 1:b2063ffa4927 200 //if (t->_count == 25) t->_count = 1;
e5115026 1:b2063ffa4927 201 //ParsePs3Result((data + 1), sizeof(ps3report),t->_count);
BartJanssens 0:99a111b75cb4 202 }
BartJanssens 0:99a111b75cb4 203 else {
BartJanssens 0:99a111b75cb4 204 printf("Not yet implemented \r\n");
BartJanssens 0:99a111b75cb4 205
BartJanssens 0:99a111b75cb4 206 }
BartJanssens 0:99a111b75cb4 207 }
BartJanssens 0:99a111b75cb4 208
BartJanssens 0:99a111b75cb4 209 }
BartJanssens 0:99a111b75cb4 210
BartJanssens 0:99a111b75cb4 211 static void OnHidControl(int socket, SocketState state, const u8* data, int len, void* userData)
BartJanssens 0:99a111b75cb4 212 {
BartJanssens 0:99a111b75cb4 213 //HIDBluetooth* t = (HIDBluetooth*)userData;
BartJanssens 0:99a111b75cb4 214
BartJanssens 0:99a111b75cb4 215 //printf("OnHidControl\r\n");
BartJanssens 0:99a111b75cb4 216
BartJanssens 0:99a111b75cb4 217 }
BartJanssens 0:99a111b75cb4 218
BartJanssens 0:99a111b75cb4 219 static void OnAcceptCtrlSocket(int socket, SocketState state, const u8* data, int len, void* userData)
BartJanssens 0:99a111b75cb4 220 {
BartJanssens 0:99a111b75cb4 221 HIDBluetooth* t = (HIDBluetooth*)userData;
BartJanssens 0:99a111b75cb4 222
BartJanssens 0:99a111b75cb4 223 t->_control = socket;
BartJanssens 0:99a111b75cb4 224
BartJanssens 0:99a111b75cb4 225 //printf("Ctrl Socket number = %d \r\n", socket);
BartJanssens 0:99a111b75cb4 226
BartJanssens 0:99a111b75cb4 227 Socket_Accept(socket,OnHidControl,userData);
BartJanssens 0:99a111b75cb4 228 u8 enable[6] = {
BartJanssens 0:99a111b75cb4 229 0x53, /* HIDP_TRANS_SET_REPORT | HIDP_DATA_RTYPE_FEATURE */
BartJanssens 0:99a111b75cb4 230 0xf4, 0x42, 0x03, 0x00, 0x00 };
BartJanssens 0:99a111b75cb4 231 Socket_Send(socket,enable,6);
BartJanssens 0:99a111b75cb4 232
BartJanssens 0:99a111b75cb4 233
BartJanssens 0:99a111b75cb4 234 }
BartJanssens 0:99a111b75cb4 235
BartJanssens 0:99a111b75cb4 236 static void OnAcceptDataSocket(int socket, SocketState state, const u8* data, int len, void* userData)
BartJanssens 0:99a111b75cb4 237 {
BartJanssens 0:99a111b75cb4 238 HIDBluetooth* t = (HIDBluetooth*)userData;
BartJanssens 0:99a111b75cb4 239 t->_interrupt = socket;
BartJanssens 0:99a111b75cb4 240
BartJanssens 0:99a111b75cb4 241 printf("OnAcceptDataSocket: Data Socket accept here \r\n");
BartJanssens 0:99a111b75cb4 242 printf("OnAcceptDataSocket: Data Socket number = %d \r\n", socket);
BartJanssens 0:99a111b75cb4 243
BartJanssens 0:99a111b75cb4 244 //printf("OnAcceptDataSocket: Ctrl Socket = %d Data Socket accept = %d \r\n", t->_control, t->_interrupt);
BartJanssens 0:99a111b75cb4 245
BartJanssens 0:99a111b75cb4 246 Socket_Accept(socket,OnHidInterrupt,userData);
BartJanssens 0:99a111b75cb4 247
BartJanssens 0:99a111b75cb4 248 //if (data)
BartJanssens 0:99a111b75cb4 249 // printHex(data,len);
BartJanssens 0:99a111b75cb4 250 }
BartJanssens 0:99a111b75cb4 251
BartJanssens 0:99a111b75cb4 252 void Open(BD_ADDR* bdAddr, inquiry_info* info)
BartJanssens 0:99a111b75cb4 253 {
BartJanssens 0:99a111b75cb4 254 printf("L2CAPAddr size %d\r\n",sizeof(L2CAPAddr));
BartJanssens 0:99a111b75cb4 255 _addr = *bdAddr;
BartJanssens 0:99a111b75cb4 256 L2CAPAddr sockAddr;
BartJanssens 0:99a111b75cb4 257 sockAddr.bdaddr = _addr;
BartJanssens 0:99a111b75cb4 258 sockAddr.psm = L2CAP_PSM_HID_INTR;
BartJanssens 0:99a111b75cb4 259 printf("Socket_Open size %d\r\n",sizeof(L2CAPAddr));
BartJanssens 0:99a111b75cb4 260 _interrupt = Socket_Open(SOCKET_L2CAP,&sockAddr.hdr,OnHidInterrupt,this);
BartJanssens 0:99a111b75cb4 261 sockAddr.psm = L2CAP_PSM_HID_CNTL;
BartJanssens 0:99a111b75cb4 262 _control = Socket_Open(SOCKET_L2CAP,&sockAddr.hdr,OnHidControl,this);
BartJanssens 0:99a111b75cb4 263
BartJanssens 0:99a111b75cb4 264 printfBytes("OPEN DEVICE CLASS",info->dev_class,3);
BartJanssens 0:99a111b75cb4 265 _devClass = (info->dev_class[0] << 16) | (info->dev_class[1] << 8) | info->dev_class[2];
BartJanssens 0:99a111b75cb4 266 }
BartJanssens 0:99a111b75cb4 267
BartJanssens 0:99a111b75cb4 268 void Listen(BD_ADDR* bdAddr, inquiry_info* info)
BartJanssens 0:99a111b75cb4 269 {
BartJanssens 0:99a111b75cb4 270 int result;
BartJanssens 0:99a111b75cb4 271 //printf("L2CAPAddr size %d\r\n",sizeof(L2CAPAddr));
BartJanssens 0:99a111b75cb4 272 _addr = *bdAddr;
BartJanssens 0:99a111b75cb4 273 L2CAPAddr sockAddr;
BartJanssens 0:99a111b75cb4 274 sockAddr.bdaddr = _addr;
BartJanssens 0:99a111b75cb4 275
BartJanssens 0:99a111b75cb4 276 _count = 1;
BartJanssens 0:99a111b75cb4 277 _ready = 1;
BartJanssens 0:99a111b75cb4 278
BartJanssens 0:99a111b75cb4 279 // set a buffer for the led&rumble report
BartJanssens 0:99a111b75cb4 280 u8 abuffer[37] = {
BartJanssens 0:99a111b75cb4 281 0x52, /* HIDP_TRANS_SET_REPORT | HIDP_DATA_RTYPE_OUTPUT */
BartJanssens 0:99a111b75cb4 282 0x01,
BartJanssens 0:99a111b75cb4 283 0x00, 0x00, 0x00, 0x00, 0x00,
BartJanssens 0:99a111b75cb4 284 0x00, 0x00, 0x00, 0x00, 0x1E,
BartJanssens 0:99a111b75cb4 285 0xff, 0x27, 0x10, 0x00, 0x32,
BartJanssens 0:99a111b75cb4 286 0xff, 0x27, 0x10, 0x00, 0x32,
BartJanssens 0:99a111b75cb4 287 0xff, 0x27, 0x10, 0x00, 0x32,
BartJanssens 0:99a111b75cb4 288 0xff, 0x27, 0x10, 0x00, 0x32,
BartJanssens 0:99a111b75cb4 289 0x00, 0x00, 0x00, 0x00, 0x00,
BartJanssens 0:99a111b75cb4 290 };
BartJanssens 0:99a111b75cb4 291 memcpy(_ledrumble,abuffer,37);
BartJanssens 0:99a111b75cb4 292
BartJanssens 0:99a111b75cb4 293 result = Socket_Listen(SOCKET_L2CAP,L2CAP_PSM_HID_CNTL,OnAcceptCtrlSocket,this);
BartJanssens 0:99a111b75cb4 294 printf("listen return code ctrl socket = %d \r\n", result);
BartJanssens 0:99a111b75cb4 295
BartJanssens 0:99a111b75cb4 296
BartJanssens 0:99a111b75cb4 297 result = Socket_Listen(SOCKET_L2CAP,L2CAP_PSM_HID_INTR,OnAcceptDataSocket,this);
BartJanssens 0:99a111b75cb4 298 printf("listen return code data socket = %d \r\n", result);
BartJanssens 0:99a111b75cb4 299
BartJanssens 0:99a111b75cb4 300 printfBytes("OPEN DEVICE CLASS",info->dev_class,3);
BartJanssens 0:99a111b75cb4 301 _devClass = (info->dev_class[0] << 16) | (info->dev_class[1] << 8) | info->dev_class[2];
BartJanssens 0:99a111b75cb4 302
BartJanssens 0:99a111b75cb4 303 while (_ready){ // wait till we receive data from PS3Hid
BartJanssens 0:99a111b75cb4 304 USBLoop();
BartJanssens 0:99a111b75cb4 305 }
BartJanssens 0:99a111b75cb4 306 USBLoop();
BartJanssens 0:99a111b75cb4 307
BartJanssens 0:99a111b75cb4 308
BartJanssens 0:99a111b75cb4 309
BartJanssens 0:99a111b75cb4 310 }
BartJanssens 0:99a111b75cb4 311
BartJanssens 0:99a111b75cb4 312 void Close()
BartJanssens 0:99a111b75cb4 313 {
BartJanssens 0:99a111b75cb4 314 if (_control)
BartJanssens 0:99a111b75cb4 315 Socket_Close(_control);
BartJanssens 0:99a111b75cb4 316 if (_interrupt)
BartJanssens 0:99a111b75cb4 317 Socket_Close(_interrupt);
BartJanssens 0:99a111b75cb4 318 _control = _interrupt = 0;
BartJanssens 0:99a111b75cb4 319 }
BartJanssens 0:99a111b75cb4 320
BartJanssens 0:99a111b75cb4 321 void WIILed(int id = 0x10)
BartJanssens 0:99a111b75cb4 322 {
BartJanssens 0:99a111b75cb4 323 u8 led[3] = {0x52, 0x11, id};
BartJanssens 0:99a111b75cb4 324 if (_control)
BartJanssens 0:99a111b75cb4 325 Socket_Send(_control,led,3);
BartJanssens 0:99a111b75cb4 326 }
BartJanssens 0:99a111b75cb4 327
BartJanssens 0:99a111b75cb4 328 void WIIHid(int report = 0x37)
BartJanssens 0:99a111b75cb4 329 {
BartJanssens 0:99a111b75cb4 330 u8 hid[4] = { 0x52, 0x12, 0x00, report };
BartJanssens 0:99a111b75cb4 331 if (_control != -1)
BartJanssens 0:99a111b75cb4 332 Socket_Send(_control,hid,4);
BartJanssens 0:99a111b75cb4 333 }
BartJanssens 0:99a111b75cb4 334
BartJanssens 0:99a111b75cb4 335
BartJanssens 0:99a111b75cb4 336
BartJanssens 0:99a111b75cb4 337 void Ps3Hid_Led(int i)
BartJanssens 0:99a111b75cb4 338 {
BartJanssens 0:99a111b75cb4 339 printf("Ps3Hid led %d\r\n",i);
BartJanssens 0:99a111b75cb4 340 u8 ledpattern[7] = {0x02, 0x04, 0x08, 0x10, 0x12, 0x14, 0x18 };
BartJanssens 0:99a111b75cb4 341 u8 buf[37];
BartJanssens 0:99a111b75cb4 342
BartJanssens 0:99a111b75cb4 343 if (i < 7) _ledrumble[11] = ledpattern[i];
BartJanssens 0:99a111b75cb4 344 memcpy(buf, _ledrumble, 37);
BartJanssens 0:99a111b75cb4 345
BartJanssens 0:99a111b75cb4 346 if (_control != -1)
BartJanssens 0:99a111b75cb4 347 Socket_Send(_control,buf,37);
BartJanssens 0:99a111b75cb4 348 wait_ms(4);
BartJanssens 0:99a111b75cb4 349 }
BartJanssens 0:99a111b75cb4 350
BartJanssens 0:99a111b75cb4 351 void Ps3Hid_Rumble(u8 duration_right, u8 power_right, u8 duration_left, u8 power_left )
BartJanssens 0:99a111b75cb4 352 {
BartJanssens 0:99a111b75cb4 353 printf("Ps3Hid rumble \r\n");
BartJanssens 0:99a111b75cb4 354 u8 buf[37];
BartJanssens 0:99a111b75cb4 355
BartJanssens 0:99a111b75cb4 356 memcpy(buf, _ledrumble, 37);
BartJanssens 0:99a111b75cb4 357 buf[3] = duration_right;
BartJanssens 0:99a111b75cb4 358 buf[4] = power_right;
BartJanssens 0:99a111b75cb4 359 buf[5] = duration_left;
BartJanssens 0:99a111b75cb4 360 buf[6] = power_left;
BartJanssens 0:99a111b75cb4 361
BartJanssens 0:99a111b75cb4 362 if (_control != -1)
BartJanssens 0:99a111b75cb4 363 Socket_Send(_control,buf,37);
BartJanssens 0:99a111b75cb4 364 wait_ms(4);
BartJanssens 0:99a111b75cb4 365 }
BartJanssens 0:99a111b75cb4 366
BartJanssens 0:99a111b75cb4 367 int CheckHID()
BartJanssens 0:99a111b75cb4 368 {
BartJanssens 0:99a111b75cb4 369 printf("CheckHID \r\n");
BartJanssens 0:99a111b75cb4 370 printf("Ctrl = %d Intr = %d \r\n", _control, _interrupt);
BartJanssens 0:99a111b75cb4 371 if (_control < 1) {
BartJanssens 0:99a111b75cb4 372 printf("Ps3 not ready \r\n");
BartJanssens 0:99a111b75cb4 373 return 1;
BartJanssens 0:99a111b75cb4 374 } else {
BartJanssens 0:99a111b75cb4 375 printf("Ps3 ready %d \r\n",_control);
BartJanssens 0:99a111b75cb4 376 return 0;
BartJanssens 0:99a111b75cb4 377 }
BartJanssens 0:99a111b75cb4 378 }
BartJanssens 0:99a111b75cb4 379 private:
BartJanssens 0:99a111b75cb4 380 u8 _ledrumble[37] ;
BartJanssens 0:99a111b75cb4 381 };
BartJanssens 0:99a111b75cb4 382
BartJanssens 0:99a111b75cb4 383
BartJanssens 0:99a111b75cb4 384 HCI* gHCI = 0;
BartJanssens 0:99a111b75cb4 385
BartJanssens 0:99a111b75cb4 386 #define MAX_HID_DEVICES 8
BartJanssens 0:99a111b75cb4 387
BartJanssens 0:99a111b75cb4 388 int GetConsoleChar();
BartJanssens 0:99a111b75cb4 389 class ShellApp
BartJanssens 0:99a111b75cb4 390 {
BartJanssens 0:99a111b75cb4 391 char _line[64];
BartJanssens 0:99a111b75cb4 392 HIDBluetooth _hids[MAX_HID_DEVICES];
BartJanssens 0:99a111b75cb4 393
BartJanssens 0:99a111b75cb4 394 public:
BartJanssens 0:99a111b75cb4 395 void Ready()
BartJanssens 0:99a111b75cb4 396 {
BartJanssens 0:99a111b75cb4 397 printf("HIDBluetooth %d\r\n",sizeof(HIDBluetooth));
BartJanssens 0:99a111b75cb4 398 memset(_hids,0,sizeof(_hids));
BartJanssens 0:99a111b75cb4 399 //Inquiry();
BartJanssens 0:99a111b75cb4 400 Scan();
BartJanssens 0:99a111b75cb4 401 }
BartJanssens 0:99a111b75cb4 402
BartJanssens 0:99a111b75cb4 403 // We have connected to a device
BartJanssens 0:99a111b75cb4 404 void ConnectionComplete(HCI* hci, connection_info* info)
BartJanssens 0:99a111b75cb4 405 {
BartJanssens 0:99a111b75cb4 406 printf("ConnectionComplete ");
BartJanssens 0:99a111b75cb4 407 BD_ADDR* a = &info->bdaddr;
BartJanssens 0:99a111b75cb4 408 printf(a);
BartJanssens 0:99a111b75cb4 409 BTDevice* bt = hci->Find(a);
BartJanssens 0:99a111b75cb4 410 HIDBluetooth* hid = NewHIDBluetooth();
BartJanssens 0:99a111b75cb4 411 printf("%08x %08x\r\n",bt,hid);
BartJanssens 0:99a111b75cb4 412 if (hid)
BartJanssens 0:99a111b75cb4 413 hid->Listen(a,&bt->_info); // use Listen for PS3, Open for WII
BartJanssens 0:99a111b75cb4 414 hid->Ps3Hid_Led(0); // set led 1
BartJanssens 0:99a111b75cb4 415 hid->Ps3Hid_Rumble(0x20,0xff,0x20,0xff); // rumble
BartJanssens 0:99a111b75cb4 416
BartJanssens 0:99a111b75cb4 417 }
BartJanssens 0:99a111b75cb4 418
BartJanssens 0:99a111b75cb4 419 HIDBluetooth* NewHIDBluetooth()
BartJanssens 0:99a111b75cb4 420 {
BartJanssens 0:99a111b75cb4 421 for (int i = 0; i < MAX_HID_DEVICES; i++)
BartJanssens 0:99a111b75cb4 422 if (!_hids[i].InUse())
BartJanssens 0:99a111b75cb4 423 return _hids+i;
BartJanssens 0:99a111b75cb4 424 return 0;
BartJanssens 0:99a111b75cb4 425 }
BartJanssens 0:99a111b75cb4 426
BartJanssens 0:99a111b75cb4 427 void ConnectDevices()
BartJanssens 0:99a111b75cb4 428 {
BartJanssens 0:99a111b75cb4 429 BTDevice* devs[8];
BartJanssens 0:99a111b75cb4 430 int count = gHCI->GetDevices(devs,8);
BartJanssens 0:99a111b75cb4 431 for (int i = 0; i < count; i++)
BartJanssens 0:99a111b75cb4 432 {
BartJanssens 0:99a111b75cb4 433 printfBytes("DEVICE CLASS",devs[i]->_info.dev_class,3);
BartJanssens 0:99a111b75cb4 434 if (devs[i]->_handle == 0)
BartJanssens 0:99a111b75cb4 435 {
BartJanssens 0:99a111b75cb4 436 BD_ADDR* bd = &devs[i]->_info.bdaddr;
BartJanssens 0:99a111b75cb4 437 printf("Connecting to ");
BartJanssens 0:99a111b75cb4 438 printf(bd);
BartJanssens 0:99a111b75cb4 439 printf("\r\n");
BartJanssens 0:99a111b75cb4 440 gHCI->CreateConnection(bd);
BartJanssens 0:99a111b75cb4 441 }
BartJanssens 0:99a111b75cb4 442 }
BartJanssens 0:99a111b75cb4 443 }
BartJanssens 0:99a111b75cb4 444
BartJanssens 0:99a111b75cb4 445 const char* ReadLine()
BartJanssens 0:99a111b75cb4 446 {
BartJanssens 0:99a111b75cb4 447 int i;
BartJanssens 0:99a111b75cb4 448 for (i = 0; i < 255; )
BartJanssens 0:99a111b75cb4 449 {
BartJanssens 0:99a111b75cb4 450 USBLoop();
BartJanssens 0:99a111b75cb4 451 int c = GetConsoleChar();
BartJanssens 0:99a111b75cb4 452 if (c == -1)
BartJanssens 0:99a111b75cb4 453 continue;
BartJanssens 0:99a111b75cb4 454 if (c == '\n' || c == 13)
BartJanssens 0:99a111b75cb4 455 break;
BartJanssens 0:99a111b75cb4 456 _line[i++] = c;
BartJanssens 0:99a111b75cb4 457 }
BartJanssens 0:99a111b75cb4 458 _line[i] = 0;
BartJanssens 0:99a111b75cb4 459 return _line;
BartJanssens 0:99a111b75cb4 460 }
BartJanssens 0:99a111b75cb4 461
BartJanssens 0:99a111b75cb4 462 void Inquiry()
BartJanssens 0:99a111b75cb4 463 {
BartJanssens 0:99a111b75cb4 464 printf("Inquiry..\r\n");
BartJanssens 0:99a111b75cb4 465 gHCI->Inquiry();
BartJanssens 0:99a111b75cb4 466 }
BartJanssens 0:99a111b75cb4 467
BartJanssens 0:99a111b75cb4 468 void List()
BartJanssens 0:99a111b75cb4 469 {
BartJanssens 0:99a111b75cb4 470 #if 0
BartJanssens 0:99a111b75cb4 471 printf("%d devices\r\n",_deviceCount);
BartJanssens 0:99a111b75cb4 472 for (int i = 0; i < _deviceCount; i++)
BartJanssens 0:99a111b75cb4 473 {
BartJanssens 0:99a111b75cb4 474 printf(&_devices[i].info.bdaddr);
BartJanssens 0:99a111b75cb4 475 printf("\r\n");
BartJanssens 0:99a111b75cb4 476 }
BartJanssens 0:99a111b75cb4 477 #endif
BartJanssens 0:99a111b75cb4 478 }
BartJanssens 0:99a111b75cb4 479
BartJanssens 0:99a111b75cb4 480 void Scan()
BartJanssens 0:99a111b75cb4 481 {
BartJanssens 0:99a111b75cb4 482 printf("Scanning...\r\n");
BartJanssens 0:99a111b75cb4 483 gHCI->WriteScanEnable();
BartJanssens 0:99a111b75cb4 484 }
BartJanssens 0:99a111b75cb4 485
BartJanssens 0:99a111b75cb4 486 void Connect()
BartJanssens 0:99a111b75cb4 487 {
BartJanssens 0:99a111b75cb4 488 ConnectDevices();
BartJanssens 0:99a111b75cb4 489 }
BartJanssens 0:99a111b75cb4 490
BartJanssens 0:99a111b75cb4 491
BartJanssens 0:99a111b75cb4 492 void Disconnect()
BartJanssens 0:99a111b75cb4 493 {
BartJanssens 0:99a111b75cb4 494 gHCI->DisconnectAll();
BartJanssens 0:99a111b75cb4 495 }
BartJanssens 0:99a111b75cb4 496
BartJanssens 0:99a111b75cb4 497 void CloseMouse()
BartJanssens 0:99a111b75cb4 498 {
BartJanssens 0:99a111b75cb4 499 }
BartJanssens 0:99a111b75cb4 500
BartJanssens 0:99a111b75cb4 501 void Quit()
BartJanssens 0:99a111b75cb4 502 {
BartJanssens 0:99a111b75cb4 503 CloseMouse();
BartJanssens 0:99a111b75cb4 504 }
BartJanssens 0:99a111b75cb4 505
BartJanssens 0:99a111b75cb4 506 void Run()
BartJanssens 0:99a111b75cb4 507 {
BartJanssens 0:99a111b75cb4 508 for(;;)
BartJanssens 0:99a111b75cb4 509 {
BartJanssens 0:99a111b75cb4 510 const char* cmd = ReadLine();
BartJanssens 0:99a111b75cb4 511 if (strcmp(cmd,"scan") == 0 || strcmp(cmd,"inquiry") == 0)
BartJanssens 0:99a111b75cb4 512 Inquiry();
BartJanssens 0:99a111b75cb4 513 else if (strcmp(cmd,"ls") == 0)
BartJanssens 0:99a111b75cb4 514 List();
BartJanssens 0:99a111b75cb4 515 else if (strcmp(cmd,"connect") == 0)
BartJanssens 0:99a111b75cb4 516 Connect();
BartJanssens 0:99a111b75cb4 517 else if (strcmp(cmd,"disconnect") == 0)
BartJanssens 0:99a111b75cb4 518 Disconnect();
BartJanssens 0:99a111b75cb4 519 else if (strcmp(cmd,"q")== 0)
BartJanssens 0:99a111b75cb4 520 {
BartJanssens 0:99a111b75cb4 521 Quit();
BartJanssens 0:99a111b75cb4 522 break;
BartJanssens 0:99a111b75cb4 523 } else {
BartJanssens 0:99a111b75cb4 524 printf("eh? %s\r\n",cmd);
BartJanssens 0:99a111b75cb4 525 }
BartJanssens 0:99a111b75cb4 526 }
BartJanssens 0:99a111b75cb4 527 }
BartJanssens 0:99a111b75cb4 528 };
BartJanssens 0:99a111b75cb4 529
BartJanssens 0:99a111b75cb4 530 // Instance
BartJanssens 0:99a111b75cb4 531 ShellApp gApp;
BartJanssens 0:99a111b75cb4 532
BartJanssens 0:99a111b75cb4 533 static int HciCallback(HCI* hci, HCI_CALLBACK_EVENT evt, const u8* data, int len)
BartJanssens 0:99a111b75cb4 534 {
BartJanssens 0:99a111b75cb4 535 switch (evt)
BartJanssens 0:99a111b75cb4 536 {
BartJanssens 0:99a111b75cb4 537 case CALLBACK_READY:
BartJanssens 0:99a111b75cb4 538 printf("CALLBACK_READY\r\n");
BartJanssens 0:99a111b75cb4 539 gApp.Ready();
BartJanssens 0:99a111b75cb4 540 break;
BartJanssens 0:99a111b75cb4 541
BartJanssens 0:99a111b75cb4 542 case CALLBACK_INQUIRY_RESULT:
BartJanssens 0:99a111b75cb4 543 printf("CALLBACK_INQUIRY_RESULT ");
BartJanssens 0:99a111b75cb4 544 printf((BD_ADDR*)data);
BartJanssens 0:99a111b75cb4 545 printf("\r\n");
BartJanssens 0:99a111b75cb4 546 break;
BartJanssens 0:99a111b75cb4 547
BartJanssens 0:99a111b75cb4 548 case CALLBACK_INQUIRY_DONE:
BartJanssens 0:99a111b75cb4 549 printf("CALLBACK_INQUIRY_DONE\r\n");
BartJanssens 0:99a111b75cb4 550 gApp.ConnectDevices();
BartJanssens 0:99a111b75cb4 551 break;
BartJanssens 0:99a111b75cb4 552
BartJanssens 0:99a111b75cb4 553 case CALLBACK_REMOTE_NAME:
BartJanssens 0:99a111b75cb4 554 {
BartJanssens 0:99a111b75cb4 555 BD_ADDR* addr = (BD_ADDR*)data;
BartJanssens 0:99a111b75cb4 556 const char* name = (const char*)(data + 6);
BartJanssens 0:99a111b75cb4 557 printf(addr);
BartJanssens 0:99a111b75cb4 558 printf(" % s\r\n",name);
BartJanssens 0:99a111b75cb4 559 }
BartJanssens 0:99a111b75cb4 560 break;
BartJanssens 0:99a111b75cb4 561
BartJanssens 0:99a111b75cb4 562 case CALLBACK_CONNECTION_COMPLETE:
BartJanssens 0:99a111b75cb4 563 gApp.ConnectionComplete(hci,(connection_info*)data);
BartJanssens 0:99a111b75cb4 564 break;
BartJanssens 0:99a111b75cb4 565 };
BartJanssens 0:99a111b75cb4 566 return 0;
BartJanssens 0:99a111b75cb4 567 }
BartJanssens 0:99a111b75cb4 568
BartJanssens 0:99a111b75cb4 569 // these should be placed in the DMA SRAM
BartJanssens 0:99a111b75cb4 570 typedef struct
BartJanssens 0:99a111b75cb4 571 {
BartJanssens 0:99a111b75cb4 572 u8 _hciBuffer[MAX_HCL_SIZE];
BartJanssens 0:99a111b75cb4 573 u8 _aclBuffer[MAX_ACL_SIZE];
BartJanssens 0:99a111b75cb4 574 } SRAMPlacement;
BartJanssens 0:99a111b75cb4 575
BartJanssens 0:99a111b75cb4 576 HCITransportUSB _HCITransportUSB;
BartJanssens 0:99a111b75cb4 577 HCI _HCI;
BartJanssens 0:99a111b75cb4 578
BartJanssens 0:99a111b75cb4 579 u8* USBGetBuffer(u32* len);
BartJanssens 0:99a111b75cb4 580 int OnBluetoothInsert(int device)
BartJanssens 0:99a111b75cb4 581 {
BartJanssens 0:99a111b75cb4 582 printf("Bluetooth inserted of %d\r\n",device);
BartJanssens 0:99a111b75cb4 583 u32 sramLen;
BartJanssens 0:99a111b75cb4 584 u8* sram = USBGetBuffer(&sramLen);
BartJanssens 0:99a111b75cb4 585 sram = (u8*)(((u32)sram + 1023) & ~1023);
BartJanssens 0:99a111b75cb4 586 SRAMPlacement* s = (SRAMPlacement*)sram;
BartJanssens 0:99a111b75cb4 587 _HCITransportUSB.Open(device,s->_hciBuffer,s->_aclBuffer);
BartJanssens 0:99a111b75cb4 588 _HCI.Open(&_HCITransportUSB,HciCallback);
BartJanssens 0:99a111b75cb4 589 RegisterSocketHandler(SOCKET_L2CAP,&_HCI);
BartJanssens 0:99a111b75cb4 590 gHCI = &_HCI;
BartJanssens 0:99a111b75cb4 591 //gApp.Inquiry();
BartJanssens 0:99a111b75cb4 592 //gApp.Scan();
BartJanssens 0:99a111b75cb4 593 gApp.Connect();
BartJanssens 0:99a111b75cb4 594 return 0;
BartJanssens 0:99a111b75cb4 595 }
BartJanssens 0:99a111b75cb4 596
BartJanssens 0:99a111b75cb4 597 void TestShell()
BartJanssens 0:99a111b75cb4 598 {
BartJanssens 0:99a111b75cb4 599 USBInit();
BartJanssens 0:99a111b75cb4 600 gApp.Run();
BartJanssens 0:99a111b75cb4 601 }