From e47ae802678720f0859cd76e00a7254b03ef5ace Mon Sep 17 00:00:00 2001 From: David Plotek Date: Thu, 21 Aug 2008 12:43:52 +0200 Subject: [PATCH] new version of callback functions and new was added --- src2/Makefile.omk | 6 +- src2/bt_hw.c | 136 +- src2/bt_hw.h | 22 +- src2/hil2cap.c | 404 ----- src2/testapp.c | 109 +- src2/testapp.h | 13 + src2/testslave.c | 40 + src2/{hcidriver.c => tiny_bt_hci_cmd.c} | 96 +- src2/{hcidriver.h => tiny_bt_hci_cmd.h} | 27 +- src2/tiny_bt_hci_core.c | 455 ++++++ src2/{hil2cap.h => tiny_bt_hci_core.h} | 49 +- testf/t4/Makefile | 2 + testf/t4/bt_hw.c | 86 ++ testf/t4/bt_hw.h | 40 + testf/t4/hciembeded.h | 1851 +++++++++++++++++++++++ testf/t4/testapp.h | 24 + testf/t4/testslave.c | 40 + testf/t4/tiny_bt_hci_cmd.c | 217 +++ testf/t4/tiny_bt_hci_cmd.h | 174 +++ testf/t4/tiny_bt_hci_core.h | 100 ++ 20 files changed, 3251 insertions(+), 640 deletions(-) delete mode 100644 src2/hil2cap.c create mode 100644 src2/testslave.c rename src2/{hcidriver.c => tiny_bt_hci_cmd.c} (68%) rename src2/{hcidriver.h => tiny_bt_hci_cmd.h} (86%) create mode 100644 src2/tiny_bt_hci_core.c rename src2/{hil2cap.h => tiny_bt_hci_core.h} (57%) create mode 100644 testf/t4/Makefile create mode 100644 testf/t4/bt_hw.c create mode 100644 testf/t4/bt_hw.h create mode 100644 testf/t4/hciembeded.h create mode 100644 testf/t4/testapp.h create mode 100644 testf/t4/testslave.c create mode 100644 testf/t4/tiny_bt_hci_cmd.c create mode 100644 testf/t4/tiny_bt_hci_cmd.h create mode 100644 testf/t4/tiny_bt_hci_core.h diff --git a/src2/Makefile.omk b/src2/Makefile.omk index a297560..60e78dd 100644 --- a/src2/Makefile.omk +++ b/src2/Makefile.omk @@ -1,3 +1,3 @@ -bin_PROGRAMS = hil2cap -hil2cap_SOURCES = hil2cap.c hcidriver.c -hil2cap_LIBS = \ No newline at end of file +bin_PROGRAMS = tiny_bt +tiny_bt_SOURCES = testapp.c tiny_bt_hci_cmd.c tiny_bt_hci_core.c bt_hw.c +tiny_bt_LIBS = \ No newline at end of file diff --git a/src2/bt_hw.c b/src2/bt_hw.c index af5e50d..00d18f6 100644 --- a/src2/bt_hw.c +++ b/src2/bt_hw.c @@ -1,7 +1,7 @@ /* * C Implementation: bt_hw * -* Description: +* Description: hardweare function for sockets * * * Author: root , (C) 2008 @@ -9,104 +9,78 @@ * Copyright: See COPYING file that comes with this distribution * */ -int hw_dd; -__u8 hw_type; +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "bt_hw.h" +#include "hciembeded.h" +static int hw_dd; -int hw_bt_open_device(__u8 type, __u8 dev_id){ - hw_type=type; - - switch(type){ - - case 0:{ - struct sockaddr_hci address; - int dd; - int oldflag; +int hw_bt_open_device(__u8 dev_id){ + struct sockaddr_hci address; + int dd; + int oldflag; + if((dd=socket(AF_BLUETOOTH, SOCK_RAW, BTPROTO_HCI))<0){ + perror("socket no created"); + return dd; //it return -1 when socket isn't created + } - if((dd=socket(AF_BLUETOOTH, SOCK_RAW, BTPROTO_HCI))<0){ - perror("socket no created"); - return dd; //it return -1 when socket isn't created - } - - oldflag=fcntl(dd, F_GETFL, 0); - if(fcntl(dd, F_SETFL, oldflag | O_NONBLOCK) < 0){ - perror("problem with socket flag setting"); - return -1; - } + oldflag=fcntl(dd, F_GETFL, 0); + if(fcntl(dd, F_SETFL, oldflag | O_NONBLOCK) < 0){ + perror("problem with socket flag setting"); + return -1; + } - memset(&address,0,sizeof(address)); - address.hci_family=AF_BLUETOOTH; - address.hci_dev=dev_id; - if(bind(dd,(struct sockaddr *) &address, sizeof(address))<0){ - perror("Socket not binded to hci device"); - close(dd); - return -1; - } + memset(&address,0,sizeof(address)); + address.hci_family=AF_BLUETOOTH; + address.hci_dev=dev_id; + if(bind(dd,(struct sockaddr *) &address, sizeof(address))<0){ + perror("Socket not binded to hci device"); + close(dd); + return -1; + } - if(ioctl(dd, HCISETRAW,1)<0){ - perror("error in ioctl HCISETRAW"); - return -1; + if(ioctl(dd, HCISETRAW,1)<0){ + perror("error in ioctl HCISETRAW"); + return -1; - } - hw_dd=dd; - return dd; - } - case 1:{ - - } } - - return -1; + hw_dd=dd; + return dd; } int hw_bt_close_dev(){ - switch(hw_type){ - case 0:{ - return close(hw_dd); - } - case 1:{ - - } - - } - - return -1; + return close(hw_dd); } int hw_bt_write(__u8 *p_array, __u16 length){ - switch(hw_type){ - case 0:{ - while(write(hw_dd, p_array, length)<0){ - perror("write interrupted"); - if(errno == EAGAIN || errno == EINTR) - continue; - return -1; - } - } - case 1:{ - - } + while(write(hw_dd, p_array, length)<0){ + perror("write interrupted"); + if(errno == EAGAIN || errno == EINTR) + continue; + return -1; + } return 0; } int hw_bt_read(__u8 *p_recbuf){ int len; - switch(hw_type){ - case 0:{ - while((len=read(hw_dd, p_recbuf, sizeof(p_recbuf*HCI_MAX_EVENT_SIZE)))<0){ - if(errno == EINTR) - continue; - if(errno == EAGAIN) - return 0; - perror("Problem with reading \n"); - return -1; - } - return len; - } - case 1:{ - - } + while((len=read(hw_dd, p_recbuf, sizeof(p_recbuf)*HCI_MAX_EVENT_SIZE))<0){ + if(errno == EINTR) + continue; + if(errno == EAGAIN) + return 0; + perror("Problem with reading \n"); + return -1; } - + return len; } + diff --git a/src2/bt_hw.h b/src2/bt_hw.h index 91f40d6..7e9b258 100644 --- a/src2/bt_hw.h +++ b/src2/bt_hw.h @@ -12,11 +12,29 @@ #ifndef __BT_HW #define __BT_HW -extern int hw_bt_open_device(__u8 type, __u8 dev_id); +#include + +/* BT protocols(from bluetooth.h)*/ +#define BTPROTO_L2CAP 0 +#define BTPROTO_HCI 1 +#define BTPROTO_SCO 2 +#define BTPROTO_RFCOMM 3 +#define BTPROTO_BNEP 4 +#define BTPROTO_CMTP 5 +#define BTPROTO_HIDP 6 +#define BTPROTO_AVDTP 7 + +#define SOL_HCI 0 +#define SOL_L2CAP 6 +#define SOL_SCO 17 +#define SOL_RFCOMM 18 + +extern int hw_bt_open_device(__u8 dev_id); extern int hw_bt_close_dev(); extern int hw_bt_write(__u8 *p_array, __u16 length); extern int hw_bt_read(__u8 *p_recbuf); -#endif \ No newline at end of file +#endif + diff --git a/src2/hil2cap.c b/src2/hil2cap.c deleted file mode 100644 index 3b59493..0000000 --- a/src2/hil2cap.c +++ /dev/null @@ -1,404 +0,0 @@ -/* -* C Implementation: testovaci -* -* Description: -* -* -* Author: root , (C) 2008 -* -* Copyright: See COPYING file that comes with this distribution -* -*/ -#include -#include -#include -#include -#include -#include "hil2cap.h" -#include "hcidriver.h" - - -expect_evt evt_array[MAX_CMD_STATE_REQUEST]; -int evt_id; -int global_index; -connection_hci connection,*p_connection=&connection; - - -void add_evt_toarray(expect_evt *p_evt){ //fcn add the request at the end of array or replace the oldest request - int i,sig=0,index=0; - incoming_evt the_oldest=evt_array[0]; - - for(i=0;icon_id=0; - p_connection->con_state=DISCONNECTED; - - memset(p_evt,0,sizeof(evt)); - p_evt->actual_status=status; - p_evt->id=evt_id++; - p_evt->evt_type=EVT_CMD_STATUS; - - add_evt_toarray(p_evt); - -} - -int tiny_bt_process(){ - int len,j,index; - hci_event_hdr *p_hdr; - __u8 recbuf[HCI_MAX_EVENT_SIZE],*p_recbuf; - - len = hw_bt_read(recbuf); - - if(len){ - printf("Count of received bytes %d \n ",len); - for(j=0;jevt))<0){ - printf("There is no awaiting evt like this\n"); - return -1; - } - else{ - if(evt_array[index].p_callback(evt_array[index].p_data, p_recbuf)<0){ - printf("error with service rutine"); - return -1; - } - if(evt_array[index].actual_status != PERMANENT){ - evt_array[index].actual_status = DONE; - } - } - return 1; - } - else if(recbuf[0]==2){ - - } - else return 0; // 0 or -1 - - } - else{ - printf("There is nothing on socket %d \n",dd); - return 0; - } - - return 0; -} - - -int tiny_bt_read_bd_addr(bd_address *p_dest, void (*callback_app_read_bd_addr)(bt_address *p_address)){ - expect_evt evt,*p_evt=&evt; - req_state status = ESTABLISHED; - read_bd_addr_data *p_data; - - memset(p_evt,0,sizeof(evt)); - p_evt->actual_status=status; - p_evt->id=evt_id++; - p_evt->evt_type=EVT_CMD_COMPLETE; - p_evt->req_opcode=READ_BD_ADDR_CMD_OP; - p_evt->p_callback=&callback_hci_read_bd_addr; - - p_data=malloc(sizeof(read_bd_addr_data)); - p_data->p_address=p_dest; - p_data->callback_app_read_bd_addr=callback_app_read_bd_addr; - p_evt->p_data=(void *)p_data; - - add_evt_toarray(p_evt); - if(send_hci_read_bd_addr_cmd()<0){ - perror("send_hci_cmd error"); - return -1; - } - return 0; -} - -int tiny_bt_read_local_name(char *p_name, void (*callback_app_read_local_name)(char *p_name)){ - expect_evt evt,*p_evt=&evt; - req_state status = ESTABLISHED; - read_local_name_data *p_data; - - memset(p_evt,0,sizeof(evt)); - p_evt->actual_status=status; - p_evt->id=evt_id++; - p_evt->evt_type=EVT_CMD_COMPLETE; - p_evt->req_opcode=READ_LOCAL_NAME_CMD_OP; - p_evt->p_callback=callback_hci_read_local_name; - - p_data=malloc(sizeof(read_local_name_data)); - p_data->p_name=p_name; - p_data->callback_hci_read_local_name=callback_app_read_local_name; - p_evt->p_data=(void *)p_data; - - add_evt_toarray(p_evt); - if(send_hci_read_local_name_cmd()<0){ - perror("send_hci_cmd error"); - return -1; - } - return 0; -} - -int tiny_bt_connect(bt_address *p_dest_addr, __u16 *p_handle, void (*callback_app_connection_complete)(__u16 *p_handle, bt_address *p_address)){ - expect_evt evt,*p_evt=&evt; - req_state status = ESTABLISHED; - connection_complete_data *p_data; - - memset(p_evt,0,sizeof(evt)); - p_evt->actual_status=status; - p_evt->id=evt_id++; - p_evt->evt_type=EVT_CONN_COMPLETE; - p_evt->req_opcode=CREATE_CONNECTION_CMD_OP; - p_evt->p_callback=callback_hci_connection_complete; - - p_data=malloc(sizeof(connection_complete_data)); - p_data->p_handle=p_handle; - p_data->callback_app_connection_complete=callback_app_connection_complete; - p_evt->p_data=(void *)p_data; - - add_evt_toarray(p_evt); - if(send_hci_create_connection_cmd(p_dest_addr)<0){ - perror("send_hci_cmd error"); - return -1; - } - return 0; - -} - -int tiny_bt_wait_for_connection(){ - -} - - - - - - -int create_master_connection(connection_hci *p_connection){//establish connection and send a coutn of bytes every x second - //array of open request which are in waiting state for appropriate event or answer - p_connection->con_id=0; - p_connection->con_state=DISCONNECTED; - - p_connection->socket_fd=hci_open_device_sraw(p_connection->master.dev_id); - if(l2cap_call_cmd(CREATE_CONNECTION_CMD_OP,p_connection->socket_fd,p_connection)<0){ - printf("connection problem \n"); - return -1; - } - - - return 0; -} - -int show_all_local_dev(struct hci_dev_info *master){ // and choose a master device which will initiate the connection - int sock,i; - struct hci_dev_list_req dlist,*p_dlist=&dlist; - struct hci_dev_req *p_dreq; - - p_dlist->dev_num=HCI_MAX_DEV; - p_dreq=p_dlist->dev_req; - - if((sock=socket(AF_BLUETOOTH, SOCK_RAW, BTPROTO_HCI))<0){ - return -1; - } - - if((ioctl(sock, HCIGETDEVLIST, (void *) p_dlist))<0){ - return -1; - } - if(p_dlist->dev_num > 0){ - struct hci_dev_info dev_array[p_dlist->dev_num]; - for(i=0;idev_num;i++){ - dev_array[i].dev_id=(p_dreq+i)->dev_id; - if(ioctl(sock, HCIGETDEVINFO, (void *) &dev_array[i])<0){ - printf("No info"); - continue; - } - int dd=hci_open_device(dev_array[i].dev_id); - if(l2cap_call_cmd(READ_BD_ADDR_CMD_OP,dd,&dev_array[i].bdaddr)< 0){ - printf("Error in call hci bd addr cmd \n"); - return -1; - } - if(l2cap_call_cmd(READ_LOCAL_NAME_CMD_OP,dd,&dev_array[i].name)< 0){ - printf("Error in call hci bd addr cmd \n"); - return -1; - } - //hci_close_dev(dev_array[i].dev_id); - } - *master = dev_array[0]; //I will take a first dev like a master - - } - else{ - printf("There is no hci device \n"); - return -1; - } - return 0; - -} - -int show_all_remote_dev(struct hci_dev_info *p_master, bt_address *p_remadrar, int *p_remd_count){ - int dd=hci_open_device(p_master->dev_id); - - if((*p_remd_count=l2cap_call_cmd(INQUIRY_CMD_OP, dd, p_remadrar))< 0){ - printf("Error in call inquiry command \n"); - return -1; - } - return 0; - -} - -int l2cap_call_cmd(__u16 ocf_ogf,int dd, void *p_param){ - cmd_state_request new_req,*p_new_req=&new_req; - __u16 sw_opcode; - int remd_count,ret_val; - sw_opcode=swap_2_bytes(ocf_ogf); - p_new_req->actual_status=ESTABLISHED; - p_new_req->id=cmd_req_id++; - p_new_req->req_opcode = ocf_ogf; - - switch(ocf_ogf){ - - case READ_BD_ADDR_CMD_OP: - p_new_req->evt_code = EVT_CMD_COMPLETE; - p_new_req->p_serv_rutine=NULL; - - if(req_fcn_add(p_new_req)<0){ - printf("Mistake with req array adding \n "); - return -1; - } - - if(call_hci_read_bd_addr_cmd(dd,(bt_address *)p_param,&sw_opcode)){ - printf("Mistake with bt addr cmd \n "); - return -1; - } - req_fcn_remove(); - return 0; - - case READ_LOCAL_NAME_CMD_OP: - p_new_req->evt_code = EVT_CMD_COMPLETE; - p_new_req->p_serv_rutine=NULL; - - if(req_fcn_add(p_new_req)<0){ - printf("Mistake with req array adding \n "); - return -1; - } - if(call_hci_read_local_name_cmd(dd,p_param,&sw_opcode)){ - printf("Mistake with read local name cmd \n "); - return -1; - } - req_fcn_remove(); - return 0; - - case INQUIRY_CMD_OP: - - p_new_req->evt_code = EVT_INQUIRY_COMPLETE; - p_new_req->p_serv_rutine=NULL; - - if(req_fcn_add(p_new_req)<0){ - printf("Mistake with req array adding \n "); - return -1; - } - if((remd_count=call_hci_inquiry_cmd(dd,p_param,&sw_opcode)) < 0){ - printf("Mistake with inquiry cmd \n "); - return -1; - } - req_fcn_remove(); - return remd_count; - - case CREATE_CONNECTION_CMD_OP: - p_new_req->evt_code = EVT_CONN_COMPLETE; - p_new_req->p_serv_rutine=NULL; - - if(req_fcn_add(p_new_req)<0){ - printf("Mistake with req array adding \n "); - return -1; - } - if((ret_val=call_hci_create_connection_cmd(dd, &(((connection_hci *)p_param)->slave.bdaddr), &sw_opcode)) < 0){ - printf("Mistake with inquiry cmd \n "); - return -1; - } - ((connection_hci *)p_param)->handle=ret_val; - ((connection_hci *)p_param)->con_state=CONNECTED; - req_fcn_remove(); - return 0; - } - - return 0; -} - - -int main(void){ - struct hci_dev_info master,*p_master=&master; - bt_address remote_bd_addr_array[HCI_MAX_DEV]; - connection_hci connection,*p_connection=&connection; - memset(remote_bd_addr_array,0,(sizeof(bt_address)*HCI_MAX_DEV)); - bt_address prefered; - int remd_count,i; - cmd_req_id=0; - global_index=0; - memset(array_req,0,(sizeof(cmd_state_request)*MAX_CMD_STATE_REQUEST)); - if(show_all_local_dev(p_master)<0){ - printf("error no dev \n"); - return -1; - } - if(show_all_remote_dev(p_master, remote_bd_addr_array, &remd_count)<0){ - printf("error no remote dev \n"); - return -1; - } - printf("All remote devices:\n"); - for(i=0;imaster=master; - p_connection->slave.bdaddr=remote_bd_addr_array[0]; - //fill_add(&prefered,0x31,0x16,0xCA,0x72,0x02,0x00); - //p_connection->slave.bdaddr=prefered; - if(create_master_connection(p_connection)<0){ - printf("connection error"); - return -1; - } - -return 0; -} - diff --git a/src2/testapp.c b/src2/testapp.c index a3861b1..453ab8a 100644 --- a/src2/testapp.c +++ b/src2/testapp.c @@ -9,41 +9,110 @@ * Copyright: See COPYING file that comes with this distribution * */ -bt_address rem_bd_addr_array[HCI_MAX_DEV]; +#include +#include +#include +#include +#include "tiny_bt_hci_core.h" +#include "tiny_bt_hci_cmd.h" +#include "testapp.h" -int callback_app_read_bd_addr(bt_address *p_address){ +bt_address rem_bd_addr_array[HCI_MAX_DEV]; +bt_address rem_addr; +int glob_count; +connection_hci connection,*p_connection=&connection; +void callback_app_read_bd_addr(bt_address *p_address){ + printf("Read address is :"); + printba(p_address); + tiny_bt_read_local_name(&(p_connection->master.name), callback_app_read_local_name); } -int callback_app_read_local_name(char *p_name){ - - +void callback_app_read_local_name(char *p_name){ + int i; + printf("read name is:"); + for(i=0;i<8;i++){ + printf("%c",*(p_name+i)); + } + printf("\n"); + tiny_bt_inquiry(&rem_addr, callback_app_inquiry_RSSI, callback_app_inquiry_complete); } -int callback_app_inquiry_RSSI(bt_address *p_address){ - +void callback_app_inquiry_RSSI(bt_address *p_address){ + static int count=0; + int i,sign=0; + + if(count==0){ + rem_bd_addr_array[0]=*p_address; + count++; + } + else{ + for(i=0;islave.bdaddr=rem_bd_addr_array[0]; + tiny_bt_connect(&rem_bd_addr_array[0],&p_connection->handle, callback_app_connection_complete); + } - -int main(void){ - bt_device device,*p_device=&device; - memset(p_device,0,sizeof(bt_device)) - p_device->type=LINUX; - tiny_bt_init(p_device); - - +void callback_app_connection_complete(__u16 *p_handle){ + connection_state state = CONNECT; + p_connection->con_state=state; + printf("Connection complete handle:%d\n",*p_handle); +} - +int main(void){ + int ii=30000; + tiny_bt_init(0); + printf("begin of main\n"); + if(tiny_bt_read_bd_addr(&p_connection->master.bdaddr, callback_app_read_bd_addr)<0){ + perror("tiny_bt_read_bd_addr error"); + return -1; + } + while(1){ + + ii--; + if(tiny_bt_process()<0){ + perror("process error"); + return -1; + } + + } return 0; -} \ No newline at end of file +} + diff --git a/src2/testapp.h b/src2/testapp.h index 32198dd..77e219e 100644 --- a/src2/testapp.h +++ b/src2/testapp.h @@ -9,3 +9,16 @@ // Copyright: See COPYING file that comes with this distribution // // +#ifndef __TEST +#define __TEST +extern void callback_app_read_bd_addr(bt_address *p_address); +extern void callback_app_read_local_name(char *p_name); +extern void callback_app_inquiry_RSSI(bt_address *p_address); +extern void callback_app_connection_complete(__u16 *p_handle); +extern void callback_app_inquiry_complete(void); + + + + +#endif + diff --git a/src2/testslave.c b/src2/testslave.c new file mode 100644 index 0000000..6359049 --- /dev/null +++ b/src2/testslave.c @@ -0,0 +1,40 @@ +/* +* C Implementation: testslave +* +* Description: +* +* +* Author: root , (C) 2008 +* +* Copyright: See COPYING file that comes with this distribution +* +*/ + +#include +#include +#include +#include +#include "tiny_bt_hci_core.h" +#include "tiny_bt_hci_cmd.h" +#include "testapp.h" + + +int main(void){ + int ii=30000; + tiny_bt_init(1); + printf("begin of main\n"); + //if(tiny_bt_read_bd_addr(&p_connection->master.bdaddr, callback_app_read_bd_addr)<0){ +// perror("tiny_bt_read_bd_addr error"); +// return -1; +// } + while(1){ + + ii--; + if(tiny_bt_process()<0){ + perror("process error"); + return -1; + } + + } + return 0; +} \ No newline at end of file diff --git a/src2/hcidriver.c b/src2/tiny_bt_hci_cmd.c similarity index 68% rename from src2/hcidriver.c rename to src2/tiny_bt_hci_cmd.c index 9fbbbae..2e7f5e6 100644 --- a/src2/hcidriver.c +++ b/src2/tiny_bt_hci_cmd.c @@ -1,14 +1,13 @@ #include #include -#include #include #include #include #include #include #include -#include -#include "hcidriver.h" +#include "tiny_bt_hci_cmd.h" +#include "bt_hw.h" @@ -32,9 +31,10 @@ int send_hci_inquiry_cmd(void){ p_creq->p_cmdp=p_cmdp; p_creq->cmdp_len=INQUIRY_CP_SIZE; - if(send_cmd(p_creq)<0) + if(send_cmd(p_creq)<0){ perror("hci_inquiry_cmd wasn't sent"); return -1; + } return 0; } // fill up the input parameter address pointer by one address @@ -45,9 +45,10 @@ int send_hci_read_bd_addr_cmd(void){ p_creq->OCF_OGF=READ_BD_ADDR_CMD_OP; p_creq->cmdp_len=0; - if(send_cmd(p_creq)<0) + if(send_cmd(p_creq)<0){ perror("hci_read_bd_addr wasn't sent"); return -1; + } return 0; } @@ -58,9 +59,10 @@ int send_hci_read_local_name_cmd(void){ p_creq->OCF_OGF=READ_LOCAL_NAME_CMD_OP; p_creq->cmdp_len=0; - if(send_smd(p_creq)<0) + if(send_cmd(p_creq)<0){ perror("hci_read_local_name_cmd wasn't sent"); return -1; + } return 0; } @@ -76,14 +78,14 @@ int send_hci_create_connection_cmd(bt_address *p_dest_addr){ p_cmdp->clock_offset=0xf000; p_cmdp->role_switch=0x00; memset(p_creq,0,sizeof(creq)); - p_req->OCF_OGF=CREATE_CONNECTION_CMD_OP; - p_req->p_cmdp=p_cmdp; - p_req->cmdp_len=CREATE_CONN_CP_SIZE; + p_creq->OCF_OGF=CREATE_CONNECTION_CMD_OP; + p_creq->p_cmdp=p_cmdp; + p_creq->cmdp_len=CREATE_CONN_CP_SIZE; - if(send_cmd(p_creq)<0) + if(send_cmd(p_creq)<0){ perror("hci_create_connection_cmd wasn't sent"); return -1; - + } return 0; } @@ -96,10 +98,10 @@ int send_hci_accept_conn_req_cmd(bt_address *p_address){ p_cmdp->role=0x01; memset(p_creq,0,sizeof(creq)); p_creq->OCF_OGF=ACCEPT_CONNECTION_REQ_OP; - p_req->p_cmdp=p_cmdp; - p_req->cmdp_len=ACCEPT_CONN_REQ_CP_SIZE; + p_creq->p_cmdp=p_cmdp; + p_creq->cmdp_len=ACCEPT_CONN_REQ_CP_SIZE; - if(send_cmd(dd,p_req)<0){ + if(send_cmd(p_creq)<0){ perror("hci_accept_conn_req_cmd wasn't sent"); return -1; } @@ -108,10 +110,12 @@ int send_hci_accept_conn_req_cmd(bt_address *p_address){ /*********************************main functions****************************/ int send_cmd(hci_cmd_request *p_creq){ - __u8 array[p_creq->cmdp_len+4]; + __u8 array[p_creq->cmdp_len+4]; + __u16 sw_opcode; int ii; + sw_opcode=swap_2_bytes(p_creq->OCF_OGF); array[0]=0x01; - memcpy(&array[1],p_req->OCF_OGF,2); + memcpy(&array[1],&sw_opcode,2); array[3]= p_creq->cmdp_len; if(p_creq->cmdp_len > 0){ memcpy(&array[4],p_creq->p_cmdp,p_creq->cmdp_len); // !!!!!!!!! segmentation fault @@ -122,71 +126,13 @@ int send_cmd(hci_cmd_request *p_creq){ } printf("\n"); - if(hw_bt_write(&array,sizeof(array))<0){ + if(hw_bt_write(array,sizeof(array))<0){ perror("hw_bt_write problem"); return -1; } return 0; } -/******************************HCI callback functions*********************/ - -static int callback_hci_all_commands(void *p_recbuf){ - evt_cmd_status *p_rp; - p_rp = (void *) p_recbuf; - - if(p_rp->status){ - perror("command status error\n"); - return -1; - } - - printf("command status with opcode: %d",p_rp->opcode); - return 0; - - -} - -static void callback_hci_read_bd_addr(void *p_arg, void *p_recbuf){ - read_bd_addr_data *p_data=p_arg; - read_bd_addr_rp *p_rp; - - p_rp = (void *) (p_recbuf+3); - memcpy(p_data->p_address,&p_rp->address,6); - p_data->callback_app_read_bd_addr(p_data->p_address); - free(p_data); -} - -static void callback_hci_read_local_name(void *p_arg, void *p_recbuf){ - read_local_name_data p_data=p_arg; - read_local_name_rp *p_rp; - - p_rp = (void *) (p_recbuf+3); - memcpy(p_data->p_name,&p_rp->name,248); - p_data->callback_app_read_local_name(p_data->p_name); - free(p_data); -} - -static void callback_hci_inquiry_RSSI(void *p_arg, void *p_recbuf){ - inquiry_RSSI_data p_data=p_arg; - inquiry_info_with_rssi *p_rp; - - p_rp = (void *) (p_recbuf+4); - memcpy(p_data->p_address,&p_rp->bdaddr,6); - p_data->callback_app_inquiry_RSSI(p_data->p_address); - free(p_data); -} - -static void callback_hci_create_connection(void *p_arg, void *p_recbuf){ - connection_complete_data p_data=p_arg; - evt_conn_complete *p_rp; - - p_rp = (void *) (p_recbuf+3); - memcpy(p_data->p_handle,&p_rp->handle,2); - memcpy(p_data->p_address,&p_rp->bdaddr,6); - p_data->callback_app_connection_complete(p_data->p_handle, p_data->p_address); - free(p_data); -} - /*****************************HCI support functions*****************************/ diff --git a/src2/hcidriver.h b/src2/tiny_bt_hci_cmd.h similarity index 86% rename from src2/hcidriver.h rename to src2/tiny_bt_hci_cmd.h index c3dc5f4..6824a54 100644 --- a/src2/hcidriver.h +++ b/src2/tiny_bt_hci_cmd.h @@ -9,33 +9,15 @@ // Copyright: See COPYING file that comes with this distribution // // -#ifndef __HCIDRIVER -#define __HCIDRIVER +#ifndef __TINI_BT_HCI_CMD +#define __TINI_BT_HCI_CMD #include -#include #include #include "hciembeded.h" - - -/* BT protocols(from bluetooth.h)*/ -#define BTPROTO_L2CAP 0 -#define BTPROTO_HCI 1 -#define BTPROTO_SCO 2 -#define BTPROTO_RFCOMM 3 -#define BTPROTO_BNEP 4 -#define BTPROTO_CMTP 5 -#define BTPROTO_HIDP 6 -#define BTPROTO_AVDTP 7 - -#define SOL_HCI 0 -#define SOL_L2CAP 6 -#define SOL_SCO 17 -#define SOL_RFCOMM 18 - /* CMD ocf and ogf */ #define INQUIRY_CMD_OP 0x0104 @@ -103,11 +85,6 @@ extern int send_hci_accept_conn_req_cmd(bt_address *p_address); extern int send_cmd(hci_cmd_request *p_creq); -extern static void callback_hci_read_bd_addr(void *p_arg, void *p_recbuf); -extern static void callback_hci_read_local_name(void *p_arg, void *p_recbuf); -extern static void callback_hci_inquiry_RSSI(void *p_arg, void *p_recbuf); -extern static void callback_hci_create_connection(void *p_arg, void *p_recbuf); - extern void assemble_ocf_ogf(__u8 ogf,__u8 ocf,__u16 *p_ocf_ogf); extern void printba(bt_address *ba); extern int compare_bda(bt_address *p_first, bt_address *p_second); diff --git a/src2/tiny_bt_hci_core.c b/src2/tiny_bt_hci_core.c new file mode 100644 index 0000000..be0916a --- /dev/null +++ b/src2/tiny_bt_hci_core.c @@ -0,0 +1,455 @@ +/* +* C Implementation: testovaci +* +* Description: +* +* +* Author: root , (C) 2008 +* +* Copyright: See COPYING file that comes with this distribution +* +*/ +#include +#include +#include +#include +#include +#include "tiny_bt_hci_core.h" +#include "tiny_bt_hci_cmd.h" +#include "bt_hw.h" + + +static expect_evt evt_array[MAX_CMD_STATE_REQUEST]; +static int evt_id; +static int global_index; +extern connection_hci connection; +/******************************HCI callback functions*********************/ + +static void callback_hci_all_commands(void *p_arg, void *p_recbuf){ + evt_cmd_status *p_rp; + p_rp = (void *) p_recbuf; + + if(p_rp->status){ + perror("command status error\n"); + //return -1; + exit(-1); // !!!!!!!!!!!!!!!! + } + + printf("command status with opcode: %d\n",p_rp->opcode); + //return 0; +} + +static void callback_hci_read_bd_addr(void *p_arg, void *p_recbuf){ + read_bd_addr_data *p_data=p_arg; + read_bd_addr_rp *p_rp; + + p_rp = (void *) (p_recbuf+3); + memcpy(p_data->p_address,&p_rp->bdaddr,6); + p_data->callback_app_read_bd_addr(p_data->p_address); + free(p_data); +} + +static void callback_hci_read_local_name(void *p_arg, void *p_recbuf){ + read_local_name_data *p_data=p_arg; + read_local_name_rp *p_rp; + + p_rp = (void *) (p_recbuf+3); + memcpy(p_data->p_name,&p_rp->name,248); + p_data->callback_app_read_local_name(p_data->p_name); + free(p_data); +} + +static void callback_hci_inquiry_RSSI(void *p_arg, void *p_recbuf){ + inquiry_RSSI_data *p_data=p_arg; + inquiry_info_with_rssi *p_rp; + + p_rp = (void *) (p_recbuf+1); + memcpy(p_data->p_address,&p_rp->bdaddr,6); + p_data->callback_app_inquiry_RSSI(p_data->p_address); + free(p_data); +} + +static void callback_hci_inquiry_comple(void *p_arg, void *p_recbuf){ + inquiry_complete_data *p_data=p_arg; + __u8 *p_byte; + + p_byte = (void *) p_recbuf; + if(*p_byte){ + perror("inquiry complete status error\n"); + exit(-1); // !!!!!!!! + } + + p_data->callback_app_inquiry_complete(); + free(p_data); +} + +static void callback_hci_create_connection(void *p_arg, void *p_recbuf){ + connection_complete_data *p_data=p_arg; + evt_conn_complete *p_rp; + + p_rp = (void *) (p_recbuf+3); + memcpy(p_data->p_handle,&p_rp->handle,2); + //memcpy(p_data->p_address,&p_rp->bdaddr,6); + p_data->callback_app_connection_complete(p_data->p_handle); + free(p_data); +} + + +void add_evt_toarray(expect_evt *p_evt) //fcn add the request at the end of array or replace the oldest request +{ + int i,sig=0,index=0; + expect_evt the_oldest=evt_array[0]; + + for ( i=0;icon_id=0; + p_conn->con_state=con_state; + + memset(p_evt,0,sizeof(evt)); + p_evt->actual_status=status; + p_evt->id=evt_id++; + p_evt->evt_type=EVT_CMD_STATUS; + p_evt->p_callback=callback_hci_all_commands; + p_evt->p_data=NULL; + + add_evt_toarray(p_evt); + + dd=hw_bt_open_device(dev_id); + + hci_filter_clear(&nf); + hci_filter_all_ptypes(&nf); + hci_filter_all_events(&nf); +// hci_filter_set_opcode(swap_2_bytes(READ_BD_ADDR_CMD_OP),&nf); + + if(setsockopt(dd, SOL_HCI, HCI_FILTER, &nf, sizeof(nf))<0){ + perror("some problem with setsockopt"); + return -1; + } + printf("init was succesful dd:%d\n",dd); + + return 0; + +} + +int tiny_bt_process(){ + + int len,j,index; + static int inqRSSI_index=-1; + hci_event_hdr *p_hdr; + __u8 recbuf[HCI_MAX_EVENT_SIZE],*p_recbuf; + + len=hw_bt_read(recbuf); + + if ( len ) + { + printf ( "Count of received bytes %d \n ",len ); + for ( j=0;jevt==EVT_CMD_COMPLETE ){ + evt_cmd_complete *p_ccevt; + p_ccevt = (void *) p_recbuf; + if((index=look_up_inarray(p_hdr->evt,swap_2_bytes(p_ccevt->opcode)))<0){ + printf ( "There is no awaiting evt like this\n" ); + return -1; + } + else{ + evt_array[index].p_callback(evt_array[index].p_data, p_recbuf); + if(evt_array[index].actual_status != PERMANENT){ + evt_array[index].actual_status = DONE; + } + } + } + /*else if(p_hdr->evt==EVT_INQUIRY_RESULT_WITH_RSSI){ + if((index=look_up_inarray(p_hdr->evt,0))<0){ + printf("There is no awaiting evt like this\n"); + return -1; + } + else{ + inqRSSI_index=index; //I will save a inq evt index + evt_array[index].p_callback(evt_array[index].p_data, p_recbuf); + } + + } */ + else if(p_hdr->evt==EVT_INQUIRY_COMPLETE){ + if((index=look_up_inarray(p_hdr->evt,0))<0){ + printf("There is no awaiting evt like this\n"); + return -1; + } + if((inqRSSI_index=look_up_inarray(EVT_INQUIRY_RESULT_WITH_RSSI,0))<0){ + printf("There is no awaiting evt like this\n"); + return -1; + } + + else{ + evt_array[index].p_callback(evt_array[index].p_data, p_recbuf); + if(evt_array[index].actual_status != PERMANENT){ + evt_array[index].actual_status = DONE; + }// mark inq result evt like a DONE + if(evt_array[inqRSSI_index].actual_status != PERMANENT){ + free(evt_array[inqRSSI_index].p_data); + evt_array[inqRSSI_index].actual_status = DONE; + } + } + + } + else{ + if((index=look_up_inarray(p_hdr->evt,0))<0){ + printf("There is no awaiting evt like this\n"); + return -1; + } + else{ + evt_array[index].p_callback(evt_array[index].p_data, p_recbuf); + if(evt_array[index].actual_status != PERMANENT){ + evt_array[index].actual_status = DONE; + } + } + } + return 1; + } + else if ( recbuf[0]==2 ) + { + + } + else return 0; // 0 or -1 + + } + else + { + //printf ( "There is nothing on socket \n"); + return 0; + } + + return 0; +} + +int tiny_bt_read_bd_addr(bt_address *p_dest, void(*callback_app_read_bd_addr)(bt_address *p_address)){ + expect_evt evt,*p_evt=&evt; + req_state status = ESTABLISHED; + read_bd_addr_data *p_data; + + memset(p_evt,0,sizeof(evt)); + p_evt->actual_status=status; + p_evt->id=evt_id++; + p_evt->evt_type=EVT_CMD_COMPLETE; + p_evt->req_opcode=READ_BD_ADDR_CMD_OP; + p_evt->p_callback=&callback_hci_read_bd_addr; + + p_data=malloc(sizeof(read_bd_addr_data)); + p_data->p_address=p_dest; + p_data->callback_app_read_bd_addr=callback_app_read_bd_addr; + p_evt->p_data=(void *) p_data; + + add_evt_toarray(p_evt); + if(send_hci_read_bd_addr_cmd()<0) + { + perror("send_hci_cmd error"); + return -1; + } + return 0; +} + +int tiny_bt_read_local_name(char *p_name, void(*callback_app_read_local_name)(char *p_name)){ + expect_evt evt,*p_evt=&evt; + req_state status = ESTABLISHED; + read_local_name_data *p_data; + + memset (p_evt,0,sizeof(evt)); + p_evt->actual_status=status; + p_evt->id=evt_id++; + p_evt->evt_type=EVT_CMD_COMPLETE; + p_evt->req_opcode=READ_LOCAL_NAME_CMD_OP; + p_evt->p_callback=callback_hci_read_local_name; + + p_data=malloc (sizeof(read_local_name_data)); + p_data->p_name=p_name; + p_data->callback_app_read_local_name=callback_app_read_local_name; + p_evt->p_data=(void *) p_data; + + add_evt_toarray(p_evt); + if(send_hci_read_local_name_cmd()<0) + { + perror("send_hci_cmd error"); + return -1; + } + return 0; +} + +int tiny_bt_inquiry(bt_address *p_dest_addr, void(*callback_app_inquiry_RSSI)(bt_address *p_address), void(*callback_app_inquiry_complete)(void)){ + + expect_evt evt,*p_evt=&evt; + req_state status = ESTABLISHED; + req_state istatus = ESTABLISHED; + inquiry_RSSI_data *p_data; + inquiry_complete_data *p_idata; + + memset (p_evt,0,sizeof(evt)); + p_evt->actual_status=status; + p_evt->id=evt_id++; + p_evt->evt_type=EVT_INQUIRY_RESULT_WITH_RSSI; + p_evt->req_opcode=INQUIRY_CMD_OP; + p_evt->p_callback=callback_hci_inquiry_RSSI; + + p_data=malloc(sizeof(inquiry_RSSI_data)); + p_data->p_address=p_dest_addr; + p_data->callback_app_inquiry_RSSI=callback_app_inquiry_RSSI; + p_evt->p_data=(void *) p_data; + + add_evt_toarray(p_evt); + + memset (p_evt,0,sizeof(evt)); + p_evt->actual_status=istatus; + p_evt->id=evt_id++; + p_evt->evt_type=EVT_INQUIRY_COMPLETE; + p_evt->req_opcode=INQUIRY_CMD_OP; + p_evt->p_callback=callback_hci_inquiry_comple; + + p_idata=malloc(sizeof(inquiry_complete_data)); + p_idata->callback_app_inquiry_complete=callback_app_inquiry_complete; + p_evt->p_data = (void *)p_idata; + + add_evt_toarray(p_evt); + + if(send_hci_inquiry_cmd()<0) + { + perror("send_hci_cmd error"); + return -1; + } + return 0; +} + +void tiny_bt_inquiry_register_again(bt_address *p_dest_addr, void(*callback_app_inquiry_RSSI)(bt_address *p_address)){ + expect_evt evt,*p_evt=&evt; + req_state status = ESTABLISHED; + inquiry_RSSI_data *p_data; + + memset (p_evt,0,sizeof(evt)); + p_evt->actual_status=status; + p_evt->id=evt_id++; + p_evt->evt_type=EVT_INQUIRY_RESULT_WITH_RSSI; + p_evt->req_opcode=INQUIRY_CMD_OP; + p_evt->p_callback=callback_hci_inquiry_RSSI; + + p_data=malloc(sizeof(inquiry_RSSI_data)); + p_data->p_address=p_dest_addr; + p_data->callback_app_inquiry_RSSI=callback_app_inquiry_RSSI; + p_evt->p_data=(void *) p_data; + + add_evt_toarray(p_evt); +} + +int tiny_bt_connect(bt_address *p_dest_addr, __u16 *p_handle, void( *callback_app_connection_complete)(__u16 *p_handle)) +{ + expect_evt evt,*p_evt=&evt; + req_state status = ESTABLISHED; + connection_complete_data *p_data; + + memset ( p_evt,0,sizeof ( evt ) ); + p_evt->actual_status=status; + p_evt->id=evt_id++; + p_evt->evt_type=EVT_CONN_COMPLETE; + p_evt->req_opcode=CREATE_CONNECTION_CMD_OP; + p_evt->p_callback=callback_hci_create_connection; + + p_data=malloc ( sizeof ( connection_complete_data ) ); + p_data->p_handle=p_handle; + p_data->callback_app_connection_complete=callback_app_connection_complete; + p_evt->p_data= ( void * ) p_data; + + add_evt_toarray ( p_evt ); + if ( send_hci_create_connection_cmd ( p_dest_addr ) <0 ) + { + perror ( "send_hci_cmd error" ); + return -1; + } + return 0; + +} + +int tiny_bt_wait_for_connection() +{ + return 0; +} + diff --git a/src2/hil2cap.h b/src2/tiny_bt_hci_core.h similarity index 57% rename from src2/hil2cap.h rename to src2/tiny_bt_hci_core.h index 1394760..7203fff 100644 --- a/src2/hil2cap.h +++ b/src2/tiny_bt_hci_core.h @@ -9,10 +9,10 @@ // Copyright: See COPYING file that comes with this distribution // // -#ifndef __HIL2CAP -#define __HIL2CAP +#ifndef __TINI_BT_HCI_CORE +#define __TINI_BT_HCI_CORE -#include"hcidriver.h" +#include"tiny_bt_hci_cmd.h" #include #include #include @@ -30,11 +30,6 @@ typedef enum{ DONE = 3 }req_state; -typedef enum{ - LINUX = 0, - UART = 1 -}hw_connection_type; - #define MAX_CMD_STATE_REQUEST 0x0F #define MAX_EVT_COUNT 128 @@ -52,7 +47,7 @@ typedef struct{ __u16 id; __u8 evt_type; __u16 req_opcode; - int (*p_callback)(void *p_arg, void *p_recbuf); + void (*p_callback)(void *p_arg, void *p_recbuf); void *p_data; } __attribute__((packed)) expect_evt; @@ -65,12 +60,6 @@ typedef struct{ int socket_fd; }connection_hci; -typedef struct{ - hw_connection_type type; - __u16 dev_identif; // like a device descriptor - hci_dev_info dev; -}bt_device; - typedef struct{ bt_address *p_address; @@ -87,25 +76,25 @@ typedef struct{ void (*callback_app_inquiry_RSSI)(bt_address *p_address); }inquiry_RSSI_data; +typedef struct{ + void (*callback_app_inquiry_complete)(void); +}inquiry_complete_data; + typedef struct{ __u16 *p_handle; //bt_address *p_address; // address of device whoo iniciated this connection - void (*callback_app_connection_complete)(__u16 *p_handle, bt_address *p_address); + void (*callback_app_connection_complete)(__u16 *p_handle); }connection_complete_data; - -extern int create_master_connection(connection_hci *p_connection); -extern int show_all_local_dev(struct hci_dev_info *master); -extern int show_all_remote_dev(struct hci_dev_info *master, bt_address *p_remadrar,int *p_remd_count); - -extern int l2cap_call_cmd(__u16 ocf_ogf,int dd, void *p_param); - -extern int req_fcn_add(cmd_state_request *p_req); -extern void req_fcn_remove(void); - -extern void *rutine_catch_bd_addr(void *arg); - - - +extern void add_evt_toarray(expect_evt *p_evt); +extern int look_up_inarray(__u8 evt_type, __u16 opcode); +extern int tiny_bt_init(__u8 dev_id); +extern int tiny_bt_process(); +extern int tiny_bt_read_bd_addr(bt_address *p_dest, void(*callback_app_read_bd_addr)(bt_address *p_address)); +extern int tiny_bt_read_local_name(char *p_name, void(*callback_app_read_local_name)(char *p_name)); +extern int tiny_bt_inquiry(bt_address *p_dest_addr, void(*callback_app_inquiry_RSSI)(bt_address *p_address), void(*callback_app_inquiry_complete)(void)); +extern void tiny_bt_inquiry_register_again(bt_address *p_dest_addr, void(*callback_app_inquiry_RSSI)(bt_address *p_address)); +extern int tiny_bt_connect(bt_address *p_dest_addr, __u16 *p_handle, void( *callback_app_connection_complete)(__u16 *p_handle)); +extern int tiny_bt_wait_for_connection(); #endif diff --git a/testf/t4/Makefile b/testf/t4/Makefile new file mode 100644 index 0000000..a9b82b0 --- /dev/null +++ b/testf/t4/Makefile @@ -0,0 +1,2 @@ +slavetest: testslave.c tiny_bt_hci_core.c tiny_bt_hci_core.h tiny_bt_hci_cmd.c tiny_bt_hci_cmd.h + gcc -Wall -o slavetest testslave.c tiny_bt_hci_core.c tiny_bt_hci_core.h tiny_bt_hci_cmd.c tiny_bt_hci_cmd.h diff --git a/testf/t4/bt_hw.c b/testf/t4/bt_hw.c new file mode 100644 index 0000000..00d18f6 --- /dev/null +++ b/testf/t4/bt_hw.c @@ -0,0 +1,86 @@ +/* +* C Implementation: bt_hw +* +* Description: hardweare function for sockets +* +* +* Author: root , (C) 2008 +* +* Copyright: See COPYING file that comes with this distribution +* +*/ +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "bt_hw.h" +#include "hciembeded.h" + +static int hw_dd; + +int hw_bt_open_device(__u8 dev_id){ + struct sockaddr_hci address; + int dd; + int oldflag; + if((dd=socket(AF_BLUETOOTH, SOCK_RAW, BTPROTO_HCI))<0){ + perror("socket no created"); + return dd; //it return -1 when socket isn't created + } + + oldflag=fcntl(dd, F_GETFL, 0); + if(fcntl(dd, F_SETFL, oldflag | O_NONBLOCK) < 0){ + perror("problem with socket flag setting"); + return -1; + } + + memset(&address,0,sizeof(address)); + address.hci_family=AF_BLUETOOTH; + address.hci_dev=dev_id; + if(bind(dd,(struct sockaddr *) &address, sizeof(address))<0){ + perror("Socket not binded to hci device"); + close(dd); + return -1; + } + + if(ioctl(dd, HCISETRAW,1)<0){ + perror("error in ioctl HCISETRAW"); + return -1; + + } + hw_dd=dd; + return dd; +} + +int hw_bt_close_dev(){ + return close(hw_dd); +} + +int hw_bt_write(__u8 *p_array, __u16 length){ + while(write(hw_dd, p_array, length)<0){ + perror("write interrupted"); + if(errno == EAGAIN || errno == EINTR) + continue; + return -1; + + } + return 0; +} + +int hw_bt_read(__u8 *p_recbuf){ + int len; + while((len=read(hw_dd, p_recbuf, sizeof(p_recbuf)*HCI_MAX_EVENT_SIZE))<0){ + if(errno == EINTR) + continue; + if(errno == EAGAIN) + return 0; + perror("Problem with reading \n"); + return -1; + } + return len; +} + diff --git a/testf/t4/bt_hw.h b/testf/t4/bt_hw.h new file mode 100644 index 0000000..7e9b258 --- /dev/null +++ b/testf/t4/bt_hw.h @@ -0,0 +1,40 @@ +// +// C++ Interface: bt_hw +// +// Description: +// +// +// Author: root , (C) 2008 +// +// Copyright: See COPYING file that comes with this distribution +// +// +#ifndef __BT_HW +#define __BT_HW + +#include + +/* BT protocols(from bluetooth.h)*/ +#define BTPROTO_L2CAP 0 +#define BTPROTO_HCI 1 +#define BTPROTO_SCO 2 +#define BTPROTO_RFCOMM 3 +#define BTPROTO_BNEP 4 +#define BTPROTO_CMTP 5 +#define BTPROTO_HIDP 6 +#define BTPROTO_AVDTP 7 + +#define SOL_HCI 0 +#define SOL_L2CAP 6 +#define SOL_SCO 17 +#define SOL_RFCOMM 18 + +extern int hw_bt_open_device(__u8 dev_id); +extern int hw_bt_close_dev(); +extern int hw_bt_write(__u8 *p_array, __u16 length); +extern int hw_bt_read(__u8 *p_recbuf); + + + +#endif + diff --git a/testf/t4/hciembeded.h b/testf/t4/hciembeded.h new file mode 100644 index 0000000..af4cd23 --- /dev/null +++ b/testf/t4/hciembeded.h @@ -0,0 +1,1851 @@ +// +// C++ Interface: hciembeded +// +// Description: copy all structures and macros from hci.h and additional structures and macros +// +// +// Author: root , (C) 2008 +// +// Copyright: See COPYING file that comes with this distribution +// +// +/* + * + * BlueZ - Bluetooth protocol stack for Linux + * + * Copyright (C) 2000-2001 Qualcomm Incorporated + * Copyright (C) 2002-2003 Maxim Krasnyansky + * Copyright (C) 2002-2007 Marcel Holtmann + * + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; either version 2 of the License, or + * (at your option) any later version. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with this program; if not, write to the Free Software + * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA + * + */ + +#ifndef __HCI_H +#define __HCI_H + +#ifdef __cplusplus +extern "C" { +#endif + +#include +#include + + +#define HCI_MAX_DEV 16 + +#define HCI_MAX_ACL_SIZE 1024 +#define HCI_MAX_SCO_SIZE 255 +#define HCI_MAX_EVENT_SIZE 260 +#define HCI_MAX_FRAME_SIZE (HCI_MAX_ACL_SIZE + 4) + +/* HCI dev events */ +#define HCI_DEV_REG 1 +#define HCI_DEV_UNREG 2 +#define HCI_DEV_UP 3 +#define HCI_DEV_DOWN 4 +#define HCI_DEV_SUSPEND 5 +#define HCI_DEV_RESUME 6 + +/* HCI device types */ +#define HCI_VIRTUAL 0 +#define HCI_USB 1 +#define HCI_PCCARD 2 +#define HCI_UART 3 +#define HCI_RS232 4 +#define HCI_PCI 5 +#define HCI_SDIO 6 + +/* HCI device flags */ +enum { + HCI_UP, + HCI_INIT, + HCI_RUNNING, + + HCI_PSCAN, + HCI_ISCAN, + HCI_AUTH, + HCI_ENCRYPT, + HCI_INQUIRY, + + HCI_RAW, + + HCI_SECMGR +}; + +/* HCI ioctl defines */ +#define HCIDEVUP _IOW('H', 201, int) +#define HCIDEVDOWN _IOW('H', 202, int) +#define HCIDEVRESET _IOW('H', 203, int) +#define HCIDEVRESTAT _IOW('H', 204, int) + +#define HCIGETDEVLIST _IOR('H', 210, int) +#define HCIGETDEVINFO _IOR('H', 211, int) +#define HCIGETCONNLIST _IOR('H', 212, int) +#define HCIGETCONNINFO _IOR('H', 213, int) + +#define HCISETRAW _IOW('H', 220, int) +#define HCISETSCAN _IOW('H', 221, int) +#define HCISETAUTH _IOW('H', 222, int) +#define HCISETENCRYPT _IOW('H', 223, int) +#define HCISETPTYPE _IOW('H', 224, int) +#define HCISETLINKPOL _IOW('H', 225, int) +#define HCISETLINKMODE _IOW('H', 226, int) +#define HCISETACLMTU _IOW('H', 227, int) +#define HCISETSCOMTU _IOW('H', 228, int) + +#define HCISETSECMGR _IOW('H', 230, int) + +#define HCIINQUIRY _IOR('H', 240, int) + +#ifndef __NO_HCI_DEFS + +/* HCI Packet types */ +#define HCI_COMMAND_PKT 0x01 +#define HCI_ACLDATA_PKT 0x02 +#define HCI_SCODATA_PKT 0x03 +#define HCI_EVENT_PKT 0x04 +#define HCI_VENDOR_PKT 0xff + +/* HCI Packet types */ +#define HCI_2DH1 0x0002 +#define HCI_3DH1 0x0004 +#define HCI_DM1 0x0008 +#define HCI_DH1 0x0010 +#define HCI_2DH3 0x0100 +#define HCI_3DH3 0x0200 +#define HCI_DM3 0x0400 +#define HCI_DH3 0x0800 +#define HCI_2DH5 0x1000 +#define HCI_3DH5 0x2000 +#define HCI_DM5 0x4000 +#define HCI_DH5 0x8000 + +#define HCI_HV1 0x0020 +#define HCI_HV2 0x0040 +#define HCI_HV3 0x0080 + +#define HCI_EV3 0x0008 +#define HCI_EV4 0x0010 +#define HCI_EV5 0x0020 +#define HCI_2EV3 0x0040 +#define HCI_3EV3 0x0080 +#define HCI_2EV5 0x0100 +#define HCI_3EV5 0x0200 + +#define SCO_PTYPE_MASK (HCI_HV1 | HCI_HV2 | HCI_HV3) +#define ACL_PTYPE_MASK (HCI_DM1 | HCI_DH1 | HCI_DM3 | HCI_DH3 | HCI_DM5 | HCI_DH5) + +/* HCI Error codes */ +#define HCI_UNKNOWN_COMMAND 0x01 +#define HCI_NO_CONNECTION 0x02 +#define HCI_HARDWARE_FAILURE 0x03 +#define HCI_PAGE_TIMEOUT 0x04 +#define HCI_AUTHENTICATION_FAILURE 0x05 +#define HCI_PIN_OR_KEY_MISSING 0x06 +#define HCI_MEMORY_FULL 0x07 +#define HCI_CONNECTION_TIMEOUT 0x08 +#define HCI_MAX_NUMBER_OF_CONNECTIONS 0x09 +#define HCI_MAX_NUMBER_OF_SCO_CONNECTIONS 0x0a +#define HCI_ACL_CONNECTION_EXISTS 0x0b +#define HCI_COMMAND_DISALLOWED 0x0c +#define HCI_REJECTED_LIMITED_RESOURCES 0x0d +#define HCI_REJECTED_SECURITY 0x0e +#define HCI_REJECTED_PERSONAL 0x0f +#define HCI_HOST_TIMEOUT 0x10 +#define HCI_UNSUPPORTED_FEATURE 0x11 +#define HCI_INVALID_PARAMETERS 0x12 +#define HCI_OE_USER_ENDED_CONNECTION 0x13 +#define HCI_OE_LOW_RESOURCES 0x14 +#define HCI_OE_POWER_OFF 0x15 +#define HCI_CONNECTION_TERMINATED 0x16 +#define HCI_REPEATED_ATTEMPTS 0x17 +#define HCI_PAIRING_NOT_ALLOWED 0x18 +#define HCI_UNKNOWN_LMP_PDU 0x19 +#define HCI_UNSUPPORTED_REMOTE_FEATURE 0x1a +#define HCI_SCO_OFFSET_REJECTED 0x1b +#define HCI_SCO_INTERVAL_REJECTED 0x1c +#define HCI_AIR_MODE_REJECTED 0x1d +#define HCI_INVALID_LMP_PARAMETERS 0x1e +#define HCI_UNSPECIFIED_ERROR 0x1f +#define HCI_UNSUPPORTED_LMP_PARAMETER_VALUE 0x20 +#define HCI_ROLE_CHANGE_NOT_ALLOWED 0x21 +#define HCI_LMP_RESPONSE_TIMEOUT 0x22 +#define HCI_LMP_ERROR_TRANSACTION_COLLISION 0x23 +#define HCI_LMP_PDU_NOT_ALLOWED 0x24 +#define HCI_ENCRYPTION_MODE_NOT_ACCEPTED 0x25 +#define HCI_UNIT_LINK_KEY_USED 0x26 +#define HCI_QOS_NOT_SUPPORTED 0x27 +#define HCI_INSTANT_PASSED 0x28 +#define HCI_PAIRING_NOT_SUPPORTED 0x29 +#define HCI_TRANSACTION_COLLISION 0x2a +#define HCI_QOS_UNACCEPTABLE_PARAMETER 0x2c +#define HCI_QOS_REJECTED 0x2d +#define HCI_CLASSIFICATION_NOT_SUPPORTED 0x2e +#define HCI_INSUFFICIENT_SECURITY 0x2f +#define HCI_PARAMETER_OUT_OF_RANGE 0x30 +#define HCI_ROLE_SWITCH_PENDING 0x32 +#define HCI_SLOT_VIOLATION 0x34 +#define HCI_ROLE_SWITCH_FAILED 0x35 +#define HCI_EIR_TOO_LARGE 0x36 +#define HCI_SIMPLE_PAIRING_NOT_SUPPORTED 0x37 +#define HCI_HOST_BUSY_PAIRING 0x38 + +/* ACL flags */ +#define ACL_CONT 0x01 +#define ACL_START 0x02 +#define ACL_ACTIVE_BCAST 0x04 +#define ACL_PICO_BCAST 0x08 + +/* Baseband links */ +#define SCO_LINK 0x00 +#define ACL_LINK 0x01 +#define ESCO_LINK 0x02 + +/* LMP features */ +#define LMP_3SLOT 0x01 +#define LMP_5SLOT 0x02 +#define LMP_ENCRYPT 0x04 +#define LMP_SOFFSET 0x08 +#define LMP_TACCURACY 0x10 +#define LMP_RSWITCH 0x20 +#define LMP_HOLD 0x40 +#define LMP_SNIFF 0x80 + +#define LMP_PARK 0x01 +#define LMP_RSSI 0x02 +#define LMP_QUALITY 0x04 +#define LMP_SCO 0x08 +#define LMP_HV2 0x10 +#define LMP_HV3 0x20 +#define LMP_ULAW 0x40 +#define LMP_ALAW 0x80 + +#define LMP_CVSD 0x01 +#define LMP_PSCHEME 0x02 +#define LMP_PCONTROL 0x04 +#define LMP_TRSP_SCO 0x08 +#define LMP_BCAST_ENC 0x80 + +#define LMP_EDR_ACL_2M 0x02 +#define LMP_EDR_ACL_3M 0x04 +#define LMP_ENH_ISCAN 0x08 +#define LMP_ILACE_ISCAN 0x10 +#define LMP_ILACE_PSCAN 0x20 +#define LMP_RSSI_INQ 0x40 +#define LMP_ESCO 0x80 + +#define LMP_EV4 0x01 +#define LMP_EV5 0x02 +#define LMP_AFH_CAP_SLV 0x08 +#define LMP_AFH_CLS_SLV 0x10 +#define LMP_EDR_3SLOT 0x80 + +#define LMP_EDR_5SLOT 0x01 +#define LMP_SNIFF_SUBR 0x02 +#define LMP_PAUSE_ENC 0x04 +#define LMP_AFH_CAP_MST 0x08 +#define LMP_AFH_CLS_MST 0x10 +#define LMP_EDR_ESCO_2M 0x20 +#define LMP_EDR_ESCO_3M 0x40 +#define LMP_EDR_3S_ESCO 0x80 + +#define LMP_EXT_INQ 0x01 +#define LMP_SIMPLE_PAIR 0x08 +#define LMP_ENCAPS_PDU 0x10 +#define LMP_ERR_DAT_REP 0x20 +#define LMP_NFLUSH_PKTS 0x40 + +#define LMP_LSTO 0x01 +#define LMP_INQ_TX_PWR 0x02 +#define LMP_EXT_FEAT 0x80 + +/* Link policies */ +#define HCI_LP_RSWITCH 0x0001 +#define HCI_LP_HOLD 0x0002 +#define HCI_LP_SNIFF 0x0004 +#define HCI_LP_PARK 0x0008 + +/* Link mode */ +#define HCI_LM_ACCEPT 0x8000 +#define HCI_LM_MASTER 0x0001 +#define HCI_LM_AUTH 0x0002 +#define HCI_LM_ENCRYPT 0x0004 +#define HCI_LM_TRUSTED 0x0008 +#define HCI_LM_RELIABLE 0x0010 +#define HCI_LM_SECURE 0x0020 + + +typedef struct{ + __u8 byte[6]; +} __attribute__((packed)) bt_address; + +/* ----- HCI Commands ----- */ + +/* Link Control */ +#define OGF_LINK_CTL 0x01 + +#define OCF_INQUIRY 0x0001 +typedef struct { + uint8_t lap[3]; + uint8_t length; /* 1.28s units */ + uint8_t num_rsp; +} __attribute__ ((packed)) inquiry_cp; +#define INQUIRY_CP_SIZE 5 + +typedef struct { + uint8_t status; + bt_address bdaddr; +} __attribute__ ((packed)) status_bdaddr_rp; +#define STATUS_BDADDR_RP_SIZE 7 + +#define OCF_INQUIRY_CANCEL 0x0002 + +#define OCF_PERIODIC_INQUIRY 0x0003 +typedef struct { + uint16_t max_period; /* 1.28s units */ + uint16_t min_period; /* 1.28s units */ + uint8_t lap[3]; + uint8_t length; /* 1.28s units */ + uint8_t num_rsp; +} __attribute__ ((packed)) periodic_inquiry_cp; +#define PERIODIC_INQUIRY_CP_SIZE 9 + +#define OCF_EXIT_PERIODIC_INQUIRY 0x0004 + +#define OCF_CREATE_CONN 0x0005 +typedef struct { + bt_address bdaddr; + uint16_t pkt_type; + uint8_t pscan_rep_mode; + uint8_t pscan_mode; + uint16_t clock_offset; + uint8_t role_switch; +} __attribute__ ((packed)) create_conn_cp; +#define CREATE_CONN_CP_SIZE 13 + +#define OCF_DISCONNECT 0x0006 +typedef struct { + uint16_t handle; + uint8_t reason; +} __attribute__ ((packed)) disconnect_cp; +#define DISCONNECT_CP_SIZE 3 + +#define OCF_ADD_SCO 0x0007 +typedef struct { + uint16_t handle; + uint16_t pkt_type; +} __attribute__ ((packed)) add_sco_cp; +#define ADD_SCO_CP_SIZE 4 + +#define OCF_CREATE_CONN_CANCEL 0x0008 +typedef struct { + bt_address bdaddr; +} __attribute__ ((packed)) create_conn_cancel_cp; +#define CREATE_CONN_CANCEL_CP_SIZE 6 + +#define OCF_ACCEPT_CONN_REQ 0x0009 +typedef struct { + bt_address bdaddr; + uint8_t role; +} __attribute__ ((packed)) accept_conn_req_cp; +#define ACCEPT_CONN_REQ_CP_SIZE 7 + +#define OCF_REJECT_CONN_REQ 0x000A +typedef struct { + bt_address bdaddr; + uint8_t reason; +} __attribute__ ((packed)) reject_conn_req_cp; +#define REJECT_CONN_REQ_CP_SIZE 7 + +#define OCF_LINK_KEY_REPLY 0x000B +typedef struct { + bt_address bdaddr; + uint8_t link_key[16]; +} __attribute__ ((packed)) link_key_reply_cp; +#define LINK_KEY_REPLY_CP_SIZE 22 + +#define OCF_LINK_KEY_NEG_REPLY 0x000C + +#define OCF_PIN_CODE_REPLY 0x000D +typedef struct { + bt_address bdaddr; + uint8_t pin_len; + uint8_t pin_code[16]; +} __attribute__ ((packed)) pin_code_reply_cp; +#define PIN_CODE_REPLY_CP_SIZE 23 + +#define OCF_PIN_CODE_NEG_REPLY 0x000E + +#define OCF_SET_CONN_PTYPE 0x000F +typedef struct { + uint16_t handle; + uint16_t pkt_type; +} __attribute__ ((packed)) set_conn_ptype_cp; +#define SET_CONN_PTYPE_CP_SIZE 4 + +#define OCF_AUTH_REQUESTED 0x0011 +typedef struct { + uint16_t handle; +} __attribute__ ((packed)) auth_requested_cp; +#define AUTH_REQUESTED_CP_SIZE 2 + +#define OCF_SET_CONN_ENCRYPT 0x0013 +typedef struct { + uint16_t handle; + uint8_t encrypt; +} __attribute__ ((packed)) set_conn_encrypt_cp; +#define SET_CONN_ENCRYPT_CP_SIZE 3 + +#define OCF_CHANGE_CONN_LINK_KEY 0x0015 +typedef struct { + uint16_t handle; +} __attribute__ ((packed)) change_conn_link_key_cp; +#define CHANGE_CONN_LINK_KEY_CP_SIZE 2 + +#define OCF_MASTER_LINK_KEY 0x0017 +typedef struct { + uint8_t key_flag; +} __attribute__ ((packed)) master_link_key_cp; +#define MASTER_LINK_KEY_CP_SIZE 1 + +#define OCF_REMOTE_NAME_REQ 0x0019 +typedef struct { + bt_address bdaddr; + uint8_t pscan_rep_mode; + uint8_t pscan_mode; + uint16_t clock_offset; +} __attribute__ ((packed)) remote_name_req_cp; +#define REMOTE_NAME_REQ_CP_SIZE 10 + +#define OCF_REMOTE_NAME_REQ_CANCEL 0x001A +typedef struct { + bt_address bdaddr; +} __attribute__ ((packed)) remote_name_req_cancel_cp; +#define REMOTE_NAME_REQ_CANCEL_CP_SIZE 6 + +#define OCF_READ_REMOTE_FEATURES 0x001B +typedef struct { + uint16_t handle; +} __attribute__ ((packed)) read_remote_features_cp; +#define READ_REMOTE_FEATURES_CP_SIZE 2 + +#define OCF_READ_REMOTE_EXT_FEATURES 0x001C +typedef struct { + uint16_t handle; + uint8_t page_num; +} __attribute__ ((packed)) read_remote_ext_features_cp; +#define READ_REMOTE_EXT_FEATURES_CP_SIZE 3 + +#define OCF_READ_REMOTE_VERSION 0x001D +typedef struct { + uint16_t handle; +} __attribute__ ((packed)) read_remote_version_cp; +#define READ_REMOTE_VERSION_CP_SIZE 2 + +#define OCF_READ_CLOCK_OFFSET 0x001F +typedef struct { + uint16_t handle; +} __attribute__ ((packed)) read_clock_offset_cp; +#define READ_CLOCK_OFFSET_CP_SIZE 2 + +#define OCF_READ_LMP_HANDLE 0x0020 + +#define OCF_SETUP_SYNC_CONN 0x0028 +typedef struct { + uint16_t handle; + uint32_t tx_bandwith; + uint32_t rx_bandwith; + uint16_t max_latency; + uint16_t voice_setting; + uint8_t retrans_effort; + uint16_t pkt_type; +} __attribute__ ((packed)) setup_sync_conn_cp; +#define SETUP_SYNC_CONN_CP_SIZE 17 + +#define OCF_ACCEPT_SYNC_CONN_REQ 0x0029 +typedef struct { + bt_address bdaddr; + uint32_t tx_bandwith; + uint32_t rx_bandwith; + uint16_t max_latency; + uint16_t voice_setting; + uint8_t retrans_effort; + uint16_t pkt_type; +} __attribute__ ((packed)) accept_sync_conn_req_cp; +#define ACCEPT_SYNC_CONN_REQ_CP_SIZE 21 + +#define OCF_REJECT_SYNC_CONN_REQ 0x002A +typedef struct { + bt_address bdaddr; + uint8_t reason; +} __attribute__ ((packed)) reject_sync_conn_req_cp; +#define REJECT_SYNC_CONN_REQ_CP_SIZE 7 + +#define OCF_IO_CAPABILITY_REPLY 0x002B +typedef struct { + bt_address bdaddr; + uint8_t capability; + uint8_t oob_data; + uint8_t authentication; +} __attribute__ ((packed)) io_capability_reply_cp; +#define IO_CAPABILITY_REPLY_CP_SIZE 9 + +#define OCF_USER_CONFIRM_REPLY 0x002C +typedef struct { + bt_address bdaddr; +} __attribute__ ((packed)) user_confirm_reply_cp; +#define USER_CONFIRM_REPLY_CP_SIZE 6 + +#define OCF_USER_CONFIRM_NEG_REPLY 0x002D + +#define OCF_USER_PASSKEY_REPLY 0x002E +typedef struct { + bt_address bdaddr; + uint32_t passkey; +} __attribute__ ((packed)) user_passkey_reply_cp; +#define USER_PASSKEY_REPLY_CP_SIZE 10 + +#define OCF_USER_PASSKEY_NEG_REPLY 0x002F + +#define OCF_REMOTE_OOB_DATA_REPLY 0x0030 +typedef struct { + bt_address bdaddr; + uint8_t hash[16]; + uint8_t randomizer[16]; +} __attribute__ ((packed)) remote_oob_data_reply_cp; +#define REMOTE_OOB_DATA_REPLY_CP_SIZE 38 + +#define OCF_REMOTE_OOB_DATA_NEG_REPLY 0x0033 + +#define OCF_IO_CAPABILITY_NEG_REPLY 0x0034 +typedef struct { + bt_address bdaddr; + uint8_t reason; +} __attribute__ ((packed)) io_capability_neg_reply_cp; +#define IO_CAPABILITY_NEG_REPLY_CP_SIZE 7 + +/* Link Policy */ +#define OGF_LINK_POLICY 0x02 + +#define OCF_HOLD_MODE 0x0001 +typedef struct { + uint16_t handle; + uint16_t max_interval; + uint16_t min_interval; +} __attribute__ ((packed)) hold_mode_cp; +#define HOLD_MODE_CP_SIZE 6 + +#define OCF_SNIFF_MODE 0x0003 +typedef struct { + uint16_t handle; + uint16_t max_interval; + uint16_t min_interval; + uint16_t attempt; + uint16_t timeout; +} __attribute__ ((packed)) sniff_mode_cp; +#define SNIFF_MODE_CP_SIZE 10 + +#define OCF_EXIT_SNIFF_MODE 0x0004 +typedef struct { + uint16_t handle; +} __attribute__ ((packed)) exit_sniff_mode_cp; +#define EXIT_SNIFF_MODE_CP_SIZE 2 + +#define OCF_PARK_MODE 0x0005 +typedef struct { + uint16_t handle; + uint16_t max_interval; + uint16_t min_interval; +} __attribute__ ((packed)) park_mode_cp; +#define PARK_MODE_CP_SIZE 6 + +#define OCF_EXIT_PARK_MODE 0x0006 +typedef struct { + uint16_t handle; +} __attribute__ ((packed)) exit_park_mode_cp; +#define EXIT_PARK_MODE_CP_SIZE 2 + +#define OCF_QOS_SETUP 0x0007 +typedef struct { + uint8_t service_type; /* 1 = best effort */ + uint32_t token_rate; /* Byte per seconds */ + uint32_t peak_bandwidth; /* Byte per seconds */ + uint32_t latency; /* Microseconds */ + uint32_t delay_variation; /* Microseconds */ +} __attribute__ ((packed)) hci_qos; +#define HCI_QOS_CP_SIZE 17 +typedef struct { + uint16_t handle; + uint8_t flags; /* Reserved */ + hci_qos qos; +} __attribute__ ((packed)) qos_setup_cp; +#define QOS_SETUP_CP_SIZE (3 + HCI_QOS_CP_SIZE) + +#define OCF_ROLE_DISCOVERY 0x0009 +typedef struct { + uint16_t handle; +} __attribute__ ((packed)) role_discovery_cp; +#define ROLE_DISCOVERY_CP_SIZE 2 +typedef struct { + uint8_t status; + uint16_t handle; + uint8_t role; +} __attribute__ ((packed)) role_discovery_rp; +#define ROLE_DISCOVERY_RP_SIZE 4 + +#define OCF_SWITCH_ROLE 0x000B +typedef struct { + bt_address bdaddr; + uint8_t role; +} __attribute__ ((packed)) switch_role_cp; +#define SWITCH_ROLE_CP_SIZE 7 + +#define OCF_READ_LINK_POLICY 0x000C +typedef struct { + uint16_t handle; +} __attribute__ ((packed)) read_link_policy_cp; +#define READ_LINK_POLICY_CP_SIZE 2 +typedef struct { + uint8_t status; + uint16_t handle; + uint16_t policy; +} __attribute__ ((packed)) read_link_policy_rp; +#define READ_LINK_POLICY_RP_SIZE 5 + +#define OCF_WRITE_LINK_POLICY 0x000D +typedef struct { + uint16_t handle; + uint16_t policy; +} __attribute__ ((packed)) write_link_policy_cp; +#define WRITE_LINK_POLICY_CP_SIZE 4 +typedef struct { + uint8_t status; + uint16_t handle; +} __attribute__ ((packed)) write_link_policy_rp; +#define WRITE_LINK_POLICY_RP_SIZE 3 + +#define OCF_READ_DEFAULT_LINK_POLICY 0x000E + +#define OCF_WRITE_DEFAULT_LINK_POLICY 0x000F + +#define OCF_FLOW_SPECIFICATION 0x0010 + +#define OCF_SNIFF_SUBRATING 0x0011 +typedef struct { + uint16_t handle; + uint16_t max_latency; + uint16_t min_remote_timeout; + uint16_t min_local_timeout; +} __attribute__ ((packed)) sniff_subrating_cp; +#define SNIFF_SUBRATING_CP_SIZE 8 + +/* Host Controller and Baseband */ +#define OGF_HOST_CTL 0x03 + +#define OCF_SET_EVENT_MASK 0x0001 +typedef struct { + uint8_t mask[8]; +} __attribute__ ((packed)) set_event_mask_cp; +#define SET_EVENT_MASK_CP_SIZE 8 + +#define OCF_RESET 0x0003 + +#define OCF_SET_EVENT_FLT 0x0005 +typedef struct { + uint8_t flt_type; + uint8_t cond_type; + uint8_t condition[0]; +} __attribute__ ((packed)) set_event_flt_cp; +#define SET_EVENT_FLT_CP_SIZE 2 + +/* Filter types */ +#define FLT_CLEAR_ALL 0x00 +#define FLT_INQ_RESULT 0x01 +#define FLT_CONN_SETUP 0x02 +/* INQ_RESULT Condition types */ +#define INQ_RESULT_RETURN_ALL 0x00 +#define INQ_RESULT_RETURN_CLASS 0x01 +#define INQ_RESULT_RETURN_BDADDR 0x02 +/* CONN_SETUP Condition types */ +#define CONN_SETUP_ALLOW_ALL 0x00 +#define CONN_SETUP_ALLOW_CLASS 0x01 +#define CONN_SETUP_ALLOW_BDADDR 0x02 +/* CONN_SETUP Conditions */ +#define CONN_SETUP_AUTO_OFF 0x01 +#define CONN_SETUP_AUTO_ON 0x02 + +#define OCF_FLUSH 0x0008 + +#define OCF_READ_PIN_TYPE 0x0009 +typedef struct { + uint8_t status; + uint8_t pin_type; +} __attribute__ ((packed)) read_pin_type_rp; +#define READ_PIN_TYPE_RP_SIZE 2 + +#define OCF_WRITE_PIN_TYPE 0x000A +typedef struct { + uint8_t pin_type; +} __attribute__ ((packed)) write_pin_type_cp; +#define WRITE_PIN_TYPE_CP_SIZE 1 + +#define OCF_CREATE_NEW_UNIT_KEY 0x000B + +#define OCF_READ_STORED_LINK_KEY 0x000D +typedef struct { + bt_address bdaddr; + uint8_t read_all; +} __attribute__ ((packed)) read_stored_link_key_cp; +#define READ_STORED_LINK_KEY_CP_SIZE 7 +typedef struct { + uint8_t status; + uint16_t max_keys; + uint16_t num_keys; +} __attribute__ ((packed)) read_stored_link_key_rp; +#define READ_STORED_LINK_KEY_RP_SIZE 5 + +#define OCF_WRITE_STORED_LINK_KEY 0x0011 +typedef struct { + uint8_t num_keys; + /* variable length part */ +} __attribute__ ((packed)) write_stored_link_key_cp; +#define WRITE_STORED_LINK_KEY_CP_SIZE 1 +typedef struct { + uint8_t status; + uint8_t num_keys; +} __attribute__ ((packed)) write_stored_link_key_rp; +#define READ_WRITE_LINK_KEY_RP_SIZE 2 + +#define OCF_DELETE_STORED_LINK_KEY 0x0012 +typedef struct { + bt_address bdaddr; + uint8_t delete_all; +} __attribute__ ((packed)) delete_stored_link_key_cp; +#define DELETE_STORED_LINK_KEY_CP_SIZE 7 +typedef struct { + uint8_t status; + uint16_t num_keys; +} __attribute__ ((packed)) delete_stored_link_key_rp; +#define DELETE_STORED_LINK_KEY_RP_SIZE 3 + +#define OCF_CHANGE_LOCAL_NAME 0x0013 +typedef struct { + uint8_t name[248]; +} __attribute__ ((packed)) change_local_name_cp; +#define CHANGE_LOCAL_NAME_CP_SIZE 248 + +#define OCF_READ_LOCAL_NAME 0x0014 +typedef struct { + uint8_t status; + uint8_t name[248]; +} __attribute__ ((packed)) read_local_name_rp; +#define READ_LOCAL_NAME_RP_SIZE 249 + +#define OCF_READ_CONN_ACCEPT_TIMEOUT 0x0015 +typedef struct { + uint8_t status; + uint16_t timeout; +} __attribute__ ((packed)) read_conn_accept_timeout_rp; +#define READ_CONN_ACCEPT_TIMEOUT_RP_SIZE 3 + +#define OCF_WRITE_CONN_ACCEPT_TIMEOUT 0x0016 +typedef struct { + uint16_t timeout; +} __attribute__ ((packed)) write_conn_accept_timeout_cp; +#define WRITE_CONN_ACCEPT_TIMEOUT_CP_SIZE 2 + +#define OCF_READ_PAGE_TIMEOUT 0x0017 +typedef struct { + uint8_t status; + uint16_t timeout; +} __attribute__ ((packed)) read_page_timeout_rp; +#define READ_PAGE_TIMEOUT_RP_SIZE 3 + +#define OCF_WRITE_PAGE_TIMEOUT 0x0018 +typedef struct { + uint16_t timeout; +} __attribute__ ((packed)) write_page_timeout_cp; +#define WRITE_PAGE_TIMEOUT_CP_SIZE 2 + +#define OCF_READ_SCAN_ENABLE 0x0019 +typedef struct { + uint8_t status; + uint8_t enable; +} __attribute__ ((packed)) read_scan_enable_rp; +#define READ_SCAN_ENABLE_RP_SIZE 2 + +#define OCF_WRITE_SCAN_ENABLE 0x001A + #define SCAN_DISABLED 0x00 + #define SCAN_INQUIRY 0x01 + #define SCAN_PAGE 0x02 + +#define OCF_READ_PAGE_ACTIVITY 0x001B +typedef struct { + uint8_t status; + uint16_t interval; + uint16_t window; +} __attribute__ ((packed)) read_page_activity_rp; +#define READ_PAGE_ACTIVITY_RP_SIZE 5 + +#define OCF_WRITE_PAGE_ACTIVITY 0x001C +typedef struct { + uint16_t interval; + uint16_t window; +} __attribute__ ((packed)) write_page_activity_cp; +#define WRITE_PAGE_ACTIVITY_CP_SIZE 4 + +#define OCF_READ_INQ_ACTIVITY 0x001D +typedef struct { + uint8_t status; + uint16_t interval; + uint16_t window; +} __attribute__ ((packed)) read_inq_activity_rp; +#define READ_INQ_ACTIVITY_RP_SIZE 5 + +#define OCF_WRITE_INQ_ACTIVITY 0x001E +typedef struct { + uint16_t interval; + uint16_t window; +} __attribute__ ((packed)) write_inq_activity_cp; +#define WRITE_INQ_ACTIVITY_CP_SIZE 4 + +#define OCF_READ_AUTH_ENABLE 0x001F + +#define OCF_WRITE_AUTH_ENABLE 0x0020 + #define AUTH_DISABLED 0x00 + #define AUTH_ENABLED 0x01 + +#define OCF_READ_ENCRYPT_MODE 0x0021 + +#define OCF_WRITE_ENCRYPT_MODE 0x0022 + #define ENCRYPT_DISABLED 0x00 + #define ENCRYPT_P2P 0x01 + #define ENCRYPT_BOTH 0x02 + +#define OCF_READ_CLASS_OF_DEV 0x0023 +typedef struct { + uint8_t status; + uint8_t dev_class[3]; +} __attribute__ ((packed)) read_class_of_dev_rp; +#define READ_CLASS_OF_DEV_RP_SIZE 4 + +#define OCF_WRITE_CLASS_OF_DEV 0x0024 +typedef struct { + uint8_t dev_class[3]; +} __attribute__ ((packed)) write_class_of_dev_cp; +#define WRITE_CLASS_OF_DEV_CP_SIZE 3 + +#define OCF_READ_VOICE_SETTING 0x0025 +typedef struct { + uint8_t status; + uint16_t voice_setting; +} __attribute__ ((packed)) read_voice_setting_rp; +#define READ_VOICE_SETTING_RP_SIZE 3 + +#define OCF_WRITE_VOICE_SETTING 0x0026 +typedef struct { + uint16_t voice_setting; +} __attribute__ ((packed)) write_voice_setting_cp; +#define WRITE_VOICE_SETTING_CP_SIZE 2 + +#define OCF_READ_AUTOMATIC_FLUSH_TIMEOUT 0x0027 + +#define OCF_WRITE_AUTOMATIC_FLUSH_TIMEOUT 0x0028 + +#define OCF_READ_NUM_BROADCAST_RETRANS 0x0029 + +#define OCF_WRITE_NUM_BROADCAST_RETRANS 0x002A + +#define OCF_READ_HOLD_MODE_ACTIVITY 0x002B + +#define OCF_WRITE_HOLD_MODE_ACTIVITY 0x002C + +#define OCF_READ_TRANSMIT_POWER_LEVEL 0x002D +typedef struct { + uint16_t handle; + uint8_t type; +} __attribute__ ((packed)) read_transmit_power_level_cp; +#define READ_TRANSMIT_POWER_LEVEL_CP_SIZE 3 +typedef struct { + uint8_t status; + uint16_t handle; + int8_t level; +} __attribute__ ((packed)) read_transmit_power_level_rp; +#define READ_TRANSMIT_POWER_LEVEL_RP_SIZE 4 + +#define OCF_SET_CONTROLLER_TO_HOST_FC 0x0031 + +#define OCF_HOST_BUFFER_SIZE 0x0033 +typedef struct { + uint16_t acl_mtu; + uint8_t sco_mtu; + uint16_t acl_max_pkt; + uint16_t sco_max_pkt; +} __attribute__ ((packed)) host_buffer_size_cp; +#define HOST_BUFFER_SIZE_CP_SIZE 7 + +#define OCF_HOST_NUM_COMP_PKTS 0x0035 +typedef struct { + uint8_t num_hndl; + /* variable length part */ +} __attribute__ ((packed)) host_num_comp_pkts_cp; +#define HOST_NUM_COMP_PKTS_CP_SIZE 1 + +#define OCF_READ_LINK_SUPERVISION_TIMEOUT 0x0036 +typedef struct { + uint8_t status; + uint16_t handle; + uint16_t timeout; +} __attribute__ ((packed)) read_link_supervision_timeout_rp; +#define READ_LINK_SUPERVISION_TIMEOUT_RP_SIZE 5 + +#define OCF_WRITE_LINK_SUPERVISION_TIMEOUT 0x0037 +typedef struct { + uint16_t handle; + uint16_t timeout; +} __attribute__ ((packed)) write_link_supervision_timeout_cp; +#define WRITE_LINK_SUPERVISION_TIMEOUT_CP_SIZE 4 +typedef struct { + uint8_t status; + uint16_t handle; +} __attribute__ ((packed)) write_link_supervision_timeout_rp; +#define WRITE_LINK_SUPERVISION_TIMEOUT_RP_SIZE 3 + +#define OCF_READ_NUM_SUPPORTED_IAC 0x0038 + +#define MAX_IAC_LAP 0x40 +#define OCF_READ_CURRENT_IAC_LAP 0x0039 +typedef struct { + uint8_t status; + uint8_t num_current_iac; + uint8_t lap[MAX_IAC_LAP][3]; +} __attribute__ ((packed)) read_current_iac_lap_rp; +#define READ_CURRENT_IAC_LAP_RP_SIZE 2+3*MAX_IAC_LAP + +#define OCF_WRITE_CURRENT_IAC_LAP 0x003A +typedef struct { + uint8_t num_current_iac; + uint8_t lap[MAX_IAC_LAP][3]; +} __attribute__ ((packed)) write_current_iac_lap_cp; +#define WRITE_CURRENT_IAC_LAP_CP_SIZE 1+3*MAX_IAC_LAP + +#define OCF_READ_PAGE_SCAN_PERIOD_MODE 0x003B + +#define OCF_WRITE_PAGE_SCAN_PERIOD_MODE 0x003C + +#define OCF_READ_PAGE_SCAN_MODE 0x003D + +#define OCF_WRITE_PAGE_SCAN_MODE 0x003E + +#define OCF_SET_AFH_CLASSIFICATION 0x003F +typedef struct { + uint8_t map[10]; +} __attribute__ ((packed)) set_afh_classification_cp; +#define SET_AFH_CLASSIFICATION_CP_SIZE 10 +typedef struct { + uint8_t status; +} __attribute__ ((packed)) set_afh_classification_rp; +#define SET_AFH_CLASSIFICATION_RP_SIZE 1 + +#define OCF_READ_INQUIRY_SCAN_TYPE 0x0042 +typedef struct { + uint8_t status; + uint8_t type; +} __attribute__ ((packed)) read_inquiry_scan_type_rp; +#define READ_INQUIRY_SCAN_TYPE_RP_SIZE 2 + +#define OCF_WRITE_INQUIRY_SCAN_TYPE 0x0043 +typedef struct { + uint8_t type; +} __attribute__ ((packed)) write_inquiry_scan_type_cp; +#define WRITE_INQUIRY_SCAN_TYPE_CP_SIZE 1 +typedef struct { + uint8_t status; +} __attribute__ ((packed)) write_inquiry_scan_type_rp; +#define WRITE_INQUIRY_SCAN_TYPE_RP_SIZE 1 + +#define OCF_READ_INQUIRY_MODE 0x0044 +typedef struct { + uint8_t status; + uint8_t mode; +} __attribute__ ((packed)) read_inquiry_mode_rp; +#define READ_INQUIRY_MODE_RP_SIZE 2 + +#define OCF_WRITE_INQUIRY_MODE 0x0045 +typedef struct { + uint8_t mode; +} __attribute__ ((packed)) write_inquiry_mode_cp; +#define WRITE_INQUIRY_MODE_CP_SIZE 1 +typedef struct { + uint8_t status; +} __attribute__ ((packed)) write_inquiry_mode_rp; +#define WRITE_INQUIRY_MODE_RP_SIZE 1 + +#define OCF_READ_PAGE_SCAN_TYPE 0x0046 + +#define OCF_WRITE_PAGE_SCAN_TYPE 0x0047 + +#define OCF_READ_AFH_MODE 0x0048 +typedef struct { + uint8_t status; + uint8_t mode; +} __attribute__ ((packed)) read_afh_mode_rp; +#define READ_AFH_MODE_RP_SIZE 2 + +#define OCF_WRITE_AFH_MODE 0x0049 +typedef struct { + uint8_t mode; +} __attribute__ ((packed)) write_afh_mode_cp; +#define WRITE_AFH_MODE_CP_SIZE 1 +typedef struct { + uint8_t status; +} __attribute__ ((packed)) write_afh_mode_rp; +#define WRITE_AFH_MODE_RP_SIZE 1 + +#define OCF_READ_EXT_INQUIRY_RESPONSE 0x0051 +typedef struct { + uint8_t status; + uint8_t fec; + uint8_t data[240]; +} __attribute__ ((packed)) read_ext_inquiry_response_rp; +#define READ_EXT_INQUIRY_RESPONSE_RP_SIZE 242 + +#define OCF_WRITE_EXT_INQUIRY_RESPONSE 0x0052 +typedef struct { + uint8_t fec; + uint8_t data[240]; +} __attribute__ ((packed)) write_ext_inquiry_response_cp; +#define WRITE_EXT_INQUIRY_RESPONSE_CP_SIZE 241 +typedef struct { + uint8_t status; +} __attribute__ ((packed)) write_ext_inquiry_response_rp; +#define WRITE_EXT_INQUIRY_RESPONSE_RP_SIZE 1 + +#define OCF_REFRESH_ENCRYPTION_KEY 0x0053 +typedef struct { + uint16_t handle; +} __attribute__ ((packed)) refresh_encryption_key_cp; +#define REFRESH_ENCRYPTION_KEY_CP_SIZE 2 +typedef struct { + uint8_t status; +} __attribute__ ((packed)) refresh_encryption_key_rp; +#define REFRESH_ENCRYPTION_KEY_RP_SIZE 1 + +#define OCF_READ_SIMPLE_PAIRING_MODE 0x0055 +typedef struct { + uint8_t status; + uint8_t mode; +} __attribute__ ((packed)) read_simple_pairing_mode_rp; +#define READ_SIMPLE_PAIRING_MODE_RP_SIZE 2 + +#define OCF_WRITE_SIMPLE_PAIRING_MODE 0x0056 +typedef struct { + uint8_t mode; +} __attribute__ ((packed)) write_simple_pairing_mode_cp; +#define WRITE_SIMPLE_PAIRING_MODE_CP_SIZE 1 +typedef struct { + uint8_t status; +} __attribute__ ((packed)) write_simple_pairing_mode_rp; +#define WRITE_SIMPLE_PAIRING_MODE_RP_SIZE 1 + +#define OCF_READ_LOCAL_OOB_DATA 0x0057 +typedef struct { + uint8_t status; + uint8_t hash[16]; + uint8_t randomizer[16]; +} __attribute__ ((packed)) read_local_oob_data_rp; +#define READ_LOCAL_OOB_DATA_RP_SIZE 33 + +#define OCF_READ_INQUIRY_TRANSMIT_POWER_LEVEL 0x0058 +typedef struct { + uint8_t status; + int8_t level; +} __attribute__ ((packed)) read_inquiry_transmit_power_level_rp; +#define READ_INQUIRY_TRANSMIT_POWER_LEVEL_RP_SIZE 2 + +#define OCF_WRITE_INQUIRY_TRANSMIT_POWER_LEVEL 0x0059 +typedef struct { + int8_t level; +} __attribute__ ((packed)) write_inquiry_transmit_power_level_cp; +#define WRITE_INQUIRY_TRANSMIT_POWER_LEVEL_CP_SIZE 1 +typedef struct { + uint8_t status; +} __attribute__ ((packed)) write_inquiry_transmit_power_level_rp; +#define WRITE_INQUIRY_TRANSMIT_POWER_LEVEL_RP_SIZE 1 + +#define OCF_READ_DEFAULT_ERROR_DATA_REPORTING 0x005A +typedef struct { + uint8_t status; + uint8_t reporting; +} __attribute__ ((packed)) read_default_error_data_reporting_rp; +#define READ_DEFAULT_ERROR_DATA_REPORTING_RP_SIZE 2 + +#define OCF_WRITE_DEFAULT_ERROR_DATA_REPORTING 0x005B +typedef struct { + uint8_t reporting; +} __attribute__ ((packed)) write_default_error_data_reporting_cp; +#define WRITE_DEFAULT_ERROR_DATA_REPORTING_CP_SIZE 1 +typedef struct { + uint8_t status; +} __attribute__ ((packed)) write_default_error_data_reporting_rp; +#define WRITE_DEFAULT_ERROR_DATA_REPORTING_RP_SIZE 1 + +#define OCF_ENHANCED_FLUSH 0x005F +typedef struct { + uint16_t handle; + uint8_t type; +} __attribute__ ((packed)) enhanced_flush_cp; +#define ENHANCED_FLUSH_CP_SIZE 3 + +#define OCF_SEND_KEYPRESS_NOTIFY 0x0060 +typedef struct { + bt_address bdaddr; + uint8_t type; +} __attribute__ ((packed)) send_keypress_notify_cp; +#define SEND_KEYPRESS_NOTIFY_CP_SIZE 7 +typedef struct { + uint8_t status; +} __attribute__ ((packed)) send_keypress_notify_rp; +#define SEND_KEYPRESS_NOTIFY_RP_SIZE 1 + +/* Informational Parameters */ +#define OGF_INFO_PARAM 0x04 + +#define OCF_READ_LOCAL_VERSION 0x0001 +typedef struct { + uint8_t status; + uint8_t hci_ver; + uint16_t hci_rev; + uint8_t lmp_ver; + uint16_t manufacturer; + uint16_t lmp_subver; +} __attribute__ ((packed)) read_local_version_rp; +#define READ_LOCAL_VERSION_RP_SIZE 9 + +#define OCF_READ_LOCAL_COMMANDS 0x0002 +typedef struct { + uint8_t status; + uint8_t commands[64]; +} __attribute__ ((packed)) read_local_commands_rp; +#define READ_LOCAL_COMMANDS_RP_SIZE 65 + +#define OCF_READ_LOCAL_FEATURES 0x0003 +typedef struct { + uint8_t status; + uint8_t features[8]; +} __attribute__ ((packed)) read_local_features_rp; +#define READ_LOCAL_FEATURES_RP_SIZE 9 + +#define OCF_READ_LOCAL_EXT_FEATURES 0x0004 +typedef struct { + uint8_t page_num; +} __attribute__ ((packed)) read_local_ext_features_cp; +#define READ_LOCAL_EXT_FEATURES_CP_SIZE 1 +typedef struct { + uint8_t status; + uint8_t page_num; + uint8_t max_page_num; + uint8_t features[8]; +} __attribute__ ((packed)) read_local_ext_features_rp; +#define READ_LOCAL_EXT_FEATURES_RP_SIZE 11 + +#define OCF_READ_BUFFER_SIZE 0x0005 +typedef struct { + uint8_t status; + uint16_t acl_mtu; + uint8_t sco_mtu; + uint16_t acl_max_pkt; + uint16_t sco_max_pkt; +} __attribute__ ((packed)) read_buffer_size_rp; +#define READ_BUFFER_SIZE_RP_SIZE 8 + +#define OCF_READ_COUNTRY_CODE 0x0007 + +#define OCF_READ_BD_ADDR 0x0009 +typedef struct { + uint8_t status; + bt_address bdaddr; +} __attribute__ ((packed)) read_bd_addr_rp; +#define READ_BD_ADDR_RP_SIZE 7 + +/* Status params */ +#define OGF_STATUS_PARAM 0x05 + +#define OCF_READ_FAILED_CONTACT_COUNTER 0x0001 +typedef struct { + uint8_t status; + uint16_t handle; + uint8_t counter; +} __attribute__ ((packed)) read_failed_contact_counter_rp; +#define READ_FAILED_CONTACT_COUNTER_RP_SIZE 4 + +#define OCF_RESET_FAILED_CONTACT_COUNTER 0x0002 +typedef struct { + uint8_t status; + uint16_t handle; +} __attribute__ ((packed)) reset_failed_contact_counter_rp; +#define RESET_FAILED_CONTACT_COUNTER_RP_SIZE 4 + +#define OCF_READ_LINK_QUALITY 0x0003 +typedef struct { + uint8_t status; + uint16_t handle; + uint8_t link_quality; +} __attribute__ ((packed)) read_link_quality_rp; +#define READ_LINK_QUALITY_RP_SIZE 4 + +#define OCF_READ_RSSI 0x0005 +typedef struct { + uint8_t status; + uint16_t handle; + int8_t rssi; +} __attribute__ ((packed)) read_rssi_rp; +#define READ_RSSI_RP_SIZE 4 + +#define OCF_READ_AFH_MAP 0x0006 +typedef struct { + uint8_t status; + uint16_t handle; + uint8_t mode; + uint8_t map[10]; +} __attribute__ ((packed)) read_afh_map_rp; +#define READ_AFH_MAP_RP_SIZE 14 + +#define OCF_READ_CLOCK 0x0007 +typedef struct { + uint16_t handle; + uint8_t which_clock; +} __attribute__ ((packed)) read_clock_cp; +#define READ_CLOCK_CP_SIZE 3 +typedef struct { + uint8_t status; + uint16_t handle; + uint32_t clock; + uint16_t accuracy; +} __attribute__ ((packed)) read_clock_rp; +#define READ_CLOCK_RP_SIZE 9 + +/* Testing commands */ +#define OGF_TESTING_CMD 0x3e + +#define OCF_READ_LOOPBACK_MODE 0x0001 + +#define OCF_WRITE_LOOPBACK_MODE 0x0002 + +#define OCF_ENABLE_DEVICE_UNDER_TEST_MODE 0x0003 + +#define OCF_WRITE_SIMPLE_PAIRING_DEBUG_MODE 0x0004 +typedef struct { + uint8_t mode; +} __attribute__ ((packed)) write_simple_pairing_debug_mode_cp; +#define WRITE_SIMPLE_PAIRING_DEBUG_MODE_CP_SIZE 1 +typedef struct { + uint8_t status; +} __attribute__ ((packed)) write_simple_pairing_debug_mode_rp; +#define WRITE_SIMPLE_PAIRING_DEBUG_MODE_RP_SIZE 1 + +/* Vendor specific commands */ +#define OGF_VENDOR_CMD 0x3f + +/* ---- HCI Events ---- */ + +#define EVT_INQUIRY_COMPLETE 0x01 + +#define EVT_INQUIRY_RESULT 0x02 +typedef struct { + bt_address bdaddr; + uint8_t pscan_rep_mode; + uint8_t pscan_period_mode; + uint8_t pscan_mode; + uint8_t dev_class[3]; + uint16_t clock_offset; +} __attribute__ ((packed)) inquiry_info; +#define INQUIRY_INFO_SIZE 14 + +#define EVT_CONN_COMPLETE 0x03 +typedef struct { + uint8_t status; + uint16_t handle; + bt_address bdaddr; + uint8_t link_type; + uint8_t encr_mode; +} __attribute__ ((packed)) evt_conn_complete; +#define EVT_CONN_COMPLETE_SIZE 13 + +#define EVT_CONN_REQUEST 0x04 +typedef struct { + bt_address bdaddr; + uint8_t dev_class[3]; + uint8_t link_type; +} __attribute__ ((packed)) evt_conn_request; +#define EVT_CONN_REQUEST_SIZE 10 + +#define EVT_DISCONN_COMPLETE 0x05 +typedef struct { + uint8_t status; + uint16_t handle; + uint8_t reason; +} __attribute__ ((packed)) evt_disconn_complete; +#define EVT_DISCONN_COMPLETE_SIZE 4 + +#define EVT_AUTH_COMPLETE 0x06 +typedef struct { + uint8_t status; + uint16_t handle; +} __attribute__ ((packed)) evt_auth_complete; +#define EVT_AUTH_COMPLETE_SIZE 3 + +#define EVT_REMOTE_NAME_REQ_COMPLETE 0x07 +typedef struct { + uint8_t status; + bt_address bdaddr; + uint8_t name[248]; +} __attribute__ ((packed)) evt_remote_name_req_complete; +#define EVT_REMOTE_NAME_REQ_COMPLETE_SIZE 255 + +#define EVT_ENCRYPT_CHANGE 0x08 +typedef struct { + uint8_t status; + uint16_t handle; + uint8_t encrypt; +} __attribute__ ((packed)) evt_encrypt_change; +#define EVT_ENCRYPT_CHANGE_SIZE 5 + +#define EVT_CHANGE_CONN_LINK_KEY_COMPLETE 0x09 +typedef struct { + uint8_t status; + uint16_t handle; +} __attribute__ ((packed)) evt_change_conn_link_key_complete; +#define EVT_CHANGE_CONN_LINK_KEY_COMPLETE_SIZE 3 + +#define EVT_MASTER_LINK_KEY_COMPLETE 0x0A +typedef struct { + uint8_t status; + uint16_t handle; + uint8_t key_flag; +} __attribute__ ((packed)) evt_master_link_key_complete; +#define EVT_MASTER_LINK_KEY_COMPLETE_SIZE 4 + +#define EVT_READ_REMOTE_FEATURES_COMPLETE 0x0B +typedef struct { + uint8_t status; + uint16_t handle; + uint8_t features[8]; +} __attribute__ ((packed)) evt_read_remote_features_complete; +#define EVT_READ_REMOTE_FEATURES_COMPLETE_SIZE 11 + +#define EVT_READ_REMOTE_VERSION_COMPLETE 0x0C +typedef struct { + uint8_t status; + uint16_t handle; + uint8_t lmp_ver; + uint16_t manufacturer; + uint16_t lmp_subver; +} __attribute__ ((packed)) evt_read_remote_version_complete; +#define EVT_READ_REMOTE_VERSION_COMPLETE_SIZE 8 + +#define EVT_QOS_SETUP_COMPLETE 0x0D +typedef struct { + uint8_t status; + uint16_t handle; + uint8_t flags; /* Reserved */ + hci_qos qos; +} __attribute__ ((packed)) evt_qos_setup_complete; +#define EVT_QOS_SETUP_COMPLETE_SIZE (4 + HCI_QOS_CP_SIZE) + +#define EVT_CMD_COMPLETE 0x0E +typedef struct { + uint8_t ncmd; + uint16_t opcode; +} __attribute__ ((packed)) evt_cmd_complete; +#define EVT_CMD_COMPLETE_SIZE 3 + +#define EVT_CMD_STATUS 0x0F +typedef struct { + uint8_t status; + uint8_t ncmd; + uint16_t opcode; +} __attribute__ ((packed)) evt_cmd_status; +#define EVT_CMD_STATUS_SIZE 4 + +#define EVT_HARDWARE_ERROR 0x10 +typedef struct { + uint8_t code; +} __attribute__ ((packed)) evt_hardware_error; +#define EVT_HARDWARE_ERROR_SIZE 1 + +#define EVT_FLUSH_OCCURRED 0x11 +typedef struct { + uint16_t handle; +} __attribute__ ((packed)) evt_flush_occured; +#define EVT_FLUSH_OCCURRED_SIZE 2 + +#define EVT_ROLE_CHANGE 0x12 +typedef struct { + uint8_t status; + bt_address bdaddr; + uint8_t role; +} __attribute__ ((packed)) evt_role_change; +#define EVT_ROLE_CHANGE_SIZE 8 + +#define EVT_NUM_COMP_PKTS 0x13 +typedef struct { + uint8_t num_hndl; + /* variable length part */ +} __attribute__ ((packed)) evt_num_comp_pkts; +#define EVT_NUM_COMP_PKTS_SIZE 1 + +#define EVT_MODE_CHANGE 0x14 +typedef struct { + uint8_t status; + uint16_t handle; + uint8_t mode; + uint16_t interval; +} __attribute__ ((packed)) evt_mode_change; +#define EVT_MODE_CHANGE_SIZE 6 + +#define EVT_RETURN_LINK_KEYS 0x15 +typedef struct { + uint8_t num_keys; + /* variable length part */ +} __attribute__ ((packed)) evt_return_link_keys; +#define EVT_RETURN_LINK_KEYS_SIZE 1 + +#define EVT_PIN_CODE_REQ 0x16 +typedef struct { + bt_address bdaddr; +} __attribute__ ((packed)) evt_pin_code_req; +#define EVT_PIN_CODE_REQ_SIZE 6 + +#define EVT_LINK_KEY_REQ 0x17 +typedef struct { + bt_address bdaddr; +} __attribute__ ((packed)) evt_link_key_req; +#define EVT_LINK_KEY_REQ_SIZE 6 + +#define EVT_LINK_KEY_NOTIFY 0x18 +typedef struct { + bt_address bdaddr; + uint8_t link_key[16]; + uint8_t key_type; +} __attribute__ ((packed)) evt_link_key_notify; +#define EVT_LINK_KEY_NOTIFY_SIZE 23 + +#define EVT_LOOPBACK_COMMAND 0x19 + +#define EVT_DATA_BUFFER_OVERFLOW 0x1A +typedef struct { + uint8_t link_type; +} __attribute__ ((packed)) evt_data_buffer_overflow; +#define EVT_DATA_BUFFER_OVERFLOW_SIZE 1 + +#define EVT_MAX_SLOTS_CHANGE 0x1B +typedef struct { + uint16_t handle; + uint8_t max_slots; +} __attribute__ ((packed)) evt_max_slots_change; +#define EVT_MAX_SLOTS_CHANGE_SIZE 3 + +#define EVT_READ_CLOCK_OFFSET_COMPLETE 0x1C +typedef struct { + uint8_t status; + uint16_t handle; + uint16_t clock_offset; +} __attribute__ ((packed)) evt_read_clock_offset_complete; +#define EVT_READ_CLOCK_OFFSET_COMPLETE_SIZE 5 + +#define EVT_CONN_PTYPE_CHANGED 0x1D +typedef struct { + uint8_t status; + uint16_t handle; + uint16_t ptype; +} __attribute__ ((packed)) evt_conn_ptype_changed; +#define EVT_CONN_PTYPE_CHANGED_SIZE 5 + +#define EVT_QOS_VIOLATION 0x1E +typedef struct { + uint16_t handle; +} __attribute__ ((packed)) evt_qos_violation; +#define EVT_QOS_VIOLATION_SIZE 2 + +#define EVT_PSCAN_REP_MODE_CHANGE 0x20 +typedef struct { + bt_address bdaddr; + uint8_t pscan_rep_mode; +} __attribute__ ((packed)) evt_pscan_rep_mode_change; +#define EVT_PSCAN_REP_MODE_CHANGE_SIZE 7 + +#define EVT_FLOW_SPEC_COMPLETE 0x21 +typedef struct { + uint8_t status; + uint16_t handle; + uint8_t flags; + uint8_t direction; + hci_qos qos; +} __attribute__ ((packed)) evt_flow_spec_complete; +#define EVT_FLOW_SPEC_COMPLETE_SIZE (5 + HCI_QOS_CP_SIZE) + +//todo:this solution is for number of responcies equal to 1 only!!! +#define EVT_INQUIRY_RESULT_WITH_RSSI 0x22 +typedef struct { + bt_address bdaddr; + uint8_t pscan_rep_mode; + uint8_t pscan_period_mode; + uint8_t dev_class[3]; + uint16_t clock_offset; + int8_t rssi; +} __attribute__ ((packed)) inquiry_info_with_rssi; +#define INQUIRY_INFO_WITH_RSSI_SIZE 14 +typedef struct { + bt_address bdaddr; + uint8_t pscan_rep_mode; + uint8_t pscan_period_mode; + uint8_t pscan_mode; + uint8_t dev_class[3]; + uint16_t clock_offset; + int8_t rssi; +} __attribute__ ((packed)) inquiry_info_with_rssi_and_pscan_mode; +#define INQUIRY_INFO_WITH_RSSI_AND_PSCAN_MODE_SIZE 15 + +#define EVT_READ_REMOTE_EXT_FEATURES_COMPLETE 0x23 +typedef struct { + uint8_t status; + uint16_t handle; + uint8_t page_num; + uint8_t max_page_num; + uint8_t features[8]; +} __attribute__ ((packed)) evt_read_remote_ext_features_complete; +#define EVT_READ_REMOTE_EXT_FEATURES_COMPLETE_SIZE 13 + +#define EVT_SYNC_CONN_COMPLETE 0x2C +typedef struct { + uint8_t status; + uint16_t handle; + bt_address bdaddr; + uint8_t link_type; + uint8_t trans_interval; + uint8_t retrans_window; + uint16_t rx_pkt_len; + uint16_t tx_pkt_len; + uint8_t air_mode; +} __attribute__ ((packed)) evt_sync_conn_complete; +#define EVT_SYNC_CONN_COMPLETE_SIZE 17 + +#define EVT_SYNC_CONN_CHANGED 0x2D +typedef struct { + uint8_t status; + uint16_t handle; + uint8_t trans_interval; + uint8_t retrans_window; + uint16_t rx_pkt_len; + uint16_t tx_pkt_len; +} __attribute__ ((packed)) evt_sync_conn_changed; +#define EVT_SYNC_CONN_CHANGED_SIZE 9 + +#define EVT_SNIFF_SUBRATING 0x2E +typedef struct { + uint8_t status; + uint16_t handle; + uint16_t max_tx_latency; + uint16_t max_rx_latency; + uint16_t min_remote_timeout; + uint16_t min_local_timeout; +} __attribute__ ((packed)) evt_sniff_subrating; +#define EVT_SNIFF_SUBRATING_SIZE 11 + +#define EVT_EXTENDED_INQUIRY_RESULT 0x2F +typedef struct { + bt_address bdaddr; + uint8_t pscan_rep_mode; + uint8_t pscan_period_mode; + uint8_t dev_class[3]; + uint16_t clock_offset; + int8_t rssi; + uint8_t data[240]; +} __attribute__ ((packed)) extended_inquiry_info; +#define EXTENDED_INQUIRY_INFO_SIZE 254 + +#define EVT_ENCRYPTION_KEY_REFRESH_COMPLETE 0x30 +typedef struct { + uint8_t status; + uint16_t handle; +} __attribute__ ((packed)) evt_encryption_key_refresh_complete; +#define EVT_ENCRYPTION_KEY_REFRESH_COMPLETE_SIZE 3 + +#define EVT_IO_CAPABILITY_REQUEST 0x31 +typedef struct { + bt_address bdaddr; +} __attribute__ ((packed)) evt_io_capability_request; +#define EVT_IO_CAPABILITY_REQUEST_SIZE 6 + +#define EVT_IO_CAPABILITY_RESPONSE 0x32 +typedef struct { + bt_address bdaddr; + uint8_t capability; + uint8_t oob_data; + uint8_t authentication; +} __attribute__ ((packed)) evt_io_capability_response; +#define EVT_IO_CAPABILITY_RESPONSE_SIZE 9 + +#define EVT_USER_CONFIRM_REQUEST 0x33 +typedef struct { + bt_address bdaddr; + uint32_t passkey; +} __attribute__ ((packed)) evt_user_confirm_request; +#define EVT_USER_CONFIRM_REQUEST_SIZE 10 + +#define EVT_USER_PASSKEY_REQUEST 0x34 +typedef struct { + bt_address bdaddr; +} __attribute__ ((packed)) evt_user_passkey_request; +#define EVT_USER_PASSKEY_REQUEST_SIZE 6 + +#define EVT_REMOTE_OOB_DATA_REQUEST 0x35 +typedef struct { + bt_address bdaddr; +} __attribute__ ((packed)) evt_remote_oob_data_request; +#define EVT_REMOTE_OOB_DATA_REQUEST_SIZE 6 + +#define EVT_SIMPLE_PAIRING_COMPLETE 0x36 +typedef struct { + uint8_t status; + bt_address bdaddr; +} __attribute__ ((packed)) evt_simple_pairing_complete; +#define EVT_SIMPLE_PAIRING_COMPLETE_SIZE 7 + +#define EVT_LINK_SUPERVISION_TIMEOUT_CHANGED 0x38 +typedef struct { + uint16_t handle; + uint16_t timeout; +} __attribute__ ((packed)) evt_link_supervision_timeout_changed; +#define EVT_LINK_SUPERVISION_TIMEOUT_CHANGED_SIZE 4 + +#define EVT_ENHANCED_FLUSH_COMPLETE 0x39 +typedef struct { + uint16_t handle; +} __attribute__ ((packed)) evt_enhanced_flush_complete; +#define EVT_ENHANCED_FLUSH_COMPLETE_SIZE 2 + +#define EVT_USER_PASSKEY_NOTIFY 0x3B +typedef struct { + bt_address bdaddr; + uint32_t passkey; +} __attribute__ ((packed)) evt_user_passkey_notify; +#define EVT_USER_PASSKEY_NOTIFY_SIZE 10 + +#define EVT_KEYPRESS_NOTIFY 0x3C +typedef struct { + bt_address bdaddr; + uint8_t type; +} __attribute__ ((packed)) evt_keypress_notify; +#define EVT_KEYPRESS_NOTIFY_SIZE 7 + +#define EVT_REMOTE_HOST_FEATURES_NOTIFY 0x3D +typedef struct { + bt_address bdaddr; + uint8_t features[8]; +} __attribute__ ((packed)) evt_remote_host_features_notify; +#define EVT_REMOTE_HOST_FEATURES_NOTIFY_SIZE 14 + +#define EVT_TESTING 0xFE + +#define EVT_VENDOR 0xFF + +/* Internal events generated by BlueZ stack */ +#define EVT_STACK_INTERNAL 0xFD +typedef struct { + uint16_t type; + uint8_t data[0]; +} __attribute__ ((packed)) evt_stack_internal; +#define EVT_STACK_INTERNAL_SIZE 2 + +#define EVT_SI_DEVICE 0x01 +typedef struct { + uint16_t event; + uint16_t dev_id; +} __attribute__ ((packed)) evt_si_device; +#define EVT_SI_DEVICE_SIZE 4 + +#define EVT_SI_SECURITY 0x02 +typedef struct { + uint16_t event; + uint16_t proto; + uint16_t subproto; + uint8_t incoming; +} __attribute__ ((packed)) evt_si_security; + +/* -------- HCI Packet structures -------- */ +#define HCI_TYPE_LEN 1 + +typedef struct { + uint16_t opcode; /* OCF & OGF */ + uint8_t plen; +} __attribute__ ((packed)) hci_command_hdr; +#define HCI_COMMAND_HDR_SIZE 3 + +typedef struct { + uint8_t evt; + uint8_t plen; +} __attribute__ ((packed)) hci_event_hdr; +#define HCI_EVENT_HDR_SIZE 2 + +typedef struct { + uint16_t handle; /* Handle & Flags(PB, BC) */ + uint16_t dlen; +} __attribute__ ((packed)) hci_acl_hdr; +#define HCI_ACL_HDR_SIZE 4 + +typedef struct { + uint16_t handle; + uint8_t dlen; +} __attribute__ ((packed)) hci_sco_hdr; +#define HCI_SCO_HDR_SIZE 3 + +typedef struct { + uint16_t device; + uint16_t type; + uint16_t plen; +} __attribute__ ((packed)) hci_msg_hdr; +#define HCI_MSG_HDR_SIZE 6 + +/* Command opcode pack/unpack */ +#define cmd_opcode_pack(ogf, ocf) (uint16_t)((ocf & 0x03ff)|(ogf << 10)) +#define cmd_opcode_ogf(op) (op >> 10) +#define cmd_opcode_ocf(op) (op & 0x03ff) + +/* ACL handle and flags pack/unpack */ +#define acl_handle_pack(h, f) (uint16_t)((h & 0x0fff)|(f << 12)) +#define acl_handle(h) (h & 0x0fff) +#define acl_flags(h) (h >> 12) + +#endif /* _NO_HCI_DEFS */ + +/* HCI Socket options */ +#define HCI_DATA_DIR 1 +#define HCI_FILTER 2 +#define HCI_TIME_STAMP 3 + +/* HCI CMSG flags */ +#define HCI_CMSG_DIR 0x0001 +#define HCI_CMSG_TSTAMP 0x0002 + +struct sockaddr_hci { + sa_family_t hci_family; + unsigned short hci_dev; +}; +#define HCI_DEV_NONE 0xffff + +struct hci_filter { + uint32_t type_mask; + uint32_t event_mask[2]; + uint16_t opcode; +}; + +#define HCI_FLT_TYPE_BITS 31 +#define HCI_FLT_EVENT_BITS 63 +#define HCI_FLT_OGF_BITS 63 +#define HCI_FLT_OCF_BITS 127 + +/* Ioctl requests structures */ +struct hci_dev_stats { + uint32_t err_rx; + uint32_t err_tx; + uint32_t cmd_tx; + uint32_t evt_rx; + uint32_t acl_tx; + uint32_t acl_rx; + uint32_t sco_tx; + uint32_t sco_rx; + uint32_t byte_rx; + uint32_t byte_tx; +}; + +struct hci_dev_info { + uint16_t dev_id; + char name[8]; + + bt_address bdaddr; + + uint32_t flags; + uint8_t type; + + uint8_t features[8]; + + uint32_t pkt_type; + uint32_t link_policy; + uint32_t link_mode; + + uint16_t acl_mtu; + uint16_t acl_pkts; + uint16_t sco_mtu; + uint16_t sco_pkts; + + struct hci_dev_stats stat; +}; + +struct hci_conn_info { + uint16_t handle; + bt_address bdaddr; + uint8_t type; + uint8_t out; + uint16_t state; + uint32_t link_mode; +}; + +struct hci_dev_req { + uint16_t dev_id; + uint32_t dev_opt; +}; + +struct hci_dev_list_req { + uint16_t dev_num; + struct hci_dev_req dev_req[16]; /* hci_dev_req structures */ +}; + +struct hci_conn_list_req { + uint16_t dev_id; + uint16_t conn_num; + struct hci_conn_info conn_info[0]; +}; + +struct hci_conn_info_req { + bt_address bdaddr; + uint8_t type; + struct hci_conn_info conn_info[0]; +}; + +struct hci_inquiry_req { + uint16_t dev_id; + uint16_t flags; + uint8_t lap[3]; + uint8_t length; + uint8_t num_rsp; +}; +#define IREQ_CACHE_FLUSH 0x0001 + +struct hci_remotename_req { + uint16_t dev_id; + uint16_t flags; + bt_address bdaddr; + uint8_t name[248]; +}; + +#ifdef __cplusplus +} +#endif + +#endif /* __HCI_H */ diff --git a/testf/t4/testapp.h b/testf/t4/testapp.h new file mode 100644 index 0000000..77e219e --- /dev/null +++ b/testf/t4/testapp.h @@ -0,0 +1,24 @@ +// +// C++ Interface: testapp +// +// Description: +// +// +// Author: root , (C) 2008 +// +// Copyright: See COPYING file that comes with this distribution +// +// +#ifndef __TEST +#define __TEST +extern void callback_app_read_bd_addr(bt_address *p_address); +extern void callback_app_read_local_name(char *p_name); +extern void callback_app_inquiry_RSSI(bt_address *p_address); +extern void callback_app_connection_complete(__u16 *p_handle); +extern void callback_app_inquiry_complete(void); + + + + +#endif + diff --git a/testf/t4/testslave.c b/testf/t4/testslave.c new file mode 100644 index 0000000..6359049 --- /dev/null +++ b/testf/t4/testslave.c @@ -0,0 +1,40 @@ +/* +* C Implementation: testslave +* +* Description: +* +* +* Author: root , (C) 2008 +* +* Copyright: See COPYING file that comes with this distribution +* +*/ + +#include +#include +#include +#include +#include "tiny_bt_hci_core.h" +#include "tiny_bt_hci_cmd.h" +#include "testapp.h" + + +int main(void){ + int ii=30000; + tiny_bt_init(1); + printf("begin of main\n"); + //if(tiny_bt_read_bd_addr(&p_connection->master.bdaddr, callback_app_read_bd_addr)<0){ +// perror("tiny_bt_read_bd_addr error"); +// return -1; +// } + while(1){ + + ii--; + if(tiny_bt_process()<0){ + perror("process error"); + return -1; + } + + } + return 0; +} \ No newline at end of file diff --git a/testf/t4/tiny_bt_hci_cmd.c b/testf/t4/tiny_bt_hci_cmd.c new file mode 100644 index 0000000..2e7f5e6 --- /dev/null +++ b/testf/t4/tiny_bt_hci_cmd.c @@ -0,0 +1,217 @@ +#include +#include +#include +#include +#include +#include +#include +#include +#include "tiny_bt_hci_cmd.h" +#include "bt_hw.h" + + + + + +/************************** hci command functions**************************/ +int send_hci_inquiry_cmd(void){ + inquiry_cp cmdp,*p_cmdp=&cmdp; + hci_cmd_request creq,*p_creq=&creq; + inq_time time=T14s40; + responce_num num=NUM_RSP_20; + + memset(p_cmdp,0,sizeof(cmdp)); + p_cmdp->lap[0]=0x33; + p_cmdp->lap[1]=0x8b; + p_cmdp->lap[2]=0x9e; + p_cmdp->length=time; + p_cmdp->num_rsp=num; + memset(p_creq,0,sizeof(creq)); + p_creq->OCF_OGF=INQUIRY_CMD_OP; + p_creq->p_cmdp=p_cmdp; + p_creq->cmdp_len=INQUIRY_CP_SIZE; + + if(send_cmd(p_creq)<0){ + perror("hci_inquiry_cmd wasn't sent"); + return -1; + } + return 0; +} +// fill up the input parameter address pointer by one address +int send_hci_read_bd_addr_cmd(void){ + hci_cmd_request creq,*p_creq=&creq; + + memset(p_creq,0,sizeof(creq)); + p_creq->OCF_OGF=READ_BD_ADDR_CMD_OP; + p_creq->cmdp_len=0; + + if(send_cmd(p_creq)<0){ + perror("hci_read_bd_addr wasn't sent"); + return -1; + } + return 0; +} + +int send_hci_read_local_name_cmd(void){ + hci_cmd_request creq,*p_creq=&creq; + + memset(p_creq,0,sizeof(creq)); + p_creq->OCF_OGF=READ_LOCAL_NAME_CMD_OP; + p_creq->cmdp_len=0; + + if(send_cmd(p_creq)<0){ + perror("hci_read_local_name_cmd wasn't sent"); + return -1; + } + return 0; +} + +int send_hci_create_connection_cmd(bt_address *p_dest_addr){ + create_conn_cp cmdp,*p_cmdp=&cmdp; + hci_cmd_request creq,*p_creq=&creq; + + memset(p_cmdp,0,sizeof(cmdp)); + p_cmdp->bdaddr=*p_dest_addr; + p_cmdp->pkt_type=0x0010; + p_cmdp->pscan_rep_mode=0x01; + p_cmdp->pscan_mode=0x00; + p_cmdp->clock_offset=0xf000; + p_cmdp->role_switch=0x00; + memset(p_creq,0,sizeof(creq)); + p_creq->OCF_OGF=CREATE_CONNECTION_CMD_OP; + p_creq->p_cmdp=p_cmdp; + p_creq->cmdp_len=CREATE_CONN_CP_SIZE; + + if(send_cmd(p_creq)<0){ + perror("hci_create_connection_cmd wasn't sent"); + return -1; + } + return 0; +} + +int send_hci_accept_conn_req_cmd(bt_address *p_address){ + accept_conn_req_cp cmdp, *p_cmdp=&cmdp; + hci_cmd_request creq,*p_creq=&creq; + + memset(p_cmdp,0,sizeof(cmdp)); + p_cmdp->bdaddr=*p_address; + p_cmdp->role=0x01; + memset(p_creq,0,sizeof(creq)); + p_creq->OCF_OGF=ACCEPT_CONNECTION_REQ_OP; + p_creq->p_cmdp=p_cmdp; + p_creq->cmdp_len=ACCEPT_CONN_REQ_CP_SIZE; + + if(send_cmd(p_creq)<0){ + perror("hci_accept_conn_req_cmd wasn't sent"); + return -1; + } + return 0; +} + +/*********************************main functions****************************/ +int send_cmd(hci_cmd_request *p_creq){ + __u8 array[p_creq->cmdp_len+4]; + __u16 sw_opcode; + int ii; + sw_opcode=swap_2_bytes(p_creq->OCF_OGF); + array[0]=0x01; + memcpy(&array[1],&sw_opcode,2); + array[3]= p_creq->cmdp_len; + if(p_creq->cmdp_len > 0){ + memcpy(&array[4],p_creq->p_cmdp,p_creq->cmdp_len); // !!!!!!!!! segmentation fault + } + + for(ii=0;iibyte[0],ba->byte[1],ba->byte[2],ba->byte[3],ba->byte[4],ba->byte[5]); +} + +int compare_bda(bt_address *p_first, bt_address *p_second){ + __u8 i,k=0; + for(i=0;ibyte[i]==p_second->byte[i]) + k++; + } + if(k==sizeof(bt_address)) return 1; //all bytes are similar + + return 0; //addreses are different in one byte at least +} + +void fill_zero(bt_address *p_addr){ + __u8 i; + for(i=0;ibyte[i]=0x00; + } +} +void swap_addrbytes(bt_address *p_addr){ + bt_address help,*p_help=&help; + __u8 i; + for(i=0;ibyte[i]=p_addr->byte[5-i]; + } + *p_addr=*p_help; +} +__u16 swap_2_bytes(__u16 twobytes){ + __u16 first,second,result=0; + first=twobytes&255; + second=twobytes&65280; + result=result|(first<<8); + result=result|(second>>8); + return result; +} + +__u8 swap8(__u8 byte1){ + __u8 i,mask=0,hvar1=0,resvar=0; + for(i=0;i<8;i++){ + mask=1<0) + resvar=resvar + (128>>i); + } + return resvar; +} + +__u16 swap16(__u16 byte2){ + __u8 i; + __u16 mask=0,hvar1=0,resvar=0; + for(i=0;i<16;i++){ + mask=1<0) + resvar=resvar + (32768>>i); + } + return resvar; +} + +void fill_add(bt_address *addr,__u8 first, __u8 sec, __u8 third, __u8 forth, __u8 fifth, __u8 sixth){ + addr->byte[0]=first; + addr->byte[1]=sec; + addr->byte[2]=third; + addr->byte[3]=forth; + addr->byte[4]=fifth; + addr->byte[5]=sixth; +} + diff --git a/testf/t4/tiny_bt_hci_cmd.h b/testf/t4/tiny_bt_hci_cmd.h new file mode 100644 index 0000000..6824a54 --- /dev/null +++ b/testf/t4/tiny_bt_hci_cmd.h @@ -0,0 +1,174 @@ +// +// C++ Interface: hcidriver +// +// Description: my idea , embeded system will be in waiting state. For this role it will be slave. Master it is a main computer or phone. +// +// +// Author: root , (C) 2008 +// +// Copyright: See COPYING file that comes with this distribution +// +// +#ifndef __TINI_BT_HCI_CMD +#define __TINI_BT_HCI_CMD + +#include +#include +#include "hciembeded.h" + + + +/* CMD ocf and ogf */ + +#define INQUIRY_CMD_OP 0x0104 +#define INQUIRY_CANCEL_CMD_OP 0x0204 +#define CREATE_CONNECTION_CMD_OP 0x0504 +#define ACCEPT_CONNECTION_REQ_OP 0x0904 +#define DISCONNECT_CMD_OP 0x0604 +#define REMOTE_NAME_REQUEST_CMD_OP 0x1904 +#define RESET_CMD_OP 0x030C +#define WRITE_LOCAL_NAME_CMD_OP 0x130C +#define READ_LOCAL_NAME_CMD_OP 0x140C +#define READ_BD_ADDR_CMD_OP 0x0910 + +#define max(a, b) ((a) > (b) ? (a) : (b)) +#define min(a, b) ((a) < (b) ? (a) : (b)) + +typedef enum{ + T1s28 = 1, + T2s56 = 2, + T4s24 = 3, + T5s52 = 4, + T7s20 = 5, + T14s40 = 10 +}inq_time; + +typedef enum{ + NUM_RSP_5 = 5, + NUM_RSP_10 = 10, + NUM_RSP_20 = 20 +}responce_num; + + +/* BD_ADDR (bluetooth.h)*/ + + +typedef struct{ + __u8 byte[3]; +} __attribute__((packed)) dev_lap; + + + +/* Class of device*/ + +typedef struct{ + __u8 byte[3]; +}cl_device; + + +typedef struct{ + __u16 OCF_OGF; + void *p_cmdp; + __u16 cmdp_len; +}hci_cmd_request; + + + +/* next function structures*/ + + +extern int send_hci_inquiry_cmd(void); +extern int send_hci_read_bd_addr_cmd(void); +extern int send_hci_read_local_name_cmd(void); +extern int send_hci_create_connection_cmd(bt_address *p_dest_addr); +extern int send_hci_accept_conn_req_cmd(bt_address *p_address); + +extern int send_cmd(hci_cmd_request *p_creq); + +extern void assemble_ocf_ogf(__u8 ogf,__u8 ocf,__u16 *p_ocf_ogf); +extern void printba(bt_address *ba); +extern int compare_bda(bt_address *p_first, bt_address *p_second); +extern void fill_zero(bt_address *p_addr); +extern void swap_addrbytes(bt_address *p_addr); +extern __u16 swap_2_bytes(__u16 twobytes); +extern __u8 swap8(__u8 byte1); +extern __u16 swap16(__u16 byte2); +extern __u16 swap_2_bytes(__u16 twobytes); +extern void fill_add(bt_address *addr,__u8 first, __u8 sec, __u8 third, __u8 forth, __u8 fifth, __u8 sixth); + +static inline void hci_set_bit(int nr, void *addr) +{ + *((uint32_t *) addr + (nr >> 5)) |= (1 << (nr & 31)); +} + +static inline void hci_clear_bit(int nr, void *addr) +{ + *((uint32_t *) addr + (nr >> 5)) &= ~(1 << (nr & 31)); +} + +static inline int hci_test_bit(int nr, void *addr) +{ + return *((uint32_t *) addr + (nr >> 5)) & (1 << (nr & 31)); +} + +/* HCI filter tools */ +static inline void hci_filter_clear(struct hci_filter *f) +{ + memset(f, 0, sizeof(*f)); +} +static inline void hci_filter_set_ptype(int t, struct hci_filter *f) +{ + hci_set_bit((t == HCI_VENDOR_PKT) ? 0 : (t & HCI_FLT_TYPE_BITS), &f->type_mask); +} +static inline void hci_filter_clear_ptype(int t, struct hci_filter *f) +{ + hci_clear_bit((t == HCI_VENDOR_PKT) ? 0 : (t & HCI_FLT_TYPE_BITS), &f->type_mask); +} +static inline int hci_filter_test_ptype(int t, struct hci_filter *f) +{ + return hci_test_bit((t == HCI_VENDOR_PKT) ? 0 : (t & HCI_FLT_TYPE_BITS), &f->type_mask); +} +static inline void hci_filter_all_ptypes(struct hci_filter *f) +{ + memset((void *) &f->type_mask, 0xff, sizeof(f->type_mask)); +} +static inline void hci_filter_set_event(int e, struct hci_filter *f) +{ + hci_set_bit((e & HCI_FLT_EVENT_BITS), &f->event_mask); +} +static inline void hci_filter_clear_event(int e, struct hci_filter *f) +{ + hci_clear_bit((e & HCI_FLT_EVENT_BITS), &f->event_mask); +} +static inline int hci_filter_test_event(int e, struct hci_filter *f) +{ + return hci_test_bit((e & HCI_FLT_EVENT_BITS), &f->event_mask); +} +static inline void hci_filter_all_events(struct hci_filter *f) +{ + memset((void *) f->event_mask, 0xff, sizeof(f->event_mask)); +} +static inline void hci_filter_set_opcode(int opcode, struct hci_filter *f) +{ + f->opcode = opcode; +} +static inline void hci_filter_clear_opcode(struct hci_filter *f) +{ + f->opcode = 0; +} +static inline int hci_filter_test_opcode(int opcode, struct hci_filter *f) +{ + return (f->opcode == opcode); +} + +static inline int bacmp(const bt_address *ba1, const bt_address *ba2) +{ + return memcmp(ba1, ba2, sizeof(bt_address)); +} +static inline void bacpy(bt_address *dst, const bt_address *src) +{ + memcpy(dst, src, sizeof(bt_address)); +} + + +#endif /* __HCIDRIVER */ diff --git a/testf/t4/tiny_bt_hci_core.h b/testf/t4/tiny_bt_hci_core.h new file mode 100644 index 0000000..7203fff --- /dev/null +++ b/testf/t4/tiny_bt_hci_core.h @@ -0,0 +1,100 @@ +// +// C++ Interface: hil2cap +// +// Description: +// +// +// Author: root , (C) 2008 +// +// Copyright: See COPYING file that comes with this distribution +// +// +#ifndef __TINI_BT_HCI_CORE +#define __TINI_BT_HCI_CORE + +#include"tiny_bt_hci_cmd.h" +#include +#include +#include + + +typedef enum{ + DISCONNECT = 0, + CONNECT= 1 +}connection_state; + +typedef enum{ + FREE = 0, + ESTABLISHED = 1, + PERMANENT = 2, + DONE = 3 +}req_state; + +#define MAX_CMD_STATE_REQUEST 0x0F +#define MAX_EVT_COUNT 128 + +typedef struct{ + __u8 actual_status; + __u8 id; + __u16 req_opcode; + __u8 evt_code;//codes of expected ansver event,command status event will be accepted everytime + void (*p_serv_rutine)(void); + +} __attribute__((packed)) cmd_state_request; + +typedef struct{ + __u8 actual_status; + __u16 id; + __u8 evt_type; + __u16 req_opcode; + void (*p_callback)(void *p_arg, void *p_recbuf); + void *p_data; +} __attribute__((packed)) expect_evt; + +typedef struct{ + __u16 con_id; + __u8 con_state; + struct hci_dev_info master; + struct hci_dev_info slave; + uint16_t handle; + int socket_fd; +}connection_hci; + + +typedef struct{ + bt_address *p_address; + void (*callback_app_read_bd_addr)(bt_address *p_address); +}read_bd_addr_data; + +typedef struct{ + char *p_name; + void (*callback_app_read_local_name)(char *p_name); +}read_local_name_data; + +typedef struct{ + bt_address *p_address; + void (*callback_app_inquiry_RSSI)(bt_address *p_address); +}inquiry_RSSI_data; + +typedef struct{ + void (*callback_app_inquiry_complete)(void); +}inquiry_complete_data; + +typedef struct{ + __u16 *p_handle; + //bt_address *p_address; // address of device whoo iniciated this connection + void (*callback_app_connection_complete)(__u16 *p_handle); +}connection_complete_data; + +extern void add_evt_toarray(expect_evt *p_evt); +extern int look_up_inarray(__u8 evt_type, __u16 opcode); +extern int tiny_bt_init(__u8 dev_id); +extern int tiny_bt_process(); +extern int tiny_bt_read_bd_addr(bt_address *p_dest, void(*callback_app_read_bd_addr)(bt_address *p_address)); +extern int tiny_bt_read_local_name(char *p_name, void(*callback_app_read_local_name)(char *p_name)); +extern int tiny_bt_inquiry(bt_address *p_dest_addr, void(*callback_app_inquiry_RSSI)(bt_address *p_address), void(*callback_app_inquiry_complete)(void)); +extern void tiny_bt_inquiry_register_again(bt_address *p_dest_addr, void(*callback_app_inquiry_RSSI)(bt_address *p_address)); +extern int tiny_bt_connect(bt_address *p_dest_addr, __u16 *p_handle, void( *callback_app_connection_complete)(__u16 *p_handle)); +extern int tiny_bt_wait_for_connection(); + +#endif -- 2.39.2