linux下bluetooth编程(六)L2CAP层编程实例

简介:   例一:发送Signaling Packet: Signaling Command是2个Bluetooth实体之间的L2CAP层命令传输。所以得Signaling Command使用CID 0x0001. 多个Command可以在一个C-frame(control frame)中发送。
 

例一:发送Signaling Packet:

Signaling Command是2个Bluetooth实体之间的L2CAP层命令传输。所以得Signaling Command使用CID 0x0001.

多个Command可以在一个C-frame(control frame)中发送。

 

 如果要直接发送Signaling Command.需要建立SOCK_RAW类型的L2CAP连接Socket。这样才有机会自己填充Command Code,Identifier等。

 

以下是一个发送signaling Command以及接收Response的简单例子:

int main(int argc, char** argv)
{
 int l2_sck = 0;
 int iRel  = 0;
 struct sockaddr_l2 local_l2_addr;
 struct sockaddr_l2 remote_l2_addr;
 char str[24] ={0};
 int len = 0;
 int size = 50;
 char* send_buf;
 char* recv_buf;
 int i = 0;
 int id = 1; //不要为0
 
 send_buf = malloc(L2CAP_CMD_HDR_SIZE + size);
 recv_buf = malloc(L2CAP_CMD_HDR_SIZE + size);
 

 if(argc < 2)
 {
  printf("\n%s <bdaddr>\n", argv[0]);
  exit(0);
 }


 // create l2cap raw socket
 l2_sck = socket(PF_BLUETOOTH, SOCK_RAW, BTPROTO_L2CAP); //创建L2CAP protocol的RAW Packet
 if(l2_sck < 0)
 {
  perror("\nsocket:");
  return -1;
 }


 //bind
 memset(&local_l2_addr, 0, sizeof(struct sockaddr_l2));
 local_l2_addr.l2_family = PF_BLUETOOTH;
 bacpy(&local_l2_addr.l2_bdaddr , BDADDR_ANY);

 iRel = bind(l2_sck, (struct sockaddr*) &local_l2_addr, sizeof(struct sockaddr_l2));
 if(iRel < 0)
 {
  perror("\nbind()");
  exit(0);
 }


 //connect
 memset(&remote_l2_addr, 0 , sizeof(struct sockaddr_l2));
 remote_l2_addr.l2_family = PF_BLUETOOTH;
 //printf("\nConnect to %s\n", argv[1]);
 str2ba(argv[1], &remote_l2_addr.l2_bdaddr);

 iRel = connect(l2_sck, (struct sockaddr*)&remote_l2_addr, sizeof(struct sockaddr_l2));
 if(iRel < 0)
 {
  perror("\nconnect()");
  exit(0);
 }


 //get local bdaddr
 len = sizeof(struct sockaddr_l2);
 memset(&local_l2_addr, 0, sizeof(struct sockaddr_l2));

//注意,getsockname()参数三是一个输入输出参数。输入时,为参数二的总体长度。输出时,

//为实际长度。
 iRel = getsockname(l2_sck, (struct sockaddr*) &local_l2_addr, &len);
 if(iRel < 0)
 {
  perror("\ngetsockname()");
  exit(0);
 }
 ba2str(&(local_l2_addr.l2_bdaddr), str);
 //printf("\nLocal Socket bdaddr:[%s]\n", str);
 printf("l2ping: [%s] from [%s](data size %d) ...\n", argv[1], str, size);

 for (i = 0; i < size; i++)
  send_buf[L2CAP_CMD_HDR_SIZE + i] = 'A';

 l2cap_cmd_hdr *send_cmd = (l2cap_cmd_hdr *) send_buf;
 l2cap_cmd_hdr *recv_cmd = (l2cap_cmd_hdr *) recv_buf;

 send_cmd->ident = id;  //如上图所示,这一项为此Command Identifier
 send_cmd->len   = htobs(size);
 send_cmd->code = L2CAP_ECHO_REQ; //如上图所示,此项为Command code.这项定为:

//Echo Request。对端会发送Response回来。code=L2CAP_ECHO_RSP

 
 while(1)
 {
  send_cmd->ident = id;
  if(send(l2_sck, send_buf, size + L2CAP_CMD_HDR_SIZE, 0) <= 0)
  {
   perror("\nsend():");
  }
  
  while(1)
  {
   if(recv(l2_sck, recv_buf, size + L2CAP_CMD_HDR_SIZE, 0) <= 0)
   {
    perror("\nrecv()");
   }
   
   if (recv_cmd->ident != id)
    continue;

   if( recv_cmd->code == L2CAP_ECHO_RSP)
   {
    //printf("\nReceive Response Packet.\n");
    printf("%d bytes from [%s] id %d\n", recv_cmd->len, argv[1], recv_cmd->ident);
    break;
   }
   
  }
  sleep(1);
  id ++;
  
 }


 close(l2_sck);
 
 
 

 return 0;
}

所以说,如果想要发送接收signaling Command。只需要建立l2cap RAW socket. 并按规则填充command id, command code等。就可以接收发送了。

 

Command Code: 这个值放在l2cap.h中。


#define L2CAP_COMMAND_REJ 0x01
#define L2CAP_CONN_REQ  0x02
#define L2CAP_CONN_RSP  0x03
#define L2CAP_CONF_REQ  0x04
#define L2CAP_CONF_RSP  0x05
#define L2CAP_DISCONN_REQ 0x06
#define L2CAP_DISCONN_RSP 0x07
#define L2CAP_ECHO_REQ  0x08
#define L2CAP_ECHO_RSP  0x09
#define L2CAP_INFO_REQ  0x0a
#define L2CAP_INFO_RSP  0x0b

 

 

 

例二:任意PSM的L2CAP连接间数据的传输:

此例子中:Server,client其实是使用网络的概念定义的。

server用来监听指定PSM的连接,并监听数据。同时,利用poll来查看peer是否断掉了。

Server:

 

#include <stdio.h>
#include <sys/types.h>         
#include <sys/socket.h>
#include <stdlib.h>
#include <poll.h>


#include <bluetooth/bluetooth.h>
#include <bluetooth/hci.h>
#include <bluetooth/hci_lib.h>
#include <bluetooth/l2cap.h>


void * Read_thread(void* pSK);

int main(int argc, char** argv)
{
 int iRel = 0;
 int sk = 0;
 struct sockaddr_l2 local_addr;
 struct sockaddr_l2 remote_addr;
 int len;
 int nsk = 0;
 pthread_t nth = 0;
 struct l2cap_options opts;
 int optlen = 0;
 int slen = 0;
 char str[16] = {0};

 if(argc < 2)
 {
  printf("\nUsage:%s psm\n", argv[0]);
  exit(0);
 }

 
 // create l2cap socket
 sk = socket(PF_BLUETOOTH, SOCK_SEQPACKET, BTPROTO_L2CAP);  //发送数据,使用SOCK_SEQPACKET为好
 if(sk < 0)
 {
  perror("\nsocket():");
  exit(0);
 }


 //bind
 local_addr.l2_family = PF_BLUETOOTH;
 local_addr.l2_psm = htobs(atoi(argv[argc -1]));  //last psm
 bacpy(&local_addr.l2_bdaddr, BDADDR_ANY);
 iRel = bind(sk, (struct sockaddr *)&local_addr, sizeof(struct sockaddr));
 if(iRel < 0)
 {
  perror("\nbind()");
  exit(0);
 }


 //get opts

// in mtu 和 out mtu.每个包的最大值
 memset(&opts, 0, sizeof(opts));
 optlen = sizeof(opts);
 getsockopt(sk, SOL_L2CAP, L2CAP_OPTIONS, &opts, &optlen);
 printf("\nomtu:[%d]. imtu:[%d]. flush_to:[%d]. mode:[%d]\n", opts.omtu, opts.imtu, opts.flush_to, opts.mode);


 //set opts. default value
 opts.omtu = 0;
 opts.imtu = 672;
 if (setsockopt(sk, SOL_L2CAP, L2CAP_OPTIONS, &opts, sizeof(opts)) < 0)
 {
  perror("\nsetsockopt():");
  exit(0);
 }


 //listen
 iRel = listen(sk, 10);
 if(iRel < 0)
 {
  perror("\nlisten()");
  exit(0);
 }

 

 len = sizeof(struct sockaddr_l2);
 while(1)
 {
  memset(&remote_addr, 0, sizeof(struct sockaddr_l2));
  nsk = accept(sk, (struct sockaddr*)(&remote_addr), &len);
  if(nsk < 0)
  {
   perror("\naccept():");
   continue;
  }
  ba2str(&(remote_addr.l2_bdaddr), str);
  printf("\npeer bdaddr:[%s].\n", str);  //得到peer的信息

  iRel = pthread_create(&nth, NULL, Read_thread, &nsk);
  if(iRel != 0)
  {
   perror("pthread_create():");
   continue;
  }
  pthread_detach(nth);  // 分离之
  
 }
 

 return 0;
}


void * Read_thread(void* pSK)
{
 //struct pollfd fds[10];
 struct   pollfd   fds[100];
 char buf[1024] = {0};
 int iRel = 0;
 int exit_val = 0;
 

 //fds[0].fd = *(int*)pSK;
 //fds[0].events = POLLIN | POLLHUP;

 fds[0].fd    (int)(*(int*)pSK);
 fds[0].events    POLLIN    POLLHUP;

 

 while(1)
 {
  if(poll(fds, 1, -1) < 0)
  {
   perror("\npoll():");
  }
  if(fds[0].revents & POLLHUP)
  {
   //hang up
   printf("\n[%d] Hang up\n", *(int*)pSK);
   close(*(int*)pSK);
   pthread_exit(&exit_val);

   break;
  }

  if(fds[0].revents & POLLIN)
  {
   memset(buf, 0 , 1024);
   //read data
   iRel = recv(*(int*)pSK, buf, 572, 0);
   //printf("\nHandle[%d] Receive [%d] data:[%s]", *(int*)pSK, iRel, buf);
  }
  
 }

 return 0;
}

 

 

client:

#include <stdio.h>
#include <sys/types.h>         
#include <sys/socket.h>
#include <unistd.h>


#include <bluetooth/bluetooth.h>
#include <bluetooth/hci.h>
#include <bluetooth/hci_lib.h>
#include <bluetooth/l2cap.h>


int main(int argc, char** argv)
{
 int sk;
 int i = 0;
 char buf[24] = "Sam is Good Guy!";
 struct sockaddr_l2 local_addr;
 struct sockaddr_l2 remote_addr;
 int iRel = 0;

 if(argc < 3)
 {
  printf("\nUsage:%s <bdaddr> <PSM>\n", argv[0]);
  exit(0);
 }


 sk = socket(PF_BLUETOOTH, SOCK_SEQPACKET, BTPROTO_L2CAP);
 if(sk < 0)
 {
  perror("\nsocket():");
  exit(0);
 }

 //bind. bluetooth好像不许有无名Socket
 local_addr.l2_family = PF_BLUETOOTH;
 bacpy(&local_addr.l2_bdaddr, BDADDR_ANY);
 iRel = bind(sk, (struct sockaddr *)&local_addr, sizeof(struct sockaddr));
 if(iRel < 0)
 {
  perror("\nbind()");
  exit(0);
 }


 memset(&remote_addr, 0, sizeof(struct sockaddr_l2));
 remote_addr.l2_family = PF_BLUETOOTH;
 str2ba(argv[1], &remote_addr.l2_bdaddr);
 remote_addr.l2_psm = htobs(atoi(argv[argc -1]));
 
 connect(sk, (struct sockaddr*)&remote_addr, sizeof(struct sockaddr_l2));

 for(i = 0; i < 60; i++)
 {
  iRel = send(sk, buf, strlen(buf)+1, 0);
  printf("Send [%d] data\n", strlen(buf)+1);
  sleep(1);
 }

 close(sk);
 return 0;
}

 

 

注意:

1. 在Linux 网络编程中,主动发起连接方,因为不关心地址具体是什么,所以可以作为无名socket,也就是说可以不bind. 但Bluetooth则不可以,一定需要bind.

2. poll可以查出连接断连,但需要注意:断开的revent值为:11001B。也就是说:POLLIN | POLLERR |POLLHUP。

3. 被连接一方,一定要指定PSM。

目录
相关文章
|
4月前
|
Shell Linux
Linux shell编程学习笔记30:打造彩色的选项菜单
Linux shell编程学习笔记30:打造彩色的选项菜单
|
18天前
|
存储 监控 Linux
嵌入式Linux系统编程 — 5.3 times、clock函数获取进程时间
在嵌入式Linux系统编程中,`times`和 `clock`函数是获取进程时间的两个重要工具。`times`函数提供了更详细的进程和子进程时间信息,而 `clock`函数则提供了更简单的处理器时间获取方法。根据具体需求选择合适的函数,可以更有效地进行性能分析和资源管理。通过本文的介绍,希望能帮助您更好地理解和使用这两个函数,提高嵌入式系统编程的效率和效果。
83 13
|
2月前
|
运维 监控 Shell
深入理解Linux系统下的Shell脚本编程
【10月更文挑战第24天】本文将深入浅出地介绍Linux系统中Shell脚本的基础知识和实用技巧,帮助读者从零开始学习编写Shell脚本。通过本文的学习,你将能够掌握Shell脚本的基本语法、变量使用、流程控制以及函数定义等核心概念,并学会如何将这些知识应用于实际问题解决中。文章还将展示几个实用的Shell脚本例子,以加深对知识点的理解和应用。无论你是运维人员还是软件开发者,这篇文章都将为你提供强大的Linux自动化工具。
|
4月前
|
Shell Linux
Linux shell编程学习笔记82:w命令——一览无余
Linux shell编程学习笔记82:w命令——一览无余
|
4月前
|
Linux Shell
Linux系统编程:掌握popen函数的使用
记得在使用完 `popen`打开的流后,总是使用 `pclose`来正确关闭它,并回收资源。这种做法符合良好的编程习惯,有助于保持程序的健壮性和稳定性。
176 6
|
4月前
|
Linux Shell
Linux系统编程:掌握popen函数的使用
记得在使用完 `popen`打开的流后,总是使用 `pclose`来正确关闭它,并回收资源。这种做法符合良好的编程习惯,有助于保持程序的健壮性和稳定性。
188 3
|
4月前
|
Shell Linux Python
python执行linux系统命令的几种方法(python3经典编程案例)
文章介绍了多种使用Python执行Linux系统命令的方法,包括使用os模块的不同函数以及subprocess模块来调用shell命令并处理其输出。
103 0
|
弹性计算 Linux 数据安全/隐私保护
【ECS常见问题】Linux 实例使用问题
如何查询 Linux 实例的账号和密码? 云服务器 ECS 的账号和密码会在创建成功后发送到您账号绑定的手机和邮箱。Linux 系统的默认管理员账号是 root。
【ECS常见问题】Linux 实例使用问题
|
2月前
|
Linux 网络安全 数据安全/隐私保护
Linux 超级强大的十六进制 dump 工具:XXD 命令,我教你应该如何使用!
在 Linux 系统中,xxd 命令是一个强大的十六进制 dump 工具,可以将文件或数据以十六进制和 ASCII 字符形式显示,帮助用户深入了解和分析数据。本文详细介绍了 xxd 命令的基本用法、高级功能及实际应用案例,包括查看文件内容、指定输出格式、写入文件、数据比较、数据提取、数据转换和数据加密解密等。通过掌握这些技巧,用户可以更高效地处理各种数据问题。
138 8
|
2月前
|
监控 Linux
如何检查 Linux 内存使用量是否耗尽?这 5 个命令堪称绝了!
本文介绍了在Linux系统中检查内存使用情况的5个常用命令:`free`、`top`、`vmstat`、`pidstat` 和 `/proc/meminfo` 文件,帮助用户准确监控内存状态,确保系统稳定运行。
555 6