myBlueUSB - Test version of BlueUSB stack. Includes SDP and R…

Users » networker » Code » myBlueUSB

Ad van der Weiden / Mbed 2 deprecated myBlueUSB

Test version of BlueUSB stack. Includes SDP and RFCOMM. As Client it allows to connect to my fischertechnik TX Controller. As Server it echo\\\\\\\'s characters to Putty. PIN=1234

Dependencies: mbed myUSBHost AvailableMemory

Dependents: mbed_TANK_Kinect myBlueUSB_ros ftusbClass

hci.cpp@4:b94984a20500, 2011-05-08 (annotated)

Committer:: networker
Date:: Sun May 08 18:30:10 2011 +0000
Revision:: 4:b94984a20500
Parent:: 2:0118da9e5169
Child:: 5:378c208637e3

Who changed what in which revision?

User	Revision	Line number	New contents of line
networker	2:0118da9e5169	1
networker	2:0118da9e5169	2	/*
networker	2:0118da9e5169	3	Copyright (c) 2010 Peter Barrett
networker	2:0118da9e5169	4
networker	2:0118da9e5169	5	Permission is hereby granted, free of charge, to any person obtaining a copy
networker	2:0118da9e5169	6	of this software and associated documentation files (the "Software"), to deal
networker	2:0118da9e5169	7	in the Software without restriction, including without limitation the rights
networker	2:0118da9e5169	8	to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
networker	2:0118da9e5169	9	copies of the Software, and to permit persons to whom the Software is
networker	2:0118da9e5169	10	furnished to do so, subject to the following conditions:
networker	2:0118da9e5169	11
networker	2:0118da9e5169	12	The above copyright notice and this permission notice shall be included in
networker	2:0118da9e5169	13	all copies or substantial portions of the Software.
networker	2:0118da9e5169	14
networker	2:0118da9e5169	15	THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
networker	2:0118da9e5169	16	IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
networker	2:0118da9e5169	17	FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
networker	2:0118da9e5169	18	AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
networker	2:0118da9e5169	19	LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
networker	2:0118da9e5169	20	OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
networker	2:0118da9e5169	21	THE SOFTWARE.
networker	2:0118da9e5169	22	*/
networker	2:0118da9e5169	23
networker	2:0118da9e5169	24	#include <stdio.h>
networker	2:0118da9e5169	25	#include <stdlib.h>
networker	2:0118da9e5169	26	#include <stdio.h>
networker	2:0118da9e5169	27	#include <string.h>
networker	2:0118da9e5169	28
networker	2:0118da9e5169	29	#include "Utils.h"
networker	2:0118da9e5169	30	#include "hci.h"
networker	2:0118da9e5169	31	#include "hci_private.h"
networker	2:0118da9e5169	32	#include "USBHost.h" //for USBLoop
networker	2:0118da9e5169	33	#include "HCITransportUSB.h" //for ACL/HCL buffer size
networker	2:0118da9e5169	34
networker	2:0118da9e5169	35	enum hci_callback_evt {
networker	2:0118da9e5169	36	NONE,
networker	2:0118da9e5169	37	CONNECT,
networker	2:0118da9e5169	38	DISCONECT,
networker	2:0118da9e5169	39	INQUIRYRESULT
networker	2:0118da9e5169	40	};
networker	2:0118da9e5169	41
networker	2:0118da9e5169	42	#define MAX_BLUETOOTH_ADAPTERS 1
networker	2:0118da9e5169	43
networker	2:0118da9e5169	44	enum StateMask {
networker	2:0118da9e5169	45	MASK_RESET = 1,
networker	2:0118da9e5169	46	MASK_READ_BUFFER_SIZE = 2,
networker	2:0118da9e5169	47	MASK_READ_BD_ADDR = 4,
networker	2:0118da9e5169	48	MASK_INITED = 8,
networker	2:0118da9e5169	49	MASK_INQUIRY = 16,
networker	2:0118da9e5169	50	MASK_REMOTE_NAME = 32,
networker	2:0118da9e5169	51	MASK_CREATE_CONNECTION = 64
networker	2:0118da9e5169	52	};
networker	2:0118da9e5169	53
networker	2:0118da9e5169	54	static const u8 local_name[] = "MBED";
networker	2:0118da9e5169	55
networker	2:0118da9e5169	56
networker	2:0118da9e5169	57	int HCI::Open(HCITransport* transport, HCICallback callback) {
networker	2:0118da9e5169	58	_transport = transport;
networker	2:0118da9e5169	59	_transport->Set(this);
networker	2:0118da9e5169	60	_callback = callback;
networker	2:0118da9e5169	61	_state = 0;
networker	2:0118da9e5169	62	for (int i = 0; i < MAX_BTDEVICES; i++) {
networker	2:0118da9e5169	63	_devices[i].Init();
networker	2:0118da9e5169	64	_devices[i]._transport = transport;
networker	2:0118da9e5169	65	}
networker	2:0118da9e5169	66	#ifdef COMMAND_FLOW
networker	2:0118da9e5169	67	cmd_credits = 1;
networker	2:0118da9e5169	68	#endif
networker	2:0118da9e5169	69	return SendCmd(HCI_OP_RESET);
networker	2:0118da9e5169	70	}
networker	2:0118da9e5169	71
networker	2:0118da9e5169	72	void printf(const BD_ADDR* addr);
networker	2:0118da9e5169	73
networker	2:0118da9e5169	74	BTDevice* HCI::Find(const BD_ADDR* addr) {
networker	2:0118da9e5169	75	for (int i = 0; i < MAX_BTDEVICES; i++)
networker	2:0118da9e5169	76	if (_devices[i]._state != 0 && memcmp(addr,&_devices[i]._info.bdaddr,6) == 0)
networker	2:0118da9e5169	77	return &_devices[i];
networker	2:0118da9e5169	78	return 0;
networker	2:0118da9e5169	79	}
networker	2:0118da9e5169	80
networker	2:0118da9e5169	81	BTDevice* HCI::Find(int handle) {
networker	2:0118da9e5169	82	for (int i = 0; i < MAX_BTDEVICES; i++)
networker	2:0118da9e5169	83	if (_devices[i]._state != 0 && handle == _devices[i]._handle)
networker	2:0118da9e5169	84	return &_devices[i];
networker	2:0118da9e5169	85	return 0;
networker	2:0118da9e5169	86	}
networker	2:0118da9e5169	87
networker	2:0118da9e5169	88	//reports that some commands are still in progress
networker	2:0118da9e5169	89	bool HCI::Busy() {
networker	2:0118da9e5169	90	return (_state & (MASK_INQUIRY \| MASK_REMOTE_NAME \| MASK_CREATE_CONNECTION)) != 0;
networker	2:0118da9e5169	91	}
networker	2:0118da9e5169	92
networker	2:0118da9e5169	93	int HCI::Inquiry(int duration) {
networker	2:0118da9e5169	94	_state \|= MASK_INQUIRY;
networker	2:0118da9e5169	95	u8 buf[5];
networker	2:0118da9e5169	96	buf[0] = 0x33;//LAP=0x9e8b33
networker	2:0118da9e5169	97	buf[1] = 0x8B;
networker	2:0118da9e5169	98	buf[2] = 0x9E;
networker	2:0118da9e5169	99	buf[3] = duration;
networker	2:0118da9e5169	100	buf[4] = 5; // 5 results
networker	2:0118da9e5169	101	SendCmd(HCI_OP_INQUIRY,buf,sizeof(buf));
networker	2:0118da9e5169	102	return 0;
networker	2:0118da9e5169	103	}
networker	2:0118da9e5169	104
networker	2:0118da9e5169	105	int HCI::SendCmd(int cmd, const u8* params, int len) {
networker	2:0118da9e5169	106	u8 b[256];
networker	2:0118da9e5169	107	b[0] = cmd;
networker	2:0118da9e5169	108	b[1] = (cmd >> 8);
networker	2:0118da9e5169	109	b[2] = len;
networker	2:0118da9e5169	110	if (params)
networker	2:0118da9e5169	111	memcpy(b+3,params,len);
networker	2:0118da9e5169	112	#ifdef COMMAND_FLOW
networker	2:0118da9e5169	113	//printf("%d cmd_credits\n", cmd_credits);
networker	2:0118da9e5169	114	while (cmd_credits == 0) {//blocks when command credits run out
networker	2:0118da9e5169	115	USBLoop();
networker	2:0118da9e5169	116	putc('_', stdout);
networker	2:0118da9e5169	117	}
networker	2:0118da9e5169	118	#endif
networker	2:0118da9e5169	119	_transport->HCISend(b,len+3);
networker	2:0118da9e5169	120	return 0;
networker	2:0118da9e5169	121	}
networker	2:0118da9e5169	122
networker	2:0118da9e5169	123	void HCI::OnCommandComplete(int cmd, const u8* data, int len) {//data is exclusive the status byte
networker	2:0118da9e5169	124	//printf("%04X %s",cmd,CmdStr(cmd));
networker	2:0118da9e5169	125	if (len < 0)
networker	2:0118da9e5169	126	return;
networker	2:0118da9e5169	127	//printfBytes(" complete",data,len/min(16,len)/);
networker	2:0118da9e5169	128
networker	2:0118da9e5169	129	switch (cmd) {
networker	2:0118da9e5169	130	case 0: //NOP
networker	2:0118da9e5169	131	printf("Received NOP command (for cmd_credits)\n");
networker	2:0118da9e5169	132	break;
networker	2:0118da9e5169	133	// Init phase 0
networker	2:0118da9e5169	134	case HCI_OP_RESET: // Reset done, init chain to HCI_OP_READ_LOCAL_NAME
networker	2:0118da9e5169	135	SendCmd(HCI_OP_READ_BUFFER_SIZE);
networker	2:0118da9e5169	136	_state \|= MASK_RESET;
networker	2:0118da9e5169	137	break;
networker	2:0118da9e5169	138
networker	2:0118da9e5169	139	// Init phase 1
networker	2:0118da9e5169	140	case HCI_OP_READ_BUFFER_SIZE:
networker	2:0118da9e5169	141	_acl_mtu = LE16(data);
networker	2:0118da9e5169	142	_sco_mtu = data[2];
networker	2:0118da9e5169	143	_acl_max_pkt = LE16(data+3);
networker	2:0118da9e5169	144	_sco_max_pkt = LE16(data+5);
networker	2:0118da9e5169	145	printf("acl_mtu=%d, acl_max_pkt=%d\n", _acl_mtu, _acl_max_pkt);
networker	2:0118da9e5169	146	#ifdef HOST_CONTR_FLOW
networker	2:0118da9e5169	147	_transport->data_credits = _acl_max_pkt;
networker	2:0118da9e5169	148	_transport->_acl_mtu = _acl_mtu;
networker	2:0118da9e5169	149	#endif
networker	2:0118da9e5169	150	SendCmd(HCI_OP_READ_BD_ADDR);
networker	2:0118da9e5169	151	_state \|= MASK_READ_BUFFER_SIZE;
networker	2:0118da9e5169	152	break;
networker	2:0118da9e5169	153
networker	2:0118da9e5169	154	// Init phase 2
networker	2:0118da9e5169	155	case HCI_OP_READ_BD_ADDR:
networker	2:0118da9e5169	156	_localAddr = ((BD_ADDR)data); // Local Address
networker	2:0118da9e5169	157	_state \|= MASK_READ_BD_ADDR;
networker	2:0118da9e5169	158	_state \|= MASK_INITED;
networker	2:0118da9e5169	159	{
networker	2:0118da9e5169	160	#ifdef CONTR_HOST_FLOW
networker	2:0118da9e5169	161	unsigned char param[7];
networker	2:0118da9e5169	162	param[0] = (u8)(MAX_ACL_SIZE-8);
networker	2:0118da9e5169	163	param[1] = (u8)((MAX_ACL_SIZE-8)>>8);
networker	2:0118da9e5169	164	param[2] = 0;//MAX_HCL_SIZE-8;
networker	2:0118da9e5169	165	param[3] = 10;
networker	2:0118da9e5169	166	param[4] = 0; //1 ACL buffer
networker	2:0118da9e5169	167	param[5] = 0;
networker	2:0118da9e5169	168	param[6] = 0; //0 Synchronous buffers
networker	2:0118da9e5169	169	SendCmd(HCI_OP_HOST_BUFFER_SIZE, param, 7);
networker	2:0118da9e5169	170	const unsigned char flow = 1;//ACL on, Synchonous off
networker	2:0118da9e5169	171	SendCmd(HCI_OP_CONTR_TO_HOST_FLOW, &flow, 1);
networker	2:0118da9e5169	172	#endif
networker	2:0118da9e5169	173	const unsigned char scan_enable = 3;
networker	2:0118da9e5169	174	SendCmd(HCI_OP_WRITE_SCAN_ENABLE, &scan_enable, 1);
networker	2:0118da9e5169	175	SendCmd(HCI_OP_WRITE_LOCAL_NAME, local_name, 248);
networker	2:0118da9e5169	176	}
networker	2:0118da9e5169	177	Callback(CALLBACK_READY,data,6);
networker	2:0118da9e5169	178	break;
networker	2:0118da9e5169	179
networker	2:0118da9e5169	180	// 0CXX
networker	2:0118da9e5169	181	case HCI_OP_READ_LOCAL_NAME:
networker	2:0118da9e5169	182	case HCI_OP_LINK_KEY_NEG_REPLY:
networker	2:0118da9e5169	183	case HCI_OP_WRITE_SCAN_ENABLE:
networker	2:0118da9e5169	184	case HCI_OP_WRITE_LOCAL_NAME:
networker	2:0118da9e5169	185	break;
networker	2:0118da9e5169	186	#ifdef CONTR_HOST_FLOW
networker	2:0118da9e5169	187	case HCI_OP_CONTR_TO_HOST_FLOW:
networker	2:0118da9e5169	188	case HCI_OP_HOST_BUFFER_SIZE:
networker	2:0118da9e5169	189	break;
networker	2:0118da9e5169	190	case HCI_OP_NUM_COMP_PKTS:
networker	2:0118da9e5169	191	printf("Host number of Completed Packets: Invalid HCI Command Parameter\n");
networker	2:0118da9e5169	192	break;
networker	2:0118da9e5169	193	#endif
networker	2:0118da9e5169	194	case HCI_OP_READ_LOCAL_VERSION:
networker	2:0118da9e5169	195	// params
networker	2:0118da9e5169	196	//SendCmd(HCI_OP_READ_LOCAL_NAME);
networker	2:0118da9e5169	197	break;
networker	2:0118da9e5169	198
networker	2:0118da9e5169	199	case HCI_OP_READ_LOCAL_COMMANDS:
networker	2:0118da9e5169	200	break;
networker	2:0118da9e5169	201
networker	2:0118da9e5169	202	case HCI_OP_READ_LOCAL_FEATURES:
networker	2:0118da9e5169	203	//SendCmd(HCI_OP_READ_LOCAL_VERSION);
networker	2:0118da9e5169	204	break;
networker	2:0118da9e5169	205
networker	2:0118da9e5169	206	case HCI_OP_READ_LOCAL_EXT_FEATURES:
networker	2:0118da9e5169	207	break;
networker	2:0118da9e5169	208
networker	2:0118da9e5169	209	case HCI_OP_PIN_CODE_REPLY:
networker	2:0118da9e5169	210	printf("Got pin reply\n");
networker	2:0118da9e5169	211	break;
networker	2:0118da9e5169	212
networker	2:0118da9e5169	213	default:
networker	2:0118da9e5169	214	printf("Unrecognized Command Completion %04X\n",cmd);
networker	2:0118da9e5169	215	break;
networker	2:0118da9e5169	216	}
networker	2:0118da9e5169	217	}
networker	2:0118da9e5169	218
networker	2:0118da9e5169	219	void HCI::Callback(HCI_CALLBACK_EVENT c, const u8* data, int len) {
networker	2:0118da9e5169	220	if (_callback) _callback(this,c,data,len);
networker	2:0118da9e5169	221	// (this->*_callback)(c, data, len);
networker	2:0118da9e5169	222	}
networker	2:0118da9e5169	223
networker	2:0118da9e5169	224	int HCI::RemoteNameRequest(const BD_ADDR* addr) {
networker	2:0118da9e5169	225	_state \|= MASK_REMOTE_NAME;
networker	2:0118da9e5169	226	u8 buf[6+4];
networker	2:0118da9e5169	227	memset(buf,0,sizeof(buf));
networker	2:0118da9e5169	228	memcpy(buf,addr,6);
networker	2:0118da9e5169	229	//buf[7] = 1;
networker	2:0118da9e5169	230	return SendCmd(HCI_OP_REMOTE_NAME_REQ,buf,sizeof(buf));
networker	2:0118da9e5169	231	}
networker	2:0118da9e5169	232
networker	2:0118da9e5169	233	int HCI::RemoteNameRequest(inquiry_info *ii) {
networker	2:0118da9e5169	234	_state \|= MASK_REMOTE_NAME;
networker	2:0118da9e5169	235	u8 buf[6+4];
networker	2:0118da9e5169	236	//memset(buf,0,sizeof(buf));
networker	2:0118da9e5169	237	memcpy(buf,&ii->bdaddr,6);
networker	2:0118da9e5169	238	buf[6] = ii->pscan_rep_mode;
networker	2:0118da9e5169	239	buf[7] = 0;
networker	2:0118da9e5169	240	(unsigned short)(buf+8) = 0;
networker	2:0118da9e5169	241	return SendCmd(HCI_OP_REMOTE_NAME_REQ,buf,sizeof(buf));
networker	2:0118da9e5169	242	}
networker	2:0118da9e5169	243
networker	2:0118da9e5169	244	int HCI::CreateConnection(const BD_ADDR* remoteAddr) {
networker	2:0118da9e5169	245	_state \|= MASK_CREATE_CONNECTION;
networker	2:0118da9e5169	246	u8 buf[6+7];
networker	2:0118da9e5169	247	memset(buf,0,sizeof(buf));
networker	2:0118da9e5169	248	memcpy(buf,remoteAddr,6);
networker	2:0118da9e5169	249	buf[6] = 0x18; // DM1,DH1
networker	2:0118da9e5169	250	buf[7] = 0xCC; // DM3, DH3, DM5, DH5
networker	2:0118da9e5169	251	buf[8] = 1; // Page Repetition R1
networker	2:0118da9e5169	252	return SendCmd(HCI_OP_CREATE_CONN,buf,sizeof(buf));
networker	2:0118da9e5169	253	}
networker	2:0118da9e5169	254
networker	2:0118da9e5169	255	int HCI::Disconnect(const BD_ADDR* bdaddr) {
networker	2:0118da9e5169	256	BTDevice* d = Find(bdaddr);
networker	2:0118da9e5169	257	if (!d)
networker	2:0118da9e5169	258	return ERR_HCI_DEVICE_NOT_FOUND;
networker	2:0118da9e5169	259	int handle = d->_handle;
networker	2:0118da9e5169	260	printf("Disconnect from %d\n",handle);
networker	2:0118da9e5169	261	_state \|= MASK_CREATE_CONNECTION;
networker	2:0118da9e5169	262	u8 buf[3];
networker	2:0118da9e5169	263	buf[0] = handle;
networker	2:0118da9e5169	264	buf[1] = (handle >> 8);
networker	2:0118da9e5169	265	buf[2] = 0x13;
networker	2:0118da9e5169	266	return SendCmd(HCI_OP_DISCONNECT,buf,sizeof(buf));
networker	2:0118da9e5169	267	}
networker	2:0118da9e5169	268
networker	2:0118da9e5169	269	void HCI::DisconnectComplete(int handle) {
networker	2:0118da9e5169	270	BTDevice* d = Find(handle);
networker	2:0118da9e5169	271	if (!d)
networker	2:0118da9e5169	272	return;
networker	2:0118da9e5169	273	d->_handle = 0;
networker	2:0118da9e5169	274	}
networker	2:0118da9e5169	275
networker	2:0118da9e5169	276	int HCI::DisconnectAll() {
networker	2:0118da9e5169	277	BTDevice* devs[8];
networker	2:0118da9e5169	278	int count = GetDevices(devs,8);
networker	2:0118da9e5169	279	for (int i = 0; i < count; i++)
networker	2:0118da9e5169	280	Disconnect(&devs[i]->_info.bdaddr);
networker	2:0118da9e5169	281	return 0;
networker	2:0118da9e5169	282	}
networker	2:0118da9e5169	283
networker	2:0118da9e5169	284	int HCI::PinCodeReply(const u8* data, const u8* pin) {
networker	2:0118da9e5169	285	u8 b[6+1+16];
networker	2:0118da9e5169	286	memset(b,0,sizeof(b));
networker	2:0118da9e5169	287	memcpy(b,data,6);
networker	2:0118da9e5169	288	b[6] = 4;
networker	2:0118da9e5169	289	memcpy(b+7, pin, 4);
networker	2:0118da9e5169	290	return SendCmd(HCI_OP_PIN_CODE_REPLY,b,sizeof(b));
networker	2:0118da9e5169	291	}
networker	2:0118da9e5169	292
networker	2:0118da9e5169	293	void HCI::InquiryResult(const inquiry_info* info) {
networker	2:0118da9e5169	294	BTDevice* bt = Find(&info->bdaddr);
networker	2:0118da9e5169	295	if (!bt) { // new device
networker	2:0118da9e5169	296	for (int i = 0; i < MAX_BTDEVICES; i++) {
networker	2:0118da9e5169	297	if (_devices[i]._state == 0) {
networker	2:0118da9e5169	298	bt = _devices + i;
networker	2:0118da9e5169	299	bt->_state = 1;
networker	2:0118da9e5169	300	break;
networker	2:0118da9e5169	301	}
networker	2:0118da9e5169	302	}
networker	2:0118da9e5169	303	if (!bt) {
networker	2:0118da9e5169	304	printf("HCI::InquiryResult too many devices\n");
networker	2:0118da9e5169	305	return; // Too many devices!
networker	2:0118da9e5169	306	}
networker	2:0118da9e5169	307	}
networker	2:0118da9e5169	308
networker	2:0118da9e5169	309	bt->_info = *info;
networker	2:0118da9e5169	310	}
networker	2:0118da9e5169	311
networker	2:0118da9e5169	312	int HCI::GetDevices(BTDevice** devices, int maxDevices) {
networker	2:0118da9e5169	313	int j = 0;
networker	2:0118da9e5169	314	for (int i = 0; i < MAX_BTDEVICES; i++) {
networker	2:0118da9e5169	315	if (_devices[i]._state != 0) {
networker	2:0118da9e5169	316	devices[j++] = _devices + i;
networker	2:0118da9e5169	317	if (j == maxDevices)
networker	2:0118da9e5169	318	break;
networker	2:0118da9e5169	319	}
networker	2:0118da9e5169	320	}
networker	2:0118da9e5169	321	return j;
networker	2:0118da9e5169	322	}
networker	2:0118da9e5169	323
networker	2:0118da9e5169	324	void HCI::RemoteName(const BD_ADDR* addr, const char* name) {
networker	2:0118da9e5169	325	BTDevice* d = Find(addr);
networker	2:0118da9e5169	326	if (d) {
networker	2:0118da9e5169	327	strncpy(d->_name,name,sizeof(d->_name)-1);
networker	2:0118da9e5169	328	d->_name[sizeof(d->_name)-1] = 0;
networker	2:0118da9e5169	329	}
networker	2:0118da9e5169	330	}
networker	2:0118da9e5169	331
networker	2:0118da9e5169	332	void HCI::ConnectComplete(const connection_info* info) {
networker	2:0118da9e5169	333	BTDevice* d = Find(&info->bdaddr);
networker	2:0118da9e5169	334	if (!d) {
networker	2:0118da9e5169	335	printf("BT Device not known!?! "); printf(&info->bdaddr);printf("\n");
networker	2:0118da9e5169	336	return;
networker	2:0118da9e5169	337	}
networker	2:0118da9e5169	338	if (info->status == 0) {
networker	2:0118da9e5169	339	d->_handle = info->handle;
networker	2:0118da9e5169	340	#ifdef HOST_CONTR_FLOW
networker	2:0118da9e5169	341	d->pkts_sent = 0;
networker	2:0118da9e5169	342	#endif
networker	2:0118da9e5169	343	printf("Connected on %04X\n",info->handle);
networker	2:0118da9e5169	344	} else
networker	2:0118da9e5169	345	printf("Connection failed with %d\n",info->status);
networker	2:0118da9e5169	346	}
networker	2:0118da9e5169	347
networker	2:0118da9e5169	348	void HCI::Accept_Connection(const BD_ADDR* addr, bool slave) {
networker	2:0118da9e5169	349	unsigned char b[7];
networker	2:0118da9e5169	350	memcpy(b, addr, 6);
networker	2:0118da9e5169	351	b[6] = slave;
networker	2:0118da9e5169	352	BTDevice* bt = Find(addr);
networker	2:0118da9e5169	353	if (!bt){
networker	2:0118da9e5169	354	printf("Received connection request from undiscovered device\n");
networker	2:0118da9e5169	355	for (int i = 0; i < MAX_BTDEVICES; i++) {
networker	2:0118da9e5169	356	if (_devices[i]._state == 0) {
networker	2:0118da9e5169	357	bt = _devices + i;
networker	2:0118da9e5169	358	bt->_state = 1;
networker	2:0118da9e5169	359	memcpy(&(bt->_info.bdaddr), addr, 6);//rest of inquiry info unknown!!!
networker	2:0118da9e5169	360	break;
networker	2:0118da9e5169	361	}
networker	2:0118da9e5169	362	}
networker	2:0118da9e5169	363	if (!bt) {
networker	2:0118da9e5169	364	printf("HCI::InquiryResult too many devices\n");
networker	2:0118da9e5169	365	return; // Too many devices!
networker	2:0118da9e5169	366	}
networker	2:0118da9e5169	367	}
networker	2:0118da9e5169	368	SendCmd(HCI_OP_ACCEPT_CONN_REQ, b , 7);
networker	2:0118da9e5169	369	}
networker	2:0118da9e5169	370
networker	2:0118da9e5169	371	void HCI::HCIRecv(const u8* data, int len) {//[0]=event, [1]=parlen, [2...]=pars
networker	2:0118da9e5169	372	printfBytes(EvtStr(data[0]),data,min(len,16));
networker	2:0118da9e5169	373	switch (data[0]) {
networker	2:0118da9e5169	374	case HCI_EV_INQUIRY_COMPLETE:
networker	2:0118da9e5169	375	printfBytes("Inquiry Complete",data,data[1]);
networker	2:0118da9e5169	376	_state &= ~MASK_INQUIRY;
networker	2:0118da9e5169	377	Callback(CALLBACK_INQUIRY_DONE,0,0);
networker	2:0118da9e5169	378	break;
networker	2:0118da9e5169	379
networker	2:0118da9e5169	380	case HCI_EV_INQUIRY_RESULT: {
networker	2:0118da9e5169	381	const u8* end = data[1] + data + 2;
networker	2:0118da9e5169	382	data += 3;
networker	2:0118da9e5169	383	while (data < end) {
networker	2:0118da9e5169	384	inquiry_info align;
networker	2:0118da9e5169	385	memcpy(&align,data,sizeof(inquiry_info));
networker	2:0118da9e5169	386	InquiryResult(&align);
networker	2:0118da9e5169	387	Callback(CALLBACK_INQUIRY_RESULT,(u8*)&align,sizeof(inquiry_info));
networker	2:0118da9e5169	388	data += 14;
networker	2:0118da9e5169	389	}
networker	2:0118da9e5169	390	}
networker	2:0118da9e5169	391	break;
networker	2:0118da9e5169	392
networker	2:0118da9e5169	393	case HCI_EV_CONN_COMPLETE:
networker	2:0118da9e5169	394	_state &= ~MASK_CREATE_CONNECTION;
networker	2:0118da9e5169	395	{
networker	2:0118da9e5169	396	connection_info align;
networker	2:0118da9e5169	397	memcpy(&align,data+2,sizeof(connection_info));
networker	2:0118da9e5169	398	ConnectComplete(&align);
networker	2:0118da9e5169	399	Callback(CALLBACK_CONNECTION_COMPLETE,(u8*)&align,sizeof(connection_info));
networker	2:0118da9e5169	400	}
networker	2:0118da9e5169	401	break;
networker	2:0118da9e5169	402
networker	2:0118da9e5169	403	case HCI_EV_CONN_REQUEST:
networker	2:0118da9e5169	404	printf("Got Connection request \n");
networker	2:0118da9e5169	405	Callback(CALLBACK_CONNECTION_REQUEST, data+2, data[1]);
networker	2:0118da9e5169	406	Accept_Connection((BD_ADDR*)(data+2));
networker	2:0118da9e5169	407	break;
networker	2:0118da9e5169	408
networker	2:0118da9e5169	409	case HCI_EV_DISCONN_COMPLETE:
networker	2:0118da9e5169	410	DisconnectComplete(LE16(data+3));
networker	2:0118da9e5169	411	break;
networker	2:0118da9e5169	412
networker	2:0118da9e5169	413	case HCI_EV_REMOTE_NAME: {
networker	2:0118da9e5169	414	BD_ADDR* addr = (BD_ADDR*)(data+3);
networker	2:0118da9e5169	415	const char* name = (const char*)(data + 9);
networker	2:0118da9e5169	416	RemoteName(addr,name);
networker	2:0118da9e5169	417	}
networker	2:0118da9e5169	418	Callback(CALLBACK_REMOTE_NAME,data+3,LE16(data+1)); // addr is in here too
networker	2:0118da9e5169	419	_state &= ~MASK_REMOTE_NAME;
networker	2:0118da9e5169	420	break;
networker	2:0118da9e5169	421
networker	2:0118da9e5169	422	case HCI_EV_CMD_STATUS: {
networker	2:0118da9e5169	423	const char* errs = HCIErrStr(data[2]);
networker	2:0118da9e5169	424	printf("Status %s %s %d cmd pkts\n",CmdStr(LE16(data+4)),errs, data[3]);
networker	2:0118da9e5169	425	#ifdef COMMAND_FLOW
networker	2:0118da9e5169	426	cmd_credits = data[3];
networker	2:0118da9e5169	427	#endif
networker	2:0118da9e5169	428	}
networker	2:0118da9e5169	429	Callback(CALLBACK_CMD_STATUS, data+2, 4);
networker	2:0118da9e5169	430	break;
networker	2:0118da9e5169	431
networker	2:0118da9e5169	432	case HCI_EV_CMD_COMPLETE://[2]=cmd-pkts, [3-4]=cmd, [5...]=pars
networker	2:0118da9e5169	433	if (data[5]) { //[5]=usually status
networker	2:0118da9e5169	434	printf("HCIRecv error status: %s\n", HCIErrStr(data[5]));
networker	2:0118da9e5169	435	}
networker	2:0118da9e5169	436	OnCommandComplete(data[3] \| (data[4] << 8), data+6, data[1]-4);
networker	2:0118da9e5169	437	#ifdef COMMAND_FLOW
networker	2:0118da9e5169	438	cmd_credits = data[2];
networker	2:0118da9e5169	439	#endif
networker	2:0118da9e5169	440	break;
networker	2:0118da9e5169	441
networker	2:0118da9e5169	442	case HCI_EV_PIN_CODE_REQ:
networker	2:0118da9e5169	443	Callback(CALLBACK_PIN_REQ, data+2, 6);
networker	2:0118da9e5169	444	//PinCodeReply(data+2);
networker	2:0118da9e5169	445	break;
networker	2:0118da9e5169	446
networker	2:0118da9e5169	447	case HCI_EV_LINK_KEY_REQ:
networker	2:0118da9e5169	448	SendCmd(HCI_OP_LINK_KEY_NEG_REPLY,data+2,6);
networker	2:0118da9e5169	449	break;
networker	2:0118da9e5169	450	#ifdef HOST_CONTR_FLOW
networker	2:0118da9e5169	451	case HCI_EV_NUM_COMP_PKTS:
networker	2:0118da9e5169	452	for (int k = 0; k < data[2]; k++) {//data[2] and 'c' are usually 1
networker	2:0118da9e5169	453	u16 h = LE16(data+3+2*k);
networker	2:0118da9e5169	454	u16 c = LE16(data+5+2*k);
networker	2:0118da9e5169	455	BTDevice *d = Find(h);
networker	2:0118da9e5169	456	if (!d)
networker	2:0118da9e5169	457	continue;//skip no existing devices
networker	2:0118da9e5169	458	if (d->pkts_sent >= c){
networker	2:0118da9e5169	459	d->pkts_sent -= c;
networker	2:0118da9e5169	460	_transport->data_credits += c;
networker	2:0118da9e5169	461	}
networker	2:0118da9e5169	462	else
networker	2:0118da9e5169	463	d->pkts_sent = 0;
networker	2:0118da9e5169	464	//printf("%d Outstanding pkts for handle %03X (total credits=%d)\n", d->pkts_sent, h, _transport->data_credits);
networker	2:0118da9e5169	465	}
networker	2:0118da9e5169	466	break;
networker	2:0118da9e5169	467	#endif
networker	2:0118da9e5169	468	case HCI_EV_LINK_KEY_NOTIFY:
networker	2:0118da9e5169	469	case HCI_EV_ENCRYPT_CHANGE:
networker	2:0118da9e5169	470	//for(int k=0; k<1000000;k++) USBLoop();
networker	2:0118da9e5169	471	break;
networker	2:0118da9e5169	472
networker	2:0118da9e5169	473	default:
networker	2:0118da9e5169	474	printfBytes("HCIRecv:",data,data[1]+2);
networker	2:0118da9e5169	475	break;
networker	2:0118da9e5169	476	}
networker	2:0118da9e5169	477	}
networker	2:0118da9e5169	478
networker	2:0118da9e5169	479	int HCI::Open(SocketInternal* sock, SocketAddrHdr* addr) {
networker	2:0118da9e5169	480	L2CAPSocket* l2capsock = (L2CAPSocket*)sock;
networker	2:0118da9e5169	481	L2CAPAddr* l2capaddr = (L2CAPAddr*)addr;
networker	2:0118da9e5169	482	BTDevice* bt = Find(&l2capaddr->bdaddr);
networker	2:0118da9e5169	483	if (!bt) {
networker	2:0118da9e5169	484	printf("Can't open l2cap %d on ",l2capaddr->psm);
networker	2:0118da9e5169	485	printf(&l2capaddr->bdaddr);
networker	2:0118da9e5169	486	printf("\n");
networker	2:0118da9e5169	487	return ERR_HCI_DEVICE_NOT_FOUND;
networker	2:0118da9e5169	488	}
networker	2:0118da9e5169	489	l2capsock->btdevice = bt;
networker	2:0118da9e5169	490	return bt->Open(sock,addr);
networker	2:0118da9e5169	491	}
networker	2:0118da9e5169	492
networker	2:0118da9e5169	493	int HCI::Accept(SocketInternal* sock, int scid, int rxid) {
networker	2:0118da9e5169	494	L2CAPSocket* l2capsock = (L2CAPSocket*)sock;
networker	2:0118da9e5169	495	BTDevice* bt = (BTDevice*)sock->userData;
networker	2:0118da9e5169	496	if (!bt) {
networker	2:0118da9e5169	497	printf("Can't accept l2cap on socket %d\n", sock->ID);
networker	2:0118da9e5169	498	return ERR_HCI_DEVICE_NOT_FOUND;
networker	2:0118da9e5169	499	}
networker	2:0118da9e5169	500	l2capsock->btdevice = bt;
networker	2:0118da9e5169	501	return bt->Accept(sock, scid, rxid);
networker	2:0118da9e5169	502	}
networker	2:0118da9e5169	503
networker	2:0118da9e5169	504	int HCI::Send(SocketInternal* sock, const u8* data, int len) {//check here for appropriate buffersize on the device
networker	2:0118da9e5169	505	/* these checks are HCI functions but this 'Send' does not catch all ACL traffic, so it is better done in L2CAP or transport
networker	2:0118da9e5169	506	//assume acl packet
networker	2:0118da9e5169	507	//FIXME: treatment of OFFSET is dubious, OFFSET is not defined?!
networker	2:0118da9e5169	508	#if OFFSET==8 //sizeof ACL/L2CAP is include in data/len
networker	2:0118da9e5169	509	if (len > _acl_mtu)
networker	2:0118da9e5169	510	#else //OFFSET==0, data is bare application frame
networker	2:0118da9e5169	511	if (len+8 > _acl_mtu)
networker	2:0118da9e5169	512	#endif
networker	2:0118da9e5169	513	{ printf("Max outgoing packet(%d) size exceeded, segmenting necessary, pktlen = %d\n", _acl_mtu, len);
networker	2:0118da9e5169	514	}
networker	2:0118da9e5169	515	if (data_credits == 0) {
networker	2:0118da9e5169	516	printf("Out of ACL data credits\n");
networker	2:0118da9e5169	517	return 0;
networker	2:0118da9e5169	518	}
networker	2:0118da9e5169	519	data_credits--;
networker	2:0118da9e5169	520	*/
networker	2:0118da9e5169	521	L2CAPSocket* l2capsock = (L2CAPSocket*)sock;
networker	2:0118da9e5169	522	return l2capsock->btdevice->Send(sock,data,len); // Pointless double dispatch
networker	2:0118da9e5169	523	}
networker	2:0118da9e5169	524
networker	2:0118da9e5169	525	int HCI::Close(SocketInternal* sock) {
networker	2:0118da9e5169	526	L2CAPSocket* l2capsock = (L2CAPSocket*)sock;
networker	2:0118da9e5169	527	return l2capsock->btdevice->Close(sock); // Pointless double dispatch
networker	2:0118da9e5169	528	}
networker	2:0118da9e5169	529
networker	2:0118da9e5169	530	void HCI::Compl_pkts(int handle, u8 p) {
networker	2:0118da9e5169	531	u8 b[8] = {(u8)HCI_OP_NUM_COMP_PKTS, HCI_OP_NUM_COMP_PKTS >> 8, 5, 1, 0, 0, 1, 0};
networker	2:0118da9e5169	532	b[4] = handle;
networker	2:0118da9e5169	533	b[5] = (handle&0x0f00)>>8;
networker	2:0118da9e5169	534	b[6] = p;//only one packet
networker	2:0118da9e5169	535	_transport->HCISend(b, 8);//directly call the transport layer to prevent the command flow control from interfering
networker	2:0118da9e5169	536	}
networker	2:0118da9e5169	537
networker	2:0118da9e5169	538	void HCI::ACLRecv(const u8* data, int len) {
networker	2:0118da9e5169	539	int handle = LE16(data);
networker	2:0118da9e5169	540	BTDevice* d = Find(handle & 0x0FFF);
networker	2:0118da9e5169	541	int bufs = 1;
networker	2:0118da9e5169	542	if (!d){
networker	2:0118da9e5169	543	printfBytes("unk. dest. HCI:ACLRecv ", data, len);
networker	2:0118da9e5169	544	}
networker	2:0118da9e5169	545	else
networker	2:0118da9e5169	546	bufs = d->ACLRecv(data,len);
networker	2:0118da9e5169	547	//controller to host flow control
networker	2:0118da9e5169	548	#ifdef CONTR_HOST_FLOW
networker	2:0118da9e5169	549	//the ACLRecv function returned so we assume that the buffer is free, and tell this to the controller
networker	2:0118da9e5169	550	if (bufs) {
networker	2:0118da9e5169	551	Compl_pkts(handle, bufs);//this packet is completed
networker	2:0118da9e5169	552	printf("%d ACL buffers completed\n", bufs);
networker	2:0118da9e5169	553	}
networker	2:0118da9e5169	554	#endif
networker	2:0118da9e5169	555	}
networker	2:0118da9e5169	556
networker	2:0118da9e5169	557	//===================================================================
networker	2:0118da9e5169	558	//===================================================================

Repository toolbox

Export to desktop IDE

Build repository

Repository details

Type:	Program
Mbed OS support:	Mbed 2 deprecated
Created:	04 Apr 2011
Imports:	1797
Forks:	0
Commits:	14
Dependents:	3
Dependencies:	3
Followers:	49

hci.cpp@4:b94984a20500, 2011-05-08 (annotated)

Who changed what in which revision?

Repository toolbox

Repository details

Important Information for this Arm website

Access Warning