hokuto Abe / Mbed 2 deprecated nisiBlutooth

TestShell.cpp@0:db1ba09e8bfa, 2012-07-10 (annotated)

Committer:
hosei2
Date:
Tue Jul 10 11:36:47 2012 +0000
Revision:
0:db1ba09e8bfa
zzz

Who changed what in which revision?

UserRevisionLine numberNew contents of line
hosei2 0:db1ba09e8bfa 1
hosei2 0:db1ba09e8bfa 2 /*
hosei2 0:db1ba09e8bfa 3 Copyright (c) 2010 Peter Barrett
hosei2 0:db1ba09e8bfa 4
hosei2 0:db1ba09e8bfa 5 Permission is hereby granted, free of charge, to any person obtaining a copy
hosei2 0:db1ba09e8bfa 6 of this software and associated documentation files (the "Software"), to deal
hosei2 0:db1ba09e8bfa 7 in the Software without restriction, including without limitation the rights
hosei2 0:db1ba09e8bfa 8 to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
hosei2 0:db1ba09e8bfa 9 copies of the Software, and to permit persons to whom the Software is
hosei2 0:db1ba09e8bfa 10 furnished to do so, subject to the following conditions:
hosei2 0:db1ba09e8bfa 11
hosei2 0:db1ba09e8bfa 12 The above copyright notice and this permission notice shall be included in
hosei2 0:db1ba09e8bfa 13 all copies or substantial portions of the Software.
hosei2 0:db1ba09e8bfa 14
hosei2 0:db1ba09e8bfa 15 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
hosei2 0:db1ba09e8bfa 16 IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
hosei2 0:db1ba09e8bfa 17 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
hosei2 0:db1ba09e8bfa 18 AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
hosei2 0:db1ba09e8bfa 19 LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
hosei2 0:db1ba09e8bfa 20 OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
hosei2 0:db1ba09e8bfa 21 THE SOFTWARE.
hosei2 0:db1ba09e8bfa 22 */
hosei2 0:db1ba09e8bfa 23
hosei2 0:db1ba09e8bfa 24 #include <stdio.h>
hosei2 0:db1ba09e8bfa 25 #include <stdlib.h>
hosei2 0:db1ba09e8bfa 26 #include <stdio.h>
hosei2 0:db1ba09e8bfa 27 #include <string.h>
hosei2 0:db1ba09e8bfa 28
hosei2 0:db1ba09e8bfa 29 #include "Utils.h"
hosei2 0:db1ba09e8bfa 30 #include "USBHost.h"
hosei2 0:db1ba09e8bfa 31 #include "hci.h"
hosei2 0:db1ba09e8bfa 32 #include "mbed.h"
hosei2 0:db1ba09e8bfa 33
hosei2 0:db1ba09e8bfa 34 DigitalOut L1(LED1);
hosei2 0:db1ba09e8bfa 35 DigitalOut L2(LED2);
hosei2 0:db1ba09e8bfa 36
hosei2 0:db1ba09e8bfa 37 void printf(const BD_ADDR* addr)
hosei2 0:db1ba09e8bfa 38 {
hosei2 0:db1ba09e8bfa 39 const u8* a = addr->addr;
hosei2 0:db1ba09e8bfa 40 printf("%02X:%02X:%02X:%02X:%02X:%02X",a[5],a[4],a[3],a[2],a[1],a[0]);
hosei2 0:db1ba09e8bfa 41 }
hosei2 0:db1ba09e8bfa 42
hosei2 0:db1ba09e8bfa 43 #define MAX_HCL_SIZE 260
hosei2 0:db1ba09e8bfa 44 #define MAX_ACL_SIZE 400
hosei2 0:db1ba09e8bfa 45
hosei2 0:db1ba09e8bfa 46 class HCITransportUSB : public HCITransport
hosei2 0:db1ba09e8bfa 47 {
hosei2 0:db1ba09e8bfa 48 int _device;
hosei2 0:db1ba09e8bfa 49 u8* _hciBuffer;
hosei2 0:db1ba09e8bfa 50 u8* _aclBuffer;
hosei2 0:db1ba09e8bfa 51
hosei2 0:db1ba09e8bfa 52 public:
hosei2 0:db1ba09e8bfa 53 void Open(int device, u8* hciBuffer, u8* aclBuffer)
hosei2 0:db1ba09e8bfa 54 {
hosei2 0:db1ba09e8bfa 55 _device = device;
hosei2 0:db1ba09e8bfa 56 _hciBuffer = hciBuffer;
hosei2 0:db1ba09e8bfa 57 _aclBuffer = aclBuffer;
hosei2 0:db1ba09e8bfa 58 USBInterruptTransfer(_device,0x81,_hciBuffer,MAX_HCL_SIZE,HciCallback,this);
hosei2 0:db1ba09e8bfa 59 USBBulkTransfer(_device,0x82,_aclBuffer,MAX_ACL_SIZE,AclCallback,this);
hosei2 0:db1ba09e8bfa 60 }
hosei2 0:db1ba09e8bfa 61
hosei2 0:db1ba09e8bfa 62 static void HciCallback(int device, int endpoint, int status, u8* data, int len, void* userData)
hosei2 0:db1ba09e8bfa 63 {
hosei2 0:db1ba09e8bfa 64 HCI* t = ((HCITransportUSB*)userData)->_target;
hosei2 0:db1ba09e8bfa 65 if (t)
hosei2 0:db1ba09e8bfa 66 t->HCIRecv(data,len);
hosei2 0:db1ba09e8bfa 67 USBInterruptTransfer(device,0x81,data,MAX_HCL_SIZE,HciCallback,userData);
hosei2 0:db1ba09e8bfa 68 }
hosei2 0:db1ba09e8bfa 69
hosei2 0:db1ba09e8bfa 70 static void AclCallback(int device, int endpoint, int status, u8* data, int len, void* userData)
hosei2 0:db1ba09e8bfa 71 {
hosei2 0:db1ba09e8bfa 72 HCI* t = ((HCITransportUSB*)userData)->_target;
hosei2 0:db1ba09e8bfa 73 if (t)
hosei2 0:db1ba09e8bfa 74 t->ACLRecv(data,len);
hosei2 0:db1ba09e8bfa 75 USBBulkTransfer(device,0x82,data,MAX_ACL_SIZE,AclCallback,userData);
hosei2 0:db1ba09e8bfa 76 }
hosei2 0:db1ba09e8bfa 77
hosei2 0:db1ba09e8bfa 78 virtual void HCISend(const u8* data, int len)
hosei2 0:db1ba09e8bfa 79 {
hosei2 0:db1ba09e8bfa 80 USBControlTransfer(_device,REQUEST_TYPE_CLASS, 0, 0, 0,(u8*)data,len);
hosei2 0:db1ba09e8bfa 81 }
hosei2 0:db1ba09e8bfa 82
hosei2 0:db1ba09e8bfa 83 virtual void ACLSend(const u8* data, int len)
hosei2 0:db1ba09e8bfa 84 {
hosei2 0:db1ba09e8bfa 85 USBBulkTransfer(_device,0x02,(u8*)data,len);
hosei2 0:db1ba09e8bfa 86 }
hosei2 0:db1ba09e8bfa 87 };
hosei2 0:db1ba09e8bfa 88
hosei2 0:db1ba09e8bfa 89
hosei2 0:db1ba09e8bfa 90 #define WII_REMOTE 0x042500
hosei2 0:db1ba09e8bfa 91
hosei2 0:db1ba09e8bfa 92 class HIDBluetooth
hosei2 0:db1ba09e8bfa 93 {
hosei2 0:db1ba09e8bfa 94 int _control; // Sockets for control (out) and interrupt (in)
hosei2 0:db1ba09e8bfa 95 int _interrupt;
hosei2 0:db1ba09e8bfa 96 int _devClass;
hosei2 0:db1ba09e8bfa 97 BD_ADDR _addr;
hosei2 0:db1ba09e8bfa 98 u8 _pad[2]; // Struct align
hosei2 0:db1ba09e8bfa 99
hosei2 0:db1ba09e8bfa 100 public:
hosei2 0:db1ba09e8bfa 101 HIDBluetooth() : _control(0),_interrupt(0),_devClass(0) {};
hosei2 0:db1ba09e8bfa 102
hosei2 0:db1ba09e8bfa 103 bool InUse()
hosei2 0:db1ba09e8bfa 104 {
hosei2 0:db1ba09e8bfa 105 return _control != 0;
hosei2 0:db1ba09e8bfa 106 }
hosei2 0:db1ba09e8bfa 107
hosei2 0:db1ba09e8bfa 108 static void OnHidInterrupt(int socket, SocketState state, const u8* data, int len, void* userData)
hosei2 0:db1ba09e8bfa 109 {
hosei2 0:db1ba09e8bfa 110 HIDBluetooth* t = (HIDBluetooth*)userData;
hosei2 0:db1ba09e8bfa 111 if (data)
hosei2 0:db1ba09e8bfa 112 {
hosei2 0:db1ba09e8bfa 113 if (t->_devClass == WII_REMOTE && data[1] == 0x30)
hosei2 0:db1ba09e8bfa 114 {
hosei2 0:db1ba09e8bfa 115 printf("================wii====================\n");
hosei2 0:db1ba09e8bfa 116 t->Led();
hosei2 0:db1ba09e8bfa 117 t->Hid(); // ask for accelerometer
hosei2 0:db1ba09e8bfa 118 t->_devClass = 0;
hosei2 0:db1ba09e8bfa 119 }
hosei2 0:db1ba09e8bfa 120
hosei2 0:db1ba09e8bfa 121 const u8* d = data;
hosei2 0:db1ba09e8bfa 122 switch (d[1])
hosei2 0:db1ba09e8bfa 123 {
hosei2 0:db1ba09e8bfa 124 case 0x02:
hosei2 0:db1ba09e8bfa 125 {
hosei2 0:db1ba09e8bfa 126 int x = (signed char)d[3];
hosei2 0:db1ba09e8bfa 127 int y = (signed char)d[4];
hosei2 0:db1ba09e8bfa 128 printf("Mouse %2X dx:%d dy:%d\n",d[2],x,y);
hosei2 0:db1ba09e8bfa 129 }
hosei2 0:db1ba09e8bfa 130 break;
hosei2 0:db1ba09e8bfa 131
hosei2 0:db1ba09e8bfa 132 case 0x37: // Accelerometer http://wiki.wiimoteproject.com/Reports
hosei2 0:db1ba09e8bfa 133 {
hosei2 0:db1ba09e8bfa 134 int pad = (d[2] & 0x9F) | ((d[3] & 0x9F) << 8);
hosei2 0:db1ba09e8bfa 135 int x = (d[2] & 0x60) >> 5 | d[4] << 2;
hosei2 0:db1ba09e8bfa 136 int y = (d[3] & 0x20) >> 4 | d[5] << 2;
hosei2 0:db1ba09e8bfa 137 int z = (d[3] & 0x40) >> 5 | d[6] << 2;
hosei2 0:db1ba09e8bfa 138 printf("WII %04X %d %d %d\n",pad,x,y,z);
hosei2 0:db1ba09e8bfa 139
hosei2 0:db1ba09e8bfa 140 /////////////////////////////////////////////////////////////////////////////////////////////////////////
hosei2 0:db1ba09e8bfa 141 L1 = (pad & 0x0800);
hosei2 0:db1ba09e8bfa 142 wait (0.1);
hosei2 0:db1ba09e8bfa 143 /////////////////////////////////////////////////////////////////////////////////////////////////////////
hosei2 0:db1ba09e8bfa 144 }
hosei2 0:db1ba09e8bfa 145 break;
hosei2 0:db1ba09e8bfa 146 default:
hosei2 0:db1ba09e8bfa 147 printHex(data,len);
hosei2 0:db1ba09e8bfa 148 }
hosei2 0:db1ba09e8bfa 149 }
hosei2 0:db1ba09e8bfa 150 }
hosei2 0:db1ba09e8bfa 151
hosei2 0:db1ba09e8bfa 152 static void OnHidControl(int socket, SocketState state, const u8* data, int len, void* userData)
hosei2 0:db1ba09e8bfa 153 {
hosei2 0:db1ba09e8bfa 154 printf("OnHidControl\n");
hosei2 0:db1ba09e8bfa 155 if (data)
hosei2 0:db1ba09e8bfa 156 printHex(data,len);
hosei2 0:db1ba09e8bfa 157 }
hosei2 0:db1ba09e8bfa 158
hosei2 0:db1ba09e8bfa 159 void Open(BD_ADDR* bdAddr, inquiry_info* info)
hosei2 0:db1ba09e8bfa 160 {
hosei2 0:db1ba09e8bfa 161 printf("L2CAPAddr size %d\n",sizeof(L2CAPAddr));
hosei2 0:db1ba09e8bfa 162 _addr = *bdAddr;
hosei2 0:db1ba09e8bfa 163 L2CAPAddr sockAddr;
hosei2 0:db1ba09e8bfa 164 sockAddr.bdaddr = _addr;
hosei2 0:db1ba09e8bfa 165 sockAddr.psm = L2CAP_PSM_HID_INTR;
hosei2 0:db1ba09e8bfa 166 printf("Socket_Open size %d\n",sizeof(L2CAPAddr));
hosei2 0:db1ba09e8bfa 167 _interrupt = Socket_Open(SOCKET_L2CAP,&sockAddr.hdr,OnHidInterrupt,this);
hosei2 0:db1ba09e8bfa 168 sockAddr.psm = L2CAP_PSM_HID_CNTL;
hosei2 0:db1ba09e8bfa 169 _control = Socket_Open(SOCKET_L2CAP,&sockAddr.hdr,OnHidControl,this);
hosei2 0:db1ba09e8bfa 170
hosei2 0:db1ba09e8bfa 171 printfBytes("OPEN DEVICE CLASS",info->dev_class,3);
hosei2 0:db1ba09e8bfa 172 _devClass = (info->dev_class[0] << 16) | (info->dev_class[1] << 8) | info->dev_class[2];
hosei2 0:db1ba09e8bfa 173 }
hosei2 0:db1ba09e8bfa 174
hosei2 0:db1ba09e8bfa 175 void Close()
hosei2 0:db1ba09e8bfa 176 {
hosei2 0:db1ba09e8bfa 177 if (_control)
hosei2 0:db1ba09e8bfa 178 Socket_Close(_control);
hosei2 0:db1ba09e8bfa 179 if (_interrupt)
hosei2 0:db1ba09e8bfa 180 Socket_Close(_interrupt);
hosei2 0:db1ba09e8bfa 181 _control = _interrupt = 0;
hosei2 0:db1ba09e8bfa 182 }
hosei2 0:db1ba09e8bfa 183
hosei2 0:db1ba09e8bfa 184 void Led(int id = 0x10)
hosei2 0:db1ba09e8bfa 185 {
hosei2 0:db1ba09e8bfa 186 u8 led[3] = {0x52, 0x11, id};
hosei2 0:db1ba09e8bfa 187 if (_control)
hosei2 0:db1ba09e8bfa 188 Socket_Send(_control,led,3);
hosei2 0:db1ba09e8bfa 189 }
hosei2 0:db1ba09e8bfa 190
hosei2 0:db1ba09e8bfa 191 void Hid(int report = 0x37)
hosei2 0:db1ba09e8bfa 192 {
hosei2 0:db1ba09e8bfa 193 u8 hid[4] = { 0x52, 0x12, 0x00, report };
hosei2 0:db1ba09e8bfa 194 if (_control != -1)
hosei2 0:db1ba09e8bfa 195 Socket_Send(_control,hid,4);
hosei2 0:db1ba09e8bfa 196 }
hosei2 0:db1ba09e8bfa 197 };
hosei2 0:db1ba09e8bfa 198
hosei2 0:db1ba09e8bfa 199
hosei2 0:db1ba09e8bfa 200 HCI* gHCI = 0;
hosei2 0:db1ba09e8bfa 201
hosei2 0:db1ba09e8bfa 202 #define MAX_HID_DEVICES 8
hosei2 0:db1ba09e8bfa 203
hosei2 0:db1ba09e8bfa 204 int GetConsoleChar();
hosei2 0:db1ba09e8bfa 205 class ShellApp
hosei2 0:db1ba09e8bfa 206 {
hosei2 0:db1ba09e8bfa 207 char _line[64];
hosei2 0:db1ba09e8bfa 208 HIDBluetooth _hids[MAX_HID_DEVICES];
hosei2 0:db1ba09e8bfa 209
hosei2 0:db1ba09e8bfa 210 public:
hosei2 0:db1ba09e8bfa 211 void Ready()
hosei2 0:db1ba09e8bfa 212 {
hosei2 0:db1ba09e8bfa 213 printf("HIDBluetooth %d\n",sizeof(HIDBluetooth));
hosei2 0:db1ba09e8bfa 214 memset(_hids,0,sizeof(_hids));
hosei2 0:db1ba09e8bfa 215 Inquiry();
hosei2 0:db1ba09e8bfa 216
hosei2 0:db1ba09e8bfa 217 }
hosei2 0:db1ba09e8bfa 218
hosei2 0:db1ba09e8bfa 219 // We have connected to a device
hosei2 0:db1ba09e8bfa 220 void ConnectionComplete(HCI* hci, connection_info* info)
hosei2 0:db1ba09e8bfa 221 {
hosei2 0:db1ba09e8bfa 222 printf("ConnectionComplete ");
hosei2 0:db1ba09e8bfa 223 BD_ADDR* a = &info->bdaddr;
hosei2 0:db1ba09e8bfa 224 printf(a);
hosei2 0:db1ba09e8bfa 225 BTDevice* bt = hci->Find(a);
hosei2 0:db1ba09e8bfa 226 HIDBluetooth* hid = NewHIDBluetooth();
hosei2 0:db1ba09e8bfa 227 printf("%08x %08x\n",bt,hid);
hosei2 0:db1ba09e8bfa 228 if (hid)
hosei2 0:db1ba09e8bfa 229 hid->Open(a,&bt->_info);
hosei2 0:db1ba09e8bfa 230 }
hosei2 0:db1ba09e8bfa 231
hosei2 0:db1ba09e8bfa 232 HIDBluetooth* NewHIDBluetooth()
hosei2 0:db1ba09e8bfa 233 {
hosei2 0:db1ba09e8bfa 234 for (int i = 0; i < MAX_HID_DEVICES; i++)
hosei2 0:db1ba09e8bfa 235 if (!_hids[i].InUse())
hosei2 0:db1ba09e8bfa 236 return _hids+i;
hosei2 0:db1ba09e8bfa 237 return 0;
hosei2 0:db1ba09e8bfa 238 }
hosei2 0:db1ba09e8bfa 239
hosei2 0:db1ba09e8bfa 240 void ConnectDevices()
hosei2 0:db1ba09e8bfa 241 {
hosei2 0:db1ba09e8bfa 242 BTDevice* devs[8];
hosei2 0:db1ba09e8bfa 243 int count = gHCI->GetDevices(devs,8);
hosei2 0:db1ba09e8bfa 244 for (int i = 0; i < count; i++)
hosei2 0:db1ba09e8bfa 245 {
hosei2 0:db1ba09e8bfa 246 printfBytes("DEVICE CLASS",devs[i]->_info.dev_class,3);
hosei2 0:db1ba09e8bfa 247 if (devs[i]->_handle == 0)
hosei2 0:db1ba09e8bfa 248 {
hosei2 0:db1ba09e8bfa 249 BD_ADDR* bd = &devs[i]->_info.bdaddr;
hosei2 0:db1ba09e8bfa 250 printf("Connecting to ");
hosei2 0:db1ba09e8bfa 251 printf(bd);
hosei2 0:db1ba09e8bfa 252 printf("\n");
hosei2 0:db1ba09e8bfa 253 gHCI->CreateConnection(bd);
hosei2 0:db1ba09e8bfa 254 }
hosei2 0:db1ba09e8bfa 255 }
hosei2 0:db1ba09e8bfa 256 }
hosei2 0:db1ba09e8bfa 257
hosei2 0:db1ba09e8bfa 258 const char* ReadLine()
hosei2 0:db1ba09e8bfa 259 {
hosei2 0:db1ba09e8bfa 260 int i;
hosei2 0:db1ba09e8bfa 261 for (i = 0; i < 255; )
hosei2 0:db1ba09e8bfa 262 {
hosei2 0:db1ba09e8bfa 263 USBLoop();
hosei2 0:db1ba09e8bfa 264 int c = GetConsoleChar();
hosei2 0:db1ba09e8bfa 265 if (c == -1)
hosei2 0:db1ba09e8bfa 266 continue;
hosei2 0:db1ba09e8bfa 267 if (c == '\n' || c == 13)
hosei2 0:db1ba09e8bfa 268 break;
hosei2 0:db1ba09e8bfa 269 _line[i++] = c;
hosei2 0:db1ba09e8bfa 270 }
hosei2 0:db1ba09e8bfa 271 _line[i] = 0;
hosei2 0:db1ba09e8bfa 272 return _line;
hosei2 0:db1ba09e8bfa 273 }
hosei2 0:db1ba09e8bfa 274
hosei2 0:db1ba09e8bfa 275 void Inquiry()
hosei2 0:db1ba09e8bfa 276 {
hosei2 0:db1ba09e8bfa 277 printf("Inquiry..\n");
hosei2 0:db1ba09e8bfa 278 gHCI->Inquiry();
hosei2 0:db1ba09e8bfa 279 }
hosei2 0:db1ba09e8bfa 280
hosei2 0:db1ba09e8bfa 281 void List()
hosei2 0:db1ba09e8bfa 282 {
hosei2 0:db1ba09e8bfa 283 #if 0
hosei2 0:db1ba09e8bfa 284 printf("%d devices\n",_deviceCount);
hosei2 0:db1ba09e8bfa 285 for (int i = 0; i < _deviceCount; i++)
hosei2 0:db1ba09e8bfa 286 {
hosei2 0:db1ba09e8bfa 287 printf(&_devices[i].info.bdaddr);
hosei2 0:db1ba09e8bfa 288 printf("\n");
hosei2 0:db1ba09e8bfa 289 }
hosei2 0:db1ba09e8bfa 290 #endif
hosei2 0:db1ba09e8bfa 291 }
hosei2 0:db1ba09e8bfa 292
hosei2 0:db1ba09e8bfa 293 void Connect()
hosei2 0:db1ba09e8bfa 294 {
hosei2 0:db1ba09e8bfa 295 ConnectDevices();
hosei2 0:db1ba09e8bfa 296 }
hosei2 0:db1ba09e8bfa 297
hosei2 0:db1ba09e8bfa 298 void Disconnect()
hosei2 0:db1ba09e8bfa 299 {
hosei2 0:db1ba09e8bfa 300 gHCI->DisconnectAll();
hosei2 0:db1ba09e8bfa 301 }
hosei2 0:db1ba09e8bfa 302
hosei2 0:db1ba09e8bfa 303 void CloseMouse()
hosei2 0:db1ba09e8bfa 304 {
hosei2 0:db1ba09e8bfa 305 }
hosei2 0:db1ba09e8bfa 306
hosei2 0:db1ba09e8bfa 307 void Quit()
hosei2 0:db1ba09e8bfa 308 {
hosei2 0:db1ba09e8bfa 309 CloseMouse();
hosei2 0:db1ba09e8bfa 310 }
hosei2 0:db1ba09e8bfa 311
hosei2 0:db1ba09e8bfa 312 void Run()
hosei2 0:db1ba09e8bfa 313 {
hosei2 0:db1ba09e8bfa 314 for(;;)
hosei2 0:db1ba09e8bfa 315 {
hosei2 0:db1ba09e8bfa 316 const char* cmd = ReadLine();
hosei2 0:db1ba09e8bfa 317 if (strcmp(cmd,"scan") == 0 || strcmp(cmd,"inquiry") == 0)
hosei2 0:db1ba09e8bfa 318 Inquiry();
hosei2 0:db1ba09e8bfa 319 else if (strcmp(cmd,"ls") == 0)
hosei2 0:db1ba09e8bfa 320 List();
hosei2 0:db1ba09e8bfa 321 else if (strcmp(cmd,"connect") == 0)
hosei2 0:db1ba09e8bfa 322 Connect();
hosei2 0:db1ba09e8bfa 323 else if (strcmp(cmd,"disconnect") == 0)
hosei2 0:db1ba09e8bfa 324 Disconnect();
hosei2 0:db1ba09e8bfa 325 else if (strcmp(cmd,"q")== 0)
hosei2 0:db1ba09e8bfa 326 {
hosei2 0:db1ba09e8bfa 327 Quit();
hosei2 0:db1ba09e8bfa 328 break;
hosei2 0:db1ba09e8bfa 329 } else {
hosei2 0:db1ba09e8bfa 330 printf("eh? %s\n",cmd);
hosei2 0:db1ba09e8bfa 331 }
hosei2 0:db1ba09e8bfa 332 }
hosei2 0:db1ba09e8bfa 333 }
hosei2 0:db1ba09e8bfa 334 };
hosei2 0:db1ba09e8bfa 335
hosei2 0:db1ba09e8bfa 336 // Instance
hosei2 0:db1ba09e8bfa 337 ShellApp gApp;
hosei2 0:db1ba09e8bfa 338
hosei2 0:db1ba09e8bfa 339 static int HciCallback(HCI* hci, HCI_CALLBACK_EVENT evt, const u8* data, int len)
hosei2 0:db1ba09e8bfa 340 {
hosei2 0:db1ba09e8bfa 341 switch (evt)
hosei2 0:db1ba09e8bfa 342 {
hosei2 0:db1ba09e8bfa 343 case CALLBACK_READY:
hosei2 0:db1ba09e8bfa 344 printf("CALLBACK_READY\n");
hosei2 0:db1ba09e8bfa 345 gApp.Ready();
hosei2 0:db1ba09e8bfa 346 break;
hosei2 0:db1ba09e8bfa 347
hosei2 0:db1ba09e8bfa 348 case CALLBACK_INQUIRY_RESULT:
hosei2 0:db1ba09e8bfa 349 printf("CALLBACK_INQUIRY_RESULT ");
hosei2 0:db1ba09e8bfa 350 printf((BD_ADDR*)data);
hosei2 0:db1ba09e8bfa 351 printf("\n");
hosei2 0:db1ba09e8bfa 352 break;
hosei2 0:db1ba09e8bfa 353
hosei2 0:db1ba09e8bfa 354 case CALLBACK_INQUIRY_DONE:
hosei2 0:db1ba09e8bfa 355 printf("CALLBACK_INQUIRY_DONE\n");
hosei2 0:db1ba09e8bfa 356 gApp.ConnectDevices();
hosei2 0:db1ba09e8bfa 357 break;
hosei2 0:db1ba09e8bfa 358
hosei2 0:db1ba09e8bfa 359 case CALLBACK_REMOTE_NAME:
hosei2 0:db1ba09e8bfa 360 {
hosei2 0:db1ba09e8bfa 361 BD_ADDR* addr = (BD_ADDR*)data;
hosei2 0:db1ba09e8bfa 362 const char* name = (const char*)(data + 6);
hosei2 0:db1ba09e8bfa 363 printf(addr);
hosei2 0:db1ba09e8bfa 364 printf(" % s\n",name);
hosei2 0:db1ba09e8bfa 365 }
hosei2 0:db1ba09e8bfa 366 break;
hosei2 0:db1ba09e8bfa 367
hosei2 0:db1ba09e8bfa 368 case CALLBACK_CONNECTION_COMPLETE:
hosei2 0:db1ba09e8bfa 369 gApp.ConnectionComplete(hci,(connection_info*)data);
hosei2 0:db1ba09e8bfa 370 break;
hosei2 0:db1ba09e8bfa 371 };
hosei2 0:db1ba09e8bfa 372 return 0;
hosei2 0:db1ba09e8bfa 373 }
hosei2 0:db1ba09e8bfa 374
hosei2 0:db1ba09e8bfa 375 // these should be placed in the DMA SRAM
hosei2 0:db1ba09e8bfa 376 typedef struct
hosei2 0:db1ba09e8bfa 377 {
hosei2 0:db1ba09e8bfa 378 u8 _hciBuffer[MAX_HCL_SIZE];
hosei2 0:db1ba09e8bfa 379 u8 _aclBuffer[MAX_ACL_SIZE];
hosei2 0:db1ba09e8bfa 380 } SRAMPlacement;
hosei2 0:db1ba09e8bfa 381
hosei2 0:db1ba09e8bfa 382 HCITransportUSB _HCITransportUSB;
hosei2 0:db1ba09e8bfa 383 HCI _HCI;
hosei2 0:db1ba09e8bfa 384
hosei2 0:db1ba09e8bfa 385 u8* USBGetBuffer(u32* len);
hosei2 0:db1ba09e8bfa 386 int OnBluetoothInsert(int device)
hosei2 0:db1ba09e8bfa 387 {
hosei2 0:db1ba09e8bfa 388 printf("Bluetooth inserted of %d\n",device);
hosei2 0:db1ba09e8bfa 389 u32 sramLen;
hosei2 0:db1ba09e8bfa 390 u8* sram = USBGetBuffer(&sramLen);
hosei2 0:db1ba09e8bfa 391 sram = (u8*)(((u32)sram + 1023) & ~1023);
hosei2 0:db1ba09e8bfa 392 SRAMPlacement* s = (SRAMPlacement*)sram;
hosei2 0:db1ba09e8bfa 393 _HCITransportUSB.Open(device,s->_hciBuffer,s->_aclBuffer);
hosei2 0:db1ba09e8bfa 394 _HCI.Open(&_HCITransportUSB,HciCallback);
hosei2 0:db1ba09e8bfa 395 RegisterSocketHandler(SOCKET_L2CAP,&_HCI);
hosei2 0:db1ba09e8bfa 396 gHCI = &_HCI;
hosei2 0:db1ba09e8bfa 397 gApp.Inquiry();
hosei2 0:db1ba09e8bfa 398 return 0;
hosei2 0:db1ba09e8bfa 399 }
hosei2 0:db1ba09e8bfa 400
hosei2 0:db1ba09e8bfa 401 void TestShell()
hosei2 0:db1ba09e8bfa 402 {
hosei2 0:db1ba09e8bfa 403 USBInit();
hosei2 0:db1ba09e8bfa 404 gApp.Run();
hosei2 0:db1ba09e8bfa 405 }