-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
/*
* C Implementation: bt_hw
*
-* Description:
+* Description: hardweare function for sockets
*
*
* Author: root <root@ubuntu>, (C) 2008
* Copyright: See COPYING file that comes with this distribution
*
*/
-int hw_dd;
-__u8 hw_type;
+#include<sys/socket.h>
+#include <stdio.h>
+#include <stdlib.h>
+#include <sys/ioctl.h>
+#include <errno.h>
+#include <string.h>
+#include <fcntl.h>
+#include <unistd.h>
+#include <stdint.h>
+#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;
}
+
#ifndef __BT_HW
#define __BT_HW
-extern int hw_bt_open_device(__u8 type, __u8 dev_id);
+#include<asm/types.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
+
+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
+
+++ /dev/null
-/*
-* C Implementation: testovaci
-*
-* Description:
-*
-*
-* Author: root <root@ubuntu>, (C) 2008
-*
-* Copyright: See COPYING file that comes with this distribution
-*
-*/
-#include <stdio.h>
-#include <stdlib.h>
-#include <sys/ioctl.h>
-#include <errno.h>
-#include <stdint.h>
-#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;i<MAX_EVT_COUNT;i++){
- if((evt_array[i].actual_status)==0 || evt_array[i].actual_status==3 ){
- evt_array[i]=*p_evt;
- sig=1;
- global_index=i;
- break;
- }
- if((evt_array[i].id) < the_oldest.id){ //the smallest id (oldest request) will stay here
- the_oldest = evt_array[i];
- index=i;
-
- }
- }
- if(!sig){
-
- evt_array[index]=*p_evt;
- global_index=index;
- }
-}
-
-int look_up_inarray(__u8 evt_code){
- int i,index=-1,oldestid=65535;
-
- if(evt_array[global_index].evt_code == evt_code && evt_array[global_index].actual_status != DONE){
- return global_index;
- }
- else{
- for(i=0;i<MAX_CMD_STATE_REQUEST;i++){
- if(evt_array[i].evt_code == evt_code && evt_array[i].actual_status != DONE){
- if(evt_array[i].id<oldestid){
- oldestid=evt_array[i].id;
- index=i;
- }
- }
- }
- return index;
- }
-}
-
-
-
-int tiny_bt_init(bt_device *p_device){
- expect_evt evt,*p_evt=&evt;
- req_state status = PERMANENT;
- evt_id=0;
- global_index=0;
- p_connection->con_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;j<len;j++){
- printf("%2.2X ",recbuf[j]);
- }
- printf("\n");
- if(recbuf[0]==HCI_EVENT_PKT){
- p_hdr = (void *) (recbuf + 1);
- p_recbuf = (void *) (recbuf + (1 + HCI_EVENT_HDR_SIZE));
- if((index=look_up_inarray(p_hdr->evt))<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;i<p_dlist->dev_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;i<remd_count;i++){
- printba(&remote_bd_addr_array[i]);
- }
- p_connection->master=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;
-}
-
* Copyright: See COPYING file that comes with this distribution
*
*/
-bt_address rem_bd_addr_array[HCI_MAX_DEV];
+#include <stdio.h>
+#include <stdlib.h>
+#include <errno.h>
+#include <stdint.h>
+#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;i<count;i++){
+ if(compare_bda(p_address,&rem_bd_addr_array[i])){
+ sign=1;
+ break;
+ }
+
+ }
+ if(sign==0){
+ if(count < HCI_MAX_DEV){
+ rem_bd_addr_array[count]=*p_address;
+ printf("There is device:");
+ printba(p_address);
+ count++;
+ }
+ else{
+ printf("Array full, there is more than 16 devices in surroundig area\n");
+ }
+ }
+ }
+
+ glob_count=count;
+ tiny_bt_inquiry_register_again(&rem_addr, callback_app_inquiry_RSSI);
}
-int callback_app_connection_complete(__u16 *p_handle, bt_address *p_address){
-
-
+void callback_app_inquiry_complete(void){
+ int i;
+
+ printf("inquiry complete\n");
+ for(i=0;i<glob_count;i++){
+ printf("remote dev ");
+ printba(&rem_bd_addr_array[i]);
+ }
+ p_connection->slave.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
+}
+
// 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
+
--- /dev/null
+/*
+* C Implementation: testslave
+*
+* Description:
+*
+*
+* Author: root <root@ubuntu>, (C) 2008
+*
+* Copyright: See COPYING file that comes with this distribution
+*
+*/
+
+#include <stdio.h>
+#include <stdlib.h>
+#include <errno.h>
+#include <stdint.h>
+#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
#include <stdio.h>
#include <stdlib.h>
-#include <math.h>
#include <string.h>
#include <errno.h>
#include <unistd.h>
#include <stdint.h>
#include <fcntl.h>
#include <sys/poll.h>
-#include <sys/ioctl.h>
-#include "hcidriver.h"
+#include "tiny_bt_hci_cmd.h"
+#include "bt_hw.h"
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
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;
}
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;
}
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;
}
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;
}
/*********************************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
}
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*****************************/
// Copyright: See COPYING file that comes with this distribution
//
//
-#ifndef __HCIDRIVER
-#define __HCIDRIVER
+#ifndef __TINI_BT_HCI_CMD
+#define __TINI_BT_HCI_CMD
#include<asm/types.h>
-#include<sys/socket.h>
#include<string.h>
#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
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);
--- /dev/null
+/*
+* C Implementation: testovaci
+*
+* Description:
+*
+*
+* Author: root <root@ubuntu>, (C) 2008
+*
+* Copyright: See COPYING file that comes with this distribution
+*
+*/
+#include <stdio.h>
+#include <stdlib.h>
+#include <sys/ioctl.h>
+#include <errno.h>
+#include <stdint.h>
+#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;i<MAX_EVT_COUNT;i++ )
+ {
+ if ( ( evt_array[i].actual_status ) ==0 || evt_array[i].actual_status==3 )
+ {
+ evt_array[i]=*p_evt;
+ sig=1;
+ global_index=i;
+ break;
+ }
+ if ( ( evt_array[i].id ) < the_oldest.id ) //the smallest id (oldest request) will stay here
+ {
+ the_oldest = evt_array[i];
+ index=i;
+
+ }
+ }
+ if ( !sig )
+ {
+
+ evt_array[index]=*p_evt;
+ global_index=index;
+ }
+}
+
+int look_up_inarray(__u8 evt_type, __u16 opcode){
+
+ int i,index=-1,oldestid=65535;
+
+
+ if(evt_array[global_index].evt_type == evt_type && evt_array[global_index].actual_status != DONE){
+ if(opcode!=0){
+ if(evt_array[global_index].req_opcode == opcode)
+ return global_index;
+ }
+ else{
+ return global_index;
+ }
+
+ }
+ else
+ {
+ for ( i=0;i<MAX_CMD_STATE_REQUEST;i++ )
+ {
+ if ( evt_array[i].evt_type == evt_type && evt_array[i].actual_status != DONE )
+ {
+ if(opcode!=0){
+ if(evt_array[i].req_opcode == opcode){
+ if(evt_array[i].id<oldestid){
+ oldestid=evt_array[i].id;
+ index=i;
+ }
+ }
+ }
+ else{
+ if(evt_array[i].id<oldestid){
+ oldestid=evt_array[i].id;
+ index=i;
+ }
+ }
+ }
+ }
+ return index;
+ }
+ return -1;
+}
+
+
+
+
+int tiny_bt_init(__u8 dev_id){
+ struct hci_filter nf;
+ int dd;
+ expect_evt evt,*p_evt=&evt;
+ connection_hci *p_conn=&connection;
+ req_state status = PERMANENT;
+ connection_state con_state = DISCONNECT;
+ evt_id=0;
+ global_index=0;
+ p_conn->con_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;j<len;j++ )
+ {
+ printf ( "%2.2X ",recbuf[j] );
+ }
+ printf ( "\n" );
+ if ( recbuf[0]==HCI_EVENT_PKT )
+ {
+ p_hdr = ( void * ) ( recbuf + 1 );
+ p_recbuf = ( void * ) ( recbuf + ( 1 + HCI_EVENT_HDR_SIZE ) );
+ if(p_hdr->evt==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;
+}
+
// 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<asm/types.h>
#include<sys/socket.h>
#include<errno.h>
DONE = 3
}req_state;
-typedef enum{
- LINUX = 0,
- UART = 1
-}hw_connection_type;
-
#define MAX_CMD_STATE_REQUEST 0x0F
#define MAX_EVT_COUNT 128
__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;
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;
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
--- /dev/null
+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
--- /dev/null
+/*
+* C Implementation: bt_hw
+*
+* Description: hardweare function for sockets
+*
+*
+* Author: root <root@ubuntu>, (C) 2008
+*
+* Copyright: See COPYING file that comes with this distribution
+*
+*/
+#include<sys/socket.h>
+#include <stdio.h>
+#include <stdlib.h>
+#include <sys/ioctl.h>
+#include <errno.h>
+#include <string.h>
+#include <fcntl.h>
+#include <unistd.h>
+#include <stdint.h>
+#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;
+}
+
--- /dev/null
+//
+// C++ Interface: bt_hw
+//
+// Description:
+//
+//
+// Author: root <root@ubuntu>, (C) 2008
+//
+// Copyright: See COPYING file that comes with this distribution
+//
+//
+#ifndef __BT_HW
+#define __BT_HW
+
+#include<asm/types.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
+
+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
+
--- /dev/null
+//
+// C++ Interface: hciembeded
+//
+// Description: copy all structures and macros from hci.h and additional structures and macros
+//
+//
+// Author: root <root@ubuntu>, (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 <maxk@qualcomm.com>
+ * Copyright (C) 2002-2007 Marcel Holtmann <marcel@holtmann.org>
+ *
+ *
+ * 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 <sys/socket.h>
+#include <stdint.h>
+
+
+#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 */
--- /dev/null
+//
+// C++ Interface: testapp
+//
+// Description:
+//
+//
+// Author: root <root@ubuntu>, (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
+
--- /dev/null
+/*
+* C Implementation: testslave
+*
+* Description:
+*
+*
+* Author: root <root@ubuntu>, (C) 2008
+*
+* Copyright: See COPYING file that comes with this distribution
+*
+*/
+
+#include <stdio.h>
+#include <stdlib.h>
+#include <errno.h>
+#include <stdint.h>
+#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
--- /dev/null
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
+#include <errno.h>
+#include <unistd.h>
+#include <stdint.h>
+#include <fcntl.h>
+#include <sys/poll.h>
+#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;ii<sizeof(array);ii++){
+ printf(" %x",array[ii]);
+ }
+ printf("\n");
+
+ if(hw_bt_write(array,sizeof(array))<0){
+ perror("hw_bt_write problem");
+ return -1;
+ }
+ return 0;
+}
+
+/*****************************HCI support functions*****************************/
+
+
+void assemble_ocf_ogf(__u8 ocf,__u8 ogf,__u16 *p_ocf_ogf){
+ __u16 var1;
+ __u16 result;
+
+ var1=(ogf<<10);
+ result=ocf;
+ *p_ocf_ogf=(result|var1);
+}
+
+void printba(bt_address *ba){
+ printf("address: %2.2X:%2.2X:%2.2X:%2.2X:%2.2X:%2.2X: \n",ba->byte[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;i<sizeof(bt_address);i++){
+ if(p_first->byte[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;i<sizeof(bt_address);i++){
+ p_addr->byte[i]=0x00;
+ }
+}
+void swap_addrbytes(bt_address *p_addr){
+ bt_address help,*p_help=&help;
+ __u8 i;
+ for(i=0;i<sizeof(bt_address);i++){
+ p_help->byte[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<<i; // 1,2,4,8,16,32,64,128
+ hvar1=byte1 & mask;
+ if(hvar1>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<<i;
+ hvar1=byte2 & mask;
+ if(hvar1>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;
+}
+
--- /dev/null
+//
+// 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 <root@ubuntu>, (C) 2008
+//
+// Copyright: See COPYING file that comes with this distribution
+//
+//
+#ifndef __TINI_BT_HCI_CMD
+#define __TINI_BT_HCI_CMD
+
+#include<asm/types.h>
+#include<string.h>
+#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 */
--- /dev/null
+//
+// C++ Interface: hil2cap
+//
+// Description:
+//
+//
+// Author: root <root@ubuntu>, (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<asm/types.h>
+#include<sys/socket.h>
+#include<errno.h>
+
+
+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
projects / tiny-bt.git / commitdiff