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