This allows to send l2cap configuration request by providing
'-o' option to l2test along with '-f' option to add destination CID.
e.g.,
l2test command format:
l2test -o -X <mode> -f <destination CID> -P <psm> <bd_addr>
---
lib/l2cap.h | 10 ++++
tools/l2test.c | 162 +++++++++++++++++++++++++++++++++++++++++++++++++++++++--
2 files changed, 167 insertions(+), 5 deletions(-)
diff --git a/lib/l2cap.h b/lib/l2cap.h
index 5ce94c4..85f3c80 100644
--- a/lib/l2cap.h
+++ b/lib/l2cap.h
@@ -235,6 +235,16 @@ typedef struct {
#define L2CAP_IR_NOTSUPP 0x0001
typedef struct {
+ uint8_t mode;
+ uint8_t txwin_size;
+ uint8_t max_transmit;
+ uint16_t retrans_timeout;
+ uint16_t monitor_timeout;
+ uint16_t max_pdu_size;
+} __attribute__ ((packed)) l2cap_conf_rfc ;
+#define L2CAP_CONF_RFC_SIZE 9
+
+typedef struct {
uint16_t psm;
uint16_t scid;
uint8_t id;
diff --git a/tools/l2test.c b/tools/l2test.c
index abe09c1..59500fb 100644
--- a/tools/l2test.c
+++ b/tools/l2test.c
@@ -69,9 +69,13 @@ enum {
LSENDRECV,
CSENDRECV,
INFOREQ,
+ CONFIGREQ,
PAIRING,
};
+#define L2CAP_DEFAULT_RETRANS_TO 2000 /* 2 seconds */
+#define L2CAP_DEFAULT_MONITOR_TO 12000 /* 12 seconds */
+
static unsigned char *buf;
/* Default mtu */
@@ -91,10 +95,11 @@ static int max_transmit = 3;
static long data_size = -1;
static long buffer_size = 2048;
-/* Default addr and psm and cid */
+/* Default addr, psm, cid and dcid */
static bdaddr_t bdaddr;
static unsigned short psm = 0;
static unsigned short cid = 0;
+static uint16_t dcid = 0;
/* Default number of frames to send (-1 = infinite) */
static int num_frames = -1;
@@ -1245,6 +1250,138 @@ failed:
close(sk);
}
+static void l2cap_add_conf_opt(void **ptr, uint8_t type,
+ uint8_t len, unsigned long val)
+{
+ l2cap_conf_opt *opt = *ptr;
+
+ printf("type 0x%2.2x len %u val 0x%lx \n", type, len, val);
+
+ opt->type = htobs(type);
+ opt->len = htobs(len);
+
+ switch (opt->len) {
+ case 1:
+ *((uint8_t *) opt->val) = val;
+ break;
+ case 2:
+ bt_put_le16(val, opt->val);
+ break;
+ case 4:
+ bt_put_le32(val, opt->val);
+ break;
+ default:
+ memcpy(opt->val, (void *) val, len);
+ break;
+ }
+
+ *ptr += L2CAP_CONF_OPT_SIZE + len;
+}
+
+static int l2cap_build_conf_req(void *data)
+{
+ l2cap_conf_req *req = data;
+ l2cap_conf_rfc rfc;
+ void *ptr = req->data;
+
+ req->dcid = htobs(dcid);
+ req->flags = htobs(0x0000);
+
+ switch (rfcmode) {
+ case L2CAP_MODE_BASIC:
+ rfc.mode = htobs(L2CAP_MODE_BASIC);
+ rfc.txwin_size = htobs(0);
+ rfc.max_transmit = htobs(0);
+ rfc.retrans_timeout = htobs(0);
+ rfc.monitor_timeout = htobs(0);
+ rfc.max_pdu_size = htobs(0);
+
+ l2cap_add_conf_opt(&ptr, L2CAP_CONF_RFC, sizeof(rfc),
+ (unsigned long) &rfc);
+
+ break;
+
+ case L2CAP_MODE_ERTM:
+ rfc.mode = htobs(L2CAP_MODE_ERTM);
+ rfc.txwin_size = htobs(txwin_size);
+ rfc.max_transmit = htobs(max_transmit);
+ rfc.retrans_timeout = htobs(L2CAP_DEFAULT_RETRANS_TO);
+ rfc.monitor_timeout = htobs(L2CAP_DEFAULT_MONITOR_TO);
+ rfc.max_pdu_size = htobs(imtu);
+
+ l2cap_add_conf_opt(&ptr, L2CAP_CONF_RFC, sizeof(rfc),
+ (unsigned long) &rfc);
+ break;
+
+ case L2CAP_MODE_STREAMING:
+ rfc.mode = htobs(L2CAP_MODE_STREAMING);
+ rfc.txwin_size = htobs(txwin_size);
+ rfc.max_transmit = htobs(max_transmit);
+ rfc.retrans_timeout = htobs(L2CAP_DEFAULT_RETRANS_TO);
+ rfc.monitor_timeout = htobs(L2CAP_DEFAULT_MONITOR_TO);
+ rfc.max_pdu_size = htobs(imtu);
+
+ l2cap_add_conf_opt(&ptr, L2CAP_CONF_RFC, sizeof(rfc),
+ (unsigned long) &rfc);
+
+ break;
+ default:
+ return L2CAP_CONF_REQ_SIZE;
+ }
+
+ return (ptr - data);
+}
+
+static void config_request(char *svr)
+{
+ unsigned char buf[48];
+ l2cap_cmd_hdr *cmd = (l2cap_cmd_hdr *) buf;
+ uint8_t *req_buf = (uint8_t *) (buf + L2CAP_CMD_HDR_SIZE);
+ struct sockaddr_l2 addr;
+ int sk;
+ int data_len = 0;
+
+ sk = socket(PF_BLUETOOTH, SOCK_RAW, BTPROTO_L2CAP);
+ if (sk < 0) {
+ perror("Can't create socket");
+ return;
+ }
+
+ memset(&addr, 0, sizeof(addr));
+ addr.l2_family = AF_BLUETOOTH;
+ bacpy(&addr.l2_bdaddr, &bdaddr);
+ addr.l2_bdaddr_type = bdaddr_type;
+
+ if (bind(sk, (struct sockaddr *) &addr, sizeof(addr)) < 0) {
+ perror("Can't bind socket");
+ goto failed;
+ }
+
+ memset(&addr, 0, sizeof(addr));
+ addr.l2_family = AF_BLUETOOTH;
+ str2ba(svr, &addr.l2_bdaddr);
+ addr.l2_bdaddr_type = bdaddr_type;
+
+ if (connect(sk, (struct sockaddr *) &addr, sizeof(addr)) < 0) {
+ perror("Can't connect socket");
+ goto failed;
+ }
+
+ memset(buf, 0, sizeof(buf));
+ cmd->code = L2CAP_CONF_REQ;
+ cmd->ident = 141;
+ data_len = l2cap_build_conf_req(req_buf);
+ cmd->len = htobs(data_len);
+
+ if (send(sk, buf, L2CAP_CMD_HDR_SIZE + data_len, 0) < 0) {
+ perror("Can't send info request");
+ goto failed;
+ }
+
+failed:
+ close(sk);
+}
+
static void do_pairing(char *svr)
{
struct sockaddr_l2 addr;
@@ -1311,7 +1448,8 @@ static void usage(void)
"\t-c connect, disconnect, connect, ...\n"
"\t-m multiple connects\n"
"\t-p trigger dedicated bonding\n"
- "\t-z information request\n");
+ "\t-z information request\n"
+ "\t-o configuration request\n");
printf("Options:\n"
"\t[-b bytes] [-i device] [-P psm] [-J cid]\n"
@@ -1340,7 +1478,7 @@ static void usage(void)
"\t[-M] become master\n"
"\t[-T] enable timestamps\n"
"\t[-V type] address type (help for list, default = bredr)\n"
- "\t[-e seq] initial sequence value (default = 0)\n");
+ "\t[-e DCID] Destination CID\n");
}
int main(int argc, char *argv[])
@@ -1350,8 +1488,8 @@ int main(int argc, char *argv[])
bacpy(&bdaddr, BDADDR_ANY);
- while ((opt = getopt(argc, argv, "a:b:cde:g:i:mnpqrstuwxyz"
- "AB:C:D:EF:GH:I:J:K:L:MN:O:P:Q:RSTUV:W:X:Y:Z:")) != EOF) {
+ while ((opt = getopt(argc, argv, "a:b:cde:g:i:mnopqrstuwxyz"
+ "AB:C:D:EFf:GH:I:J:K:L:MN:O:P:Q:RSTUV:W:X:Y:Z:")) != EOF) {
switch (opt) {
case 'r':
mode = RECV;
@@ -1412,6 +1550,11 @@ int main(int argc, char *argv[])
need_addr = 1;
break;
+ case 'o':
+ mode = CONFIGREQ;
+ need_addr = 1;
+ break;
+
case 'p':
mode = PAIRING;
need_addr = 1;
@@ -1565,6 +1708,11 @@ int main(int argc, char *argv[])
disc_delay = atoi(optarg) * 1000;
break;
+ case 'f':
+ dcid = strtoul(optarg, NULL, 16);
+ printf("dcid 0x%2x", dcid);
+ break;
+
default:
usage();
exit(1);
@@ -1666,6 +1814,10 @@ int main(int argc, char *argv[])
info_request(argv[optind]);
exit(0);
+ case CONFIGREQ:
+ config_request(argv[optind]);
+ exit(0);
+
case PAIRING:
do_pairing(argv[optind]);
exit(0);
--
1.9.1
--
To unsubscribe from this list: send the line "unsubscribe linux-bluetooth" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at http://vger.kernel.org/majordomo-info.html
