#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");
+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\n");
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;
+/* 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;
+ 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");
+ if (send_cmd(p_creq) < 0) {
+ perror("hci_read_bd_addr wasn't sent\n");
return -1;
}
return 0;
}
-int send_hci_read_local_name_cmd(void){
- hci_cmd_request creq,*p_creq=&creq;
+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;
+ 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");
+ if (send_cmd(p_creq) < 0) {
+ perror("hci_read_local_name_cmd wasn't sent\n");
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");
+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\n");
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;
+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\n");
+ return -1;
+ }
+ return 0;
+}
+
+int send_hci_disconnect_cmd(__u16 handle)
+{
+ disconnect_cp cmdp, *p_cmdp = &cmdp;
+ hci_cmd_request creq, *p_creq = &creq;
+
+ memset(p_cmdp, 0, sizeof(cmdp));
+ p_cmdp->handle = handle;
+ p_cmdp->reason = 0x13;
- 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;
+ memset(p_creq, 0, sizeof(creq));
+ p_creq->OCF_OGF = DISCONNECT_CMD_OP;
+ p_creq->p_cmdp = p_cmdp;
+ p_creq->cmdp_len = DISCONNECT_CP_SIZE;
+
+ if (send_cmd(p_creq) < 0) {
+ perror("hci_disconnect_cmd wasn't sent\n");
+ return -1;
+ }
+ return 0;
+}
+
+int send_hci_data(char *p_data, __u16 lenght, __u16 *p_chandle)
+{
+ hci_data_request dreq, *p_dreq = &dreq;
+
+ p_dreq->p_data = p_data;
+ p_dreq->lenght = lenght;
+ p_dreq->p_chandle = p_chandle;
- if(send_cmd(p_creq)<0){
- perror("hci_accept_conn_req_cmd wasn't sent");
+ if (send_data(p_dreq) < 0) {
+ perror("hci_accept_conn_req_cmd wasn't sent\n");
return -1;
}
return 0;
}
/*********************************main functions****************************/
-int send_cmd(hci_cmd_request *p_creq){
- __u8 array[p_creq->cmdp_len+4];
+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
+
+ sw_opcode = swap_2_bytes(p_creq->OCF_OGF);
+ array[0]= HCI_COMMAND_PKT;
+ 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++){
+ 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");
+ if (hw_bt_write(array, sizeof(array)) < 0) {
+ perror("hw_bt_write problem\n");
return -1;
}
return 0;
}
-/*****************************HCI support functions*****************************/
+int send_data(hci_data_request *p_dreq)
+{
+ int ii;
+ __u8 array[p_dreq->lenght + 4];
+
+ array[0] = HCI_ACLDATA_PKT;
+ memcpy(&array[1], p_dreq->p_chandle, 2);
+ memcpy(&array[3], &p_dreq->lenght, 2);
+ memcpy(&array[5], p_dreq->p_data, p_dreq->lenght);
+
+ 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\n");
+ return -1;
+ }
+ return 0;
+}
+/*****************************HCI support functions*****************************/
-void assemble_ocf_ogf(__u8 ocf,__u8 ogf,__u16 *p_ocf_ogf){
+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);
+ 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]);
+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])
+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
+
+ 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){
+void fill_zero(bt_address *p_addr)
+{
__u8 i;
- for(i=0;i<sizeof(bt_address);i++){
- p_addr->byte[i]=0x00;
+
+ 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;
+
+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];
+
+ for (i = 0; i < sizeof(bt_address); i++) {
+ p_help->byte[i] = p_addr->byte[5-i];
}
- *p_addr=*p_help;
+ *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);
+
+__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);
+__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){
+__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);
+ __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;
+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;
}
projects / tiny-bt.git / blobdiff