Radio Junk Box / Mbed 2 deprecated KAMUI_USBHOST_MIDI-CV_Example

KAMUI USB HOST MIDI-CV Example based on Peter Barrett's BlueUSB

Dependencies:   TextLCD mbed

L2CAP.cpp@0:3b4e3e2ec6a5, 2012-05-11 (annotated)

Committer:
radiojunkbox
Date:
Fri May 11 15:31:59 2012 +0000
Revision:
0:3b4e3e2ec6a5
Rev. 0.1 alfa

Who changed what in which revision?

UserRevisionLine numberNew contents of line
radiojunkbox 0:3b4e3e2ec6a5 1 /*
radiojunkbox 0:3b4e3e2ec6a5 2 Copyright (c) 2010 Peter Barrett
radiojunkbox 0:3b4e3e2ec6a5 3
radiojunkbox 0:3b4e3e2ec6a5 4 Permission is hereby granted, free of charge, to any person obtaining a copy
radiojunkbox 0:3b4e3e2ec6a5 5 of this software and associated documentation files (the "Software"), to deal
radiojunkbox 0:3b4e3e2ec6a5 6 in the Software without restriction, including without limitation the rights
radiojunkbox 0:3b4e3e2ec6a5 7 to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
radiojunkbox 0:3b4e3e2ec6a5 8 copies of the Software, and to permit persons to whom the Software is
radiojunkbox 0:3b4e3e2ec6a5 9 furnished to do so, subject to the following conditions:
radiojunkbox 0:3b4e3e2ec6a5 10
radiojunkbox 0:3b4e3e2ec6a5 11 The above copyright notice and this permission notice shall be included in
radiojunkbox 0:3b4e3e2ec6a5 12 all copies or substantial portions of the Software.
radiojunkbox 0:3b4e3e2ec6a5 13
radiojunkbox 0:3b4e3e2ec6a5 14 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
radiojunkbox 0:3b4e3e2ec6a5 15 IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
radiojunkbox 0:3b4e3e2ec6a5 16 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
radiojunkbox 0:3b4e3e2ec6a5 17 AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
radiojunkbox 0:3b4e3e2ec6a5 18 LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
radiojunkbox 0:3b4e3e2ec6a5 19 OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
radiojunkbox 0:3b4e3e2ec6a5 20 THE SOFTWARE.
radiojunkbox 0:3b4e3e2ec6a5 21 */
radiojunkbox 0:3b4e3e2ec6a5 22
radiojunkbox 0:3b4e3e2ec6a5 23
radiojunkbox 0:3b4e3e2ec6a5 24 #include <stdio.h>
radiojunkbox 0:3b4e3e2ec6a5 25 #include <stdlib.h>
radiojunkbox 0:3b4e3e2ec6a5 26 #include <stdio.h>
radiojunkbox 0:3b4e3e2ec6a5 27 #include <string.h>
radiojunkbox 0:3b4e3e2ec6a5 28
radiojunkbox 0:3b4e3e2ec6a5 29 #include "Utils.h"
radiojunkbox 0:3b4e3e2ec6a5 30 #include "hci.h"
radiojunkbox 0:3b4e3e2ec6a5 31
radiojunkbox 0:3b4e3e2ec6a5 32 #define L2CAP_COMMAND_REJ 0x01
radiojunkbox 0:3b4e3e2ec6a5 33 #define L2CAP_CONN_REQ 0x02
radiojunkbox 0:3b4e3e2ec6a5 34 #define L2CAP_CONN_RSP 0x03
radiojunkbox 0:3b4e3e2ec6a5 35 #define L2CAP_CONF_REQ 0x04
radiojunkbox 0:3b4e3e2ec6a5 36 #define L2CAP_CONF_RSP 0x05
radiojunkbox 0:3b4e3e2ec6a5 37 #define L2CAP_DISCONN_REQ 0x06
radiojunkbox 0:3b4e3e2ec6a5 38 #define L2CAP_DISCONN_RSP 0x07
radiojunkbox 0:3b4e3e2ec6a5 39 #define L2CAP_ECHO_REQ 0x08
radiojunkbox 0:3b4e3e2ec6a5 40 #define L2CAP_ECHO_RSP 0x09
radiojunkbox 0:3b4e3e2ec6a5 41 #define L2CAP_INFO_REQ 0x0a
radiojunkbox 0:3b4e3e2ec6a5 42 #define L2CAP_INFO_RSP 0x0b
radiojunkbox 0:3b4e3e2ec6a5 43
radiojunkbox 0:3b4e3e2ec6a5 44
radiojunkbox 0:3b4e3e2ec6a5 45 /* L2CAP command codes */
radiojunkbox 0:3b4e3e2ec6a5 46 const char* L2CAP_ComandCodeStr(int c)
radiojunkbox 0:3b4e3e2ec6a5 47 {
radiojunkbox 0:3b4e3e2ec6a5 48 switch (c)
radiojunkbox 0:3b4e3e2ec6a5 49 {
radiojunkbox 0:3b4e3e2ec6a5 50 case L2CAP_COMMAND_REJ: return "L2CAP_COMMAND_REJ";
radiojunkbox 0:3b4e3e2ec6a5 51 case L2CAP_CONN_REQ: return "L2CAP_CONN_REQ";
radiojunkbox 0:3b4e3e2ec6a5 52 case L2CAP_CONN_RSP: return "L2CAP_CONN_RSP";
radiojunkbox 0:3b4e3e2ec6a5 53 case L2CAP_CONF_REQ: return "L2CAP_CONF_REQ";
radiojunkbox 0:3b4e3e2ec6a5 54 case L2CAP_CONF_RSP: return "L2CAP_CONF_RSP";
radiojunkbox 0:3b4e3e2ec6a5 55 case L2CAP_DISCONN_REQ: return "L2CAP_DISCONN_REQ";
radiojunkbox 0:3b4e3e2ec6a5 56 case L2CAP_DISCONN_RSP: return "L2CAP_DISCONN_RSP";
radiojunkbox 0:3b4e3e2ec6a5 57 case L2CAP_ECHO_REQ: return "L2CAP_ECHO_REQ";
radiojunkbox 0:3b4e3e2ec6a5 58 case L2CAP_ECHO_RSP: return "L2CAP_ECHO_RSP";
radiojunkbox 0:3b4e3e2ec6a5 59 case L2CAP_INFO_REQ: return "L2CAP_INFO_REQ";
radiojunkbox 0:3b4e3e2ec6a5 60 case L2CAP_INFO_RSP: return "L2CAP_INFO_RSP";
radiojunkbox 0:3b4e3e2ec6a5 61 }
radiojunkbox 0:3b4e3e2ec6a5 62 return "unknown";
radiojunkbox 0:3b4e3e2ec6a5 63 }
radiojunkbox 0:3b4e3e2ec6a5 64
radiojunkbox 0:3b4e3e2ec6a5 65 typedef struct
radiojunkbox 0:3b4e3e2ec6a5 66 {
radiojunkbox 0:3b4e3e2ec6a5 67 u16 handle;
radiojunkbox 0:3b4e3e2ec6a5 68 u16 length; // total
radiojunkbox 0:3b4e3e2ec6a5 69 u16 l2capLength; // length -4
radiojunkbox 0:3b4e3e2ec6a5 70 u16 cid; // Signaling packet CID = 1
radiojunkbox 0:3b4e3e2ec6a5 71 u8 data[64]; // Largest thing to send!!! todo
radiojunkbox 0:3b4e3e2ec6a5 72 } L2CAPData;
radiojunkbox 0:3b4e3e2ec6a5 73
radiojunkbox 0:3b4e3e2ec6a5 74 typedef struct
radiojunkbox 0:3b4e3e2ec6a5 75 {
radiojunkbox 0:3b4e3e2ec6a5 76 u16 handle;
radiojunkbox 0:3b4e3e2ec6a5 77 u16 length; // total
radiojunkbox 0:3b4e3e2ec6a5 78 u16 l2capLength; // length -4
radiojunkbox 0:3b4e3e2ec6a5 79 u16 cid; // Signaling packet CID = 1
radiojunkbox 0:3b4e3e2ec6a5 80
radiojunkbox 0:3b4e3e2ec6a5 81 // Payload
radiojunkbox 0:3b4e3e2ec6a5 82 u8 cmd; //
radiojunkbox 0:3b4e3e2ec6a5 83 u8 id;
radiojunkbox 0:3b4e3e2ec6a5 84 u16 cmdLength; // total-8
radiojunkbox 0:3b4e3e2ec6a5 85 u16 params[4]; // Params
radiojunkbox 0:3b4e3e2ec6a5 86 } L2CAPCmd;
radiojunkbox 0:3b4e3e2ec6a5 87
radiojunkbox 0:3b4e3e2ec6a5 88 //
radiojunkbox 0:3b4e3e2ec6a5 89 void BTDevice::Init()
radiojunkbox 0:3b4e3e2ec6a5 90 {
radiojunkbox 0:3b4e3e2ec6a5 91 memset(&_info,0,sizeof(inquiry_info));
radiojunkbox 0:3b4e3e2ec6a5 92 _handle = 0;
radiojunkbox 0:3b4e3e2ec6a5 93 _name[0] = 0;
radiojunkbox 0:3b4e3e2ec6a5 94 _state = 0;
radiojunkbox 0:3b4e3e2ec6a5 95 }
radiojunkbox 0:3b4e3e2ec6a5 96
radiojunkbox 0:3b4e3e2ec6a5 97 // virtual SocketHandler
radiojunkbox 0:3b4e3e2ec6a5 98 int BTDevice::Open(SocketInternal* sock, SocketAddrHdr* addr)
radiojunkbox 0:3b4e3e2ec6a5 99 {
radiojunkbox 0:3b4e3e2ec6a5 100 L2CAPSocket* s = (L2CAPSocket*)sock;
radiojunkbox 0:3b4e3e2ec6a5 101 L2CAPAddr* a = (L2CAPAddr*)addr;
radiojunkbox 0:3b4e3e2ec6a5 102 s->scid = 0x40 + sock->ID-1; // are these reserved?
radiojunkbox 0:3b4e3e2ec6a5 103 s->dcid = 0;
radiojunkbox 0:3b4e3e2ec6a5 104 Connect(s->scid,a->psm);
radiojunkbox 0:3b4e3e2ec6a5 105 return sock->ID;
radiojunkbox 0:3b4e3e2ec6a5 106 }
radiojunkbox 0:3b4e3e2ec6a5 107
radiojunkbox 0:3b4e3e2ec6a5 108 // virtual SocketHandler
radiojunkbox 0:3b4e3e2ec6a5 109 int BTDevice::Send(SocketInternal* sock, const u8* data, int len)
radiojunkbox 0:3b4e3e2ec6a5 110 {
radiojunkbox 0:3b4e3e2ec6a5 111 L2CAPData d;
radiojunkbox 0:3b4e3e2ec6a5 112 L2CAPSocket* s = (L2CAPSocket*)sock;
radiojunkbox 0:3b4e3e2ec6a5 113
radiojunkbox 0:3b4e3e2ec6a5 114 d.handle = _handle | 0x2000;
radiojunkbox 0:3b4e3e2ec6a5 115 d.length = 4 + len;
radiojunkbox 0:3b4e3e2ec6a5 116 d.l2capLength = len;
radiojunkbox 0:3b4e3e2ec6a5 117 d.cid = s->dcid;
radiojunkbox 0:3b4e3e2ec6a5 118
radiojunkbox 0:3b4e3e2ec6a5 119 if (len > 64)
radiojunkbox 0:3b4e3e2ec6a5 120 return -1;
radiojunkbox 0:3b4e3e2ec6a5 121 memcpy(d.data,data,len);
radiojunkbox 0:3b4e3e2ec6a5 122 return Send((u8*)&d,len+8);
radiojunkbox 0:3b4e3e2ec6a5 123 }
radiojunkbox 0:3b4e3e2ec6a5 124
radiojunkbox 0:3b4e3e2ec6a5 125 // virtual SocketHandler
radiojunkbox 0:3b4e3e2ec6a5 126 int BTDevice::Close(SocketInternal* sock)
radiojunkbox 0:3b4e3e2ec6a5 127 {
radiojunkbox 0:3b4e3e2ec6a5 128 printf("L2CAP close %d\n",sock->ID);
radiojunkbox 0:3b4e3e2ec6a5 129 L2CAPSocket* s = (L2CAPSocket*)sock;
radiojunkbox 0:3b4e3e2ec6a5 130 return Disconnect(s->scid,s->dcid);
radiojunkbox 0:3b4e3e2ec6a5 131 }
radiojunkbox 0:3b4e3e2ec6a5 132
radiojunkbox 0:3b4e3e2ec6a5 133 L2CAPSocket* BTDevice::SCIDToSocket(int scid)
radiojunkbox 0:3b4e3e2ec6a5 134 {
radiojunkbox 0:3b4e3e2ec6a5 135 return (L2CAPSocket*)GetSocketInternal(scid-0x40+1);
radiojunkbox 0:3b4e3e2ec6a5 136 }
radiojunkbox 0:3b4e3e2ec6a5 137
radiojunkbox 0:3b4e3e2ec6a5 138 int BTDevice::Send(const u8* data, int len)
radiojunkbox 0:3b4e3e2ec6a5 139 {
radiojunkbox 0:3b4e3e2ec6a5 140 _transport->ACLSend(data,len);
radiojunkbox 0:3b4e3e2ec6a5 141 return 0;
radiojunkbox 0:3b4e3e2ec6a5 142 }
radiojunkbox 0:3b4e3e2ec6a5 143
radiojunkbox 0:3b4e3e2ec6a5 144 int BTDevice::Send(u8 c, u8 id, u16* params, int count)
radiojunkbox 0:3b4e3e2ec6a5 145 {
radiojunkbox 0:3b4e3e2ec6a5 146 L2CAPCmd cmd;
radiojunkbox 0:3b4e3e2ec6a5 147 cmd.handle = _handle | 0x2000;
radiojunkbox 0:3b4e3e2ec6a5 148 cmd.length = 8 + count*2;
radiojunkbox 0:3b4e3e2ec6a5 149
radiojunkbox 0:3b4e3e2ec6a5 150 cmd.l2capLength = cmd.length-4;
radiojunkbox 0:3b4e3e2ec6a5 151 cmd.cid = 1; // Signaling packet
radiojunkbox 0:3b4e3e2ec6a5 152
radiojunkbox 0:3b4e3e2ec6a5 153 cmd.cmd = c;
radiojunkbox 0:3b4e3e2ec6a5 154 cmd.id = id;
radiojunkbox 0:3b4e3e2ec6a5 155 cmd.cmdLength = count*2;
radiojunkbox 0:3b4e3e2ec6a5 156 for (int i = 0; i < count; i++)
radiojunkbox 0:3b4e3e2ec6a5 157 cmd.params[i] = params[i];
radiojunkbox 0:3b4e3e2ec6a5 158 return Send((u8*)&cmd,cmd.length+4);
radiojunkbox 0:3b4e3e2ec6a5 159 }
radiojunkbox 0:3b4e3e2ec6a5 160
radiojunkbox 0:3b4e3e2ec6a5 161 int BTDevice::Connect(int scid, int psm)
radiojunkbox 0:3b4e3e2ec6a5 162 {
radiojunkbox 0:3b4e3e2ec6a5 163 u16 p[2];
radiojunkbox 0:3b4e3e2ec6a5 164 p[0] = psm;
radiojunkbox 0:3b4e3e2ec6a5 165 p[1] = scid;
radiojunkbox 0:3b4e3e2ec6a5 166 return Send(L2CAP_CONN_REQ,_txid++,p,2);
radiojunkbox 0:3b4e3e2ec6a5 167 }
radiojunkbox 0:3b4e3e2ec6a5 168
radiojunkbox 0:3b4e3e2ec6a5 169 int BTDevice::Disconnect(int scid, int dcid)
radiojunkbox 0:3b4e3e2ec6a5 170 {
radiojunkbox 0:3b4e3e2ec6a5 171 u16 p[2];
radiojunkbox 0:3b4e3e2ec6a5 172 p[0] = dcid;
radiojunkbox 0:3b4e3e2ec6a5 173 p[1] = scid;
radiojunkbox 0:3b4e3e2ec6a5 174 return Send(L2CAP_DISCONN_REQ,_txid++,p,2);
radiojunkbox 0:3b4e3e2ec6a5 175 }
radiojunkbox 0:3b4e3e2ec6a5 176
radiojunkbox 0:3b4e3e2ec6a5 177 int BTDevice::ConfigureRequest(int dcid)
radiojunkbox 0:3b4e3e2ec6a5 178 {
radiojunkbox 0:3b4e3e2ec6a5 179 u16 p[4];
radiojunkbox 0:3b4e3e2ec6a5 180 p[0] = dcid;
radiojunkbox 0:3b4e3e2ec6a5 181 p[1] = 0;
radiojunkbox 0:3b4e3e2ec6a5 182 p[2] = 0x0201; // Options
radiojunkbox 0:3b4e3e2ec6a5 183 p[3] = 0x02A0; // 672
radiojunkbox 0:3b4e3e2ec6a5 184 return Send(L2CAP_CONF_REQ,_txid++,p,4);
radiojunkbox 0:3b4e3e2ec6a5 185 }
radiojunkbox 0:3b4e3e2ec6a5 186
radiojunkbox 0:3b4e3e2ec6a5 187 int BTDevice::ConfigureResponse(u8 rxid, int dcid)
radiojunkbox 0:3b4e3e2ec6a5 188 {
radiojunkbox 0:3b4e3e2ec6a5 189 u16 p[3];
radiojunkbox 0:3b4e3e2ec6a5 190 p[0] = dcid;
radiojunkbox 0:3b4e3e2ec6a5 191 p[1] = 0;
radiojunkbox 0:3b4e3e2ec6a5 192 p[2] = 0;
radiojunkbox 0:3b4e3e2ec6a5 193 return Send(L2CAP_CONF_RSP,rxid,p,3);
radiojunkbox 0:3b4e3e2ec6a5 194 }
radiojunkbox 0:3b4e3e2ec6a5 195
radiojunkbox 0:3b4e3e2ec6a5 196 int BTDevice::DisconnectResponse(u8 rxid, int scid, int dcid)
radiojunkbox 0:3b4e3e2ec6a5 197 {
radiojunkbox 0:3b4e3e2ec6a5 198 u16 p[2];
radiojunkbox 0:3b4e3e2ec6a5 199 p[0] = dcid;
radiojunkbox 0:3b4e3e2ec6a5 200 p[1] = scid;
radiojunkbox 0:3b4e3e2ec6a5 201 return Send(L2CAP_DISCONN_RSP,rxid,p,2);
radiojunkbox 0:3b4e3e2ec6a5 202 }
radiojunkbox 0:3b4e3e2ec6a5 203
radiojunkbox 0:3b4e3e2ec6a5 204 void BTDevice::Control(const u8* data, int len)
radiojunkbox 0:3b4e3e2ec6a5 205 {
radiojunkbox 0:3b4e3e2ec6a5 206 int cc = data[8];
radiojunkbox 0:3b4e3e2ec6a5 207 printf(L2CAP_ComandCodeStr(cc));
radiojunkbox 0:3b4e3e2ec6a5 208 int result = LE16(data+16);
radiojunkbox 0:3b4e3e2ec6a5 209 printf(" Result %d\n",result);
radiojunkbox 0:3b4e3e2ec6a5 210 switch (cc)
radiojunkbox 0:3b4e3e2ec6a5 211 {
radiojunkbox 0:3b4e3e2ec6a5 212 case L2CAP_COMMAND_REJ:
radiojunkbox 0:3b4e3e2ec6a5 213 break;
radiojunkbox 0:3b4e3e2ec6a5 214 case L2CAP_CONN_REQ:
radiojunkbox 0:3b4e3e2ec6a5 215 break;
radiojunkbox 0:3b4e3e2ec6a5 216
radiojunkbox 0:3b4e3e2ec6a5 217 // Response to our initial connect from Remote
radiojunkbox 0:3b4e3e2ec6a5 218 case L2CAP_CONN_RSP:
radiojunkbox 0:3b4e3e2ec6a5 219 {
radiojunkbox 0:3b4e3e2ec6a5 220 if (result == 0)
radiojunkbox 0:3b4e3e2ec6a5 221 {
radiojunkbox 0:3b4e3e2ec6a5 222 int dcid = LE16(data+12);
radiojunkbox 0:3b4e3e2ec6a5 223 int scid = LE16(data+14);
radiojunkbox 0:3b4e3e2ec6a5 224 L2CAPSocket* s = SCIDToSocket(scid);
radiojunkbox 0:3b4e3e2ec6a5 225 if (s)
radiojunkbox 0:3b4e3e2ec6a5 226 {
radiojunkbox 0:3b4e3e2ec6a5 227 s->dcid = dcid;
radiojunkbox 0:3b4e3e2ec6a5 228 ConfigureRequest(dcid);
radiojunkbox 0:3b4e3e2ec6a5 229 }
radiojunkbox 0:3b4e3e2ec6a5 230 } else
radiojunkbox 0:3b4e3e2ec6a5 231 printf("Connect failed?\n");
radiojunkbox 0:3b4e3e2ec6a5 232 }
radiojunkbox 0:3b4e3e2ec6a5 233 break;
radiojunkbox 0:3b4e3e2ec6a5 234
radiojunkbox 0:3b4e3e2ec6a5 235 case L2CAP_CONF_RSP:
radiojunkbox 0:3b4e3e2ec6a5 236 {
radiojunkbox 0:3b4e3e2ec6a5 237 int scid = LE16(data+12);
radiojunkbox 0:3b4e3e2ec6a5 238 SocketInternal* s = (SocketInternal*)SCIDToSocket(scid);
radiojunkbox 0:3b4e3e2ec6a5 239 if (s)
radiojunkbox 0:3b4e3e2ec6a5 240 s->SetState(SocketState_Open);
radiojunkbox 0:3b4e3e2ec6a5 241 }
radiojunkbox 0:3b4e3e2ec6a5 242 break;
radiojunkbox 0:3b4e3e2ec6a5 243
radiojunkbox 0:3b4e3e2ec6a5 244 case L2CAP_CONF_REQ:
radiojunkbox 0:3b4e3e2ec6a5 245 {
radiojunkbox 0:3b4e3e2ec6a5 246 int scid = LE16(data+12);
radiojunkbox 0:3b4e3e2ec6a5 247 L2CAPSocket* s = SCIDToSocket(scid);
radiojunkbox 0:3b4e3e2ec6a5 248 if (s)
radiojunkbox 0:3b4e3e2ec6a5 249 ConfigureResponse(data[9],s->dcid);
radiojunkbox 0:3b4e3e2ec6a5 250 }
radiojunkbox 0:3b4e3e2ec6a5 251 break;
radiojunkbox 0:3b4e3e2ec6a5 252 }
radiojunkbox 0:3b4e3e2ec6a5 253 }
radiojunkbox 0:3b4e3e2ec6a5 254
radiojunkbox 0:3b4e3e2ec6a5 255 void BTDevice::ACLRecv(const u8* data, int len)
radiojunkbox 0:3b4e3e2ec6a5 256 {
radiojunkbox 0:3b4e3e2ec6a5 257 // printfBytes("L2CP",data,16);
radiojunkbox 0:3b4e3e2ec6a5 258 int handle = LE16(data);
radiojunkbox 0:3b4e3e2ec6a5 259 if (handle != (0x2000 | _handle))
radiojunkbox 0:3b4e3e2ec6a5 260 return;
radiojunkbox 0:3b4e3e2ec6a5 261
radiojunkbox 0:3b4e3e2ec6a5 262 int cid = LE16(data+6);
radiojunkbox 0:3b4e3e2ec6a5 263 if (cid == 1)
radiojunkbox 0:3b4e3e2ec6a5 264 {
radiojunkbox 0:3b4e3e2ec6a5 265 Control(data,len);
radiojunkbox 0:3b4e3e2ec6a5 266 return;
radiojunkbox 0:3b4e3e2ec6a5 267 }
radiojunkbox 0:3b4e3e2ec6a5 268
radiojunkbox 0:3b4e3e2ec6a5 269 SocketInternal* s = (SocketInternal*)SCIDToSocket(cid);
radiojunkbox 0:3b4e3e2ec6a5 270 if (s)
radiojunkbox 0:3b4e3e2ec6a5 271 s->Recv(data+8,LE16(data+2)-4);
radiojunkbox 0:3b4e3e2ec6a5 272 else
radiojunkbox 0:3b4e3e2ec6a5 273 printf("Bad event cid %d\n",cid);
radiojunkbox 0:3b4e3e2ec6a5 274 }