3 * BlueZ - Bluetooth protocol stack for Linux
5 * Copyright (C) 2002-2010 Marcel Holtmann <marcel@holtmann.org>
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
20 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
39 #include <sys/param.h>
40 #include <sys/ioctl.h>
41 #include <sys/socket.h>
44 #include <bluetooth/bluetooth.h>
45 #include <bluetooth/hci.h>
46 #include <bluetooth/hci_lib.h>
47 #include <bluetooth/rfcomm.h>
55 static char *rfcomm_config_file = NULL;
56 static int rfcomm_raw_tty = 0;
58 static int encryption = 0;
59 static int secure = 0;
60 static int master = 0;
61 static int linger = 0;
63 static char *rfcomm_state[] = {
76 static volatile sig_atomic_t __io_canceled = 0;
78 static void sig_hup(int sig)
83 static void sig_term(int sig)
88 static char *rfcomm_flagstostr(uint32_t flags)
95 if (flags & (1 << RFCOMM_REUSE_DLC))
96 strcat(str, "reuse-dlc ");
98 if (flags & (1 << RFCOMM_RELEASE_ONHUP))
99 strcat(str, "release-on-hup ");
101 if (flags & (1 << RFCOMM_TTY_ATTACHED))
102 strcat(str, "tty-attached");
108 static void print_dev_info(struct rfcomm_dev_info *di)
110 char src[18], dst[18], addr[40];
112 ba2str(&di->src, src); ba2str(&di->dst, dst);
114 if (bacmp(&di->src, BDADDR_ANY) == 0)
115 sprintf(addr, "%s", dst);
117 sprintf(addr, "%s -> %s", src, dst);
119 printf("rfcomm%d: %s channel %d %s %s\n",
120 di->id, addr, di->channel,
121 rfcomm_state[di->state],
122 di->flags ? rfcomm_flagstostr(di->flags) : "");
125 static void print_dev_list(int ctl, int flags)
127 struct rfcomm_dev_list_req *dl;
128 struct rfcomm_dev_info *di;
131 dl = malloc(sizeof(*dl) + RFCOMM_MAX_DEV * sizeof(*di));
133 perror("Can't allocate memory");
137 dl->dev_num = RFCOMM_MAX_DEV;
140 if (ioctl(ctl, RFCOMMGETDEVLIST, (void *) dl) < 0) {
141 perror("Can't get device list");
146 for (i = 0; i < dl->dev_num; i++)
147 print_dev_info(di + i);
151 static int create_dev(int ctl, int dev, uint32_t flags, bdaddr_t *bdaddr, int argc, char **argv)
153 struct rfcomm_dev_req req;
156 memset(&req, 0, sizeof(req));
159 bacpy(&req.src, bdaddr);
162 err = rfcomm_read_config(rfcomm_config_file);
164 perror("Can't open RFCOMM config file");
168 bacpy(&req.dst, &rfcomm_opts[dev].bdaddr);
169 req.channel = rfcomm_opts[dev].channel;
171 if (bacmp(&req.dst, BDADDR_ANY) == 0) {
172 fprintf(stderr, "Can't find a config entry for rfcomm%d\n", dev);
176 str2ba(argv[1], &req.dst);
179 req.channel = atoi(argv[2]);
184 err = ioctl(ctl, RFCOMMCREATEDEV, &req);
185 if (err == EOPNOTSUPP)
186 fprintf(stderr, "RFCOMM TTY support not available\n");
188 perror("Can't create device");
193 static int create_all(int ctl)
195 struct rfcomm_dev_req req;
198 err = rfcomm_read_config(rfcomm_config_file);
200 perror("Can't open RFCOMM config file");
204 for (i = 0; i < RFCOMM_MAX_DEV; i++) {
205 if (!rfcomm_opts[i].bind)
208 memset(&req, 0, sizeof(req));
211 bacpy(&req.src, BDADDR_ANY);
212 bacpy(&req.dst, &rfcomm_opts[i].bdaddr);
213 req.channel = rfcomm_opts[i].channel;
215 if (bacmp(&req.dst, BDADDR_ANY) != 0)
216 ioctl(ctl, RFCOMMCREATEDEV, &req);
222 static int release_dev(int ctl, int dev, uint32_t flags)
224 struct rfcomm_dev_req req;
227 memset(&req, 0, sizeof(req));
230 err = ioctl(ctl, RFCOMMRELEASEDEV, &req);
232 perror("Can't release device");
237 static int release_all(int ctl)
239 struct rfcomm_dev_list_req *dl;
240 struct rfcomm_dev_info *di;
243 dl = malloc(sizeof(*dl) + RFCOMM_MAX_DEV * sizeof(*di));
245 perror("Can't allocate memory");
249 dl->dev_num = RFCOMM_MAX_DEV;
252 if (ioctl(ctl, RFCOMMGETDEVLIST, (void *) dl) < 0) {
253 perror("Can't get device list");
258 for (i = 0; i < dl->dev_num; i++)
259 release_dev(ctl, (di + i)->id, 0);
265 static void run_cmdline(struct pollfd *p, sigset_t* sigs, char *devname,
266 int argc, char **argv)
272 cmdargv = malloc((argc + 1) * sizeof(char*));
276 for (i = 0; i < argc; i++)
277 cmdargv[i] = (strcmp(argv[i], "{}") == 0) ? devname : argv[i];
284 i = execvp(cmdargv[0], cmdargv);
285 fprintf(stderr, "Couldn't execute command %s (errno=%d:%s)\n",
286 cmdargv[0], errno, strerror(errno));
289 fprintf(stderr, "Couldn't fork to execute command %s\n",
298 child = waitpid(-1, &status, WNOHANG);
299 if (child == pid || (child < 0 && errno != EAGAIN))
305 if (ppoll(p, 1, &ts, sigs) || __io_canceled) {
307 waitpid(pid, &status, 0);
317 static void cmd_connect(int ctl, int dev, bdaddr_t *bdaddr, int argc, char **argv)
319 struct sockaddr_rc laddr, raddr;
320 struct rfcomm_dev_req req;
326 char dst[18], devname[MAXPATHLEN];
327 int sk, fd, try = 30;
329 laddr.rc_family = AF_BLUETOOTH;
330 bacpy(&laddr.rc_bdaddr, bdaddr);
331 laddr.rc_channel = 0;
334 if (rfcomm_read_config(rfcomm_config_file) < 0) {
335 perror("Can't open RFCOMM config file");
339 raddr.rc_family = AF_BLUETOOTH;
340 bacpy(&raddr.rc_bdaddr, &rfcomm_opts[dev].bdaddr);
341 raddr.rc_channel = rfcomm_opts[dev].channel;
343 if (bacmp(&raddr.rc_bdaddr, BDADDR_ANY) == 0) {
344 fprintf(stderr, "Can't find a config entry for rfcomm%d\n", dev);
348 raddr.rc_family = AF_BLUETOOTH;
349 str2ba(argv[1], &raddr.rc_bdaddr);
352 raddr.rc_channel = atoi(argv[2]);
354 raddr.rc_channel = 1;
357 sk = socket(AF_BLUETOOTH, SOCK_STREAM, BTPROTO_RFCOMM);
359 perror("Can't create RFCOMM socket");
364 struct linger l = { .l_onoff = 1, .l_linger = linger };
366 if (setsockopt(sk, SOL_SOCKET, SO_LINGER, &l, sizeof(l)) < 0) {
367 perror("Can't set linger option");
372 if (bind(sk, (struct sockaddr *) &laddr, sizeof(laddr)) < 0) {
373 perror("Can't bind RFCOMM socket");
378 if (connect(sk, (struct sockaddr *) &raddr, sizeof(raddr)) < 0) {
379 perror("Can't connect RFCOMM socket");
384 alen = sizeof(laddr);
385 if (getsockname(sk, (struct sockaddr *)&laddr, &alen) < 0) {
386 perror("Can't get RFCOMM socket name");
391 memset(&req, 0, sizeof(req));
393 req.flags = (1 << RFCOMM_REUSE_DLC) | (1 << RFCOMM_RELEASE_ONHUP);
395 bacpy(&req.src, &laddr.rc_bdaddr);
396 bacpy(&req.dst, &raddr.rc_bdaddr);
397 req.channel = raddr.rc_channel;
399 dev = ioctl(sk, RFCOMMCREATEDEV, &req);
401 perror("Can't create RFCOMM TTY");
406 snprintf(devname, MAXPATHLEN - 1, "/dev/rfcomm%d", dev);
407 while ((fd = open(devname, O_RDONLY | O_NOCTTY)) < 0) {
408 if (errno == EACCES) {
409 perror("Can't open RFCOMM device");
413 snprintf(devname, MAXPATHLEN - 1, "/dev/bluetooth/rfcomm/%d", dev);
414 if ((fd = open(devname, O_RDONLY | O_NOCTTY)) < 0) {
416 snprintf(devname, MAXPATHLEN - 1, "/dev/rfcomm%d", dev);
420 perror("Can't open RFCOMM device");
425 if (rfcomm_raw_tty) {
426 tcflush(fd, TCIOFLUSH);
429 tcsetattr(fd, TCSANOW, &ti);
434 ba2str(&req.dst, dst);
435 printf("Connected %s to %s on channel %d\n", devname, dst, req.channel);
436 printf("Press CTRL-C for hangup\n");
438 memset(&sa, 0, sizeof(sa));
439 sa.sa_flags = SA_NOCLDSTOP;
440 sa.sa_handler = SIG_IGN;
441 sigaction(SIGCHLD, &sa, NULL);
442 sigaction(SIGPIPE, &sa, NULL);
444 sa.sa_handler = sig_term;
445 sigaction(SIGTERM, &sa, NULL);
446 sigaction(SIGINT, &sa, NULL);
448 sa.sa_handler = sig_hup;
449 sigaction(SIGHUP, &sa, NULL);
452 sigdelset(&sigs, SIGCHLD);
453 sigdelset(&sigs, SIGPIPE);
454 sigdelset(&sigs, SIGTERM);
455 sigdelset(&sigs, SIGINT);
456 sigdelset(&sigs, SIGHUP);
459 p.events = POLLERR | POLLHUP;
461 while (!__io_canceled) {
463 if (ppoll(&p, 1, NULL, &sigs) > 0)
467 printf("Disconnected\n");
473 memset(&req, 0, sizeof(req));
475 req.flags = (1 << RFCOMM_HANGUP_NOW);
476 ioctl(ctl, RFCOMMRELEASEDEV, &req);
481 static void cmd_listen(int ctl, int dev, bdaddr_t *bdaddr, int argc, char **argv)
483 struct sockaddr_rc laddr, raddr;
484 struct rfcomm_dev_req req;
490 char dst[18], devname[MAXPATHLEN];
491 int sk, nsk, fd, lm, try = 30;
493 laddr.rc_family = AF_BLUETOOTH;
494 bacpy(&laddr.rc_bdaddr, bdaddr);
495 laddr.rc_channel = (argc < 2) ? 1 : atoi(argv[1]);
497 sk = socket(AF_BLUETOOTH, SOCK_STREAM, BTPROTO_RFCOMM);
499 perror("Can't create RFCOMM socket");
505 lm |= RFCOMM_LM_MASTER;
507 lm |= RFCOMM_LM_AUTH;
509 lm |= RFCOMM_LM_ENCRYPT;
511 lm |= RFCOMM_LM_SECURE;
513 if (lm && setsockopt(sk, SOL_RFCOMM, RFCOMM_LM, &lm, sizeof(lm)) < 0) {
514 perror("Can't set RFCOMM link mode");
519 if (bind(sk, (struct sockaddr *)&laddr, sizeof(laddr)) < 0) {
520 perror("Can't bind RFCOMM socket");
525 printf("Waiting for connection on channel %d\n", laddr.rc_channel);
529 alen = sizeof(raddr);
530 nsk = accept(sk, (struct sockaddr *) &raddr, &alen);
532 alen = sizeof(laddr);
533 if (getsockname(nsk, (struct sockaddr *)&laddr, &alen) < 0) {
534 perror("Can't get RFCOMM socket name");
540 struct linger l = { .l_onoff = 1, .l_linger = linger };
542 if (setsockopt(nsk, SOL_SOCKET, SO_LINGER, &l, sizeof(l)) < 0) {
543 perror("Can't set linger option");
549 memset(&req, 0, sizeof(req));
551 req.flags = (1 << RFCOMM_REUSE_DLC) | (1 << RFCOMM_RELEASE_ONHUP);
553 bacpy(&req.src, &laddr.rc_bdaddr);
554 bacpy(&req.dst, &raddr.rc_bdaddr);
555 req.channel = raddr.rc_channel;
557 dev = ioctl(nsk, RFCOMMCREATEDEV, &req);
559 perror("Can't create RFCOMM TTY");
564 snprintf(devname, MAXPATHLEN - 1, "/dev/rfcomm%d", dev);
565 while ((fd = open(devname, O_RDONLY | O_NOCTTY)) < 0) {
566 if (errno == EACCES) {
567 perror("Can't open RFCOMM device");
571 snprintf(devname, MAXPATHLEN - 1, "/dev/bluetooth/rfcomm/%d", dev);
572 if ((fd = open(devname, O_RDONLY | O_NOCTTY)) < 0) {
574 snprintf(devname, MAXPATHLEN - 1, "/dev/rfcomm%d", dev);
578 perror("Can't open RFCOMM device");
583 if (rfcomm_raw_tty) {
584 tcflush(fd, TCIOFLUSH);
587 tcsetattr(fd, TCSANOW, &ti);
593 ba2str(&req.dst, dst);
594 printf("Connection from %s to %s\n", dst, devname);
595 printf("Press CTRL-C for hangup\n");
597 memset(&sa, 0, sizeof(sa));
598 sa.sa_flags = SA_NOCLDSTOP;
599 sa.sa_handler = SIG_IGN;
600 sigaction(SIGCHLD, &sa, NULL);
601 sigaction(SIGPIPE, &sa, NULL);
603 sa.sa_handler = sig_term;
604 sigaction(SIGTERM, &sa, NULL);
605 sigaction(SIGINT, &sa, NULL);
607 sa.sa_handler = sig_hup;
608 sigaction(SIGHUP, &sa, NULL);
611 sigdelset(&sigs, SIGCHLD);
612 sigdelset(&sigs, SIGPIPE);
613 sigdelset(&sigs, SIGTERM);
614 sigdelset(&sigs, SIGINT);
615 sigdelset(&sigs, SIGHUP);
618 p.events = POLLERR | POLLHUP;
621 while (!__io_canceled) {
623 if (ppoll(&p, 1, NULL, &sigs) > 0)
627 run_cmdline(&p, &sigs, devname, argc - 2, argv + 2);
629 sa.sa_handler = NULL;
630 sigaction(SIGTERM, &sa, NULL);
631 sigaction(SIGINT, &sa, NULL);
633 printf("Disconnected\n");
639 memset(&req, 0, sizeof(req));
641 req.flags = (1 << RFCOMM_HANGUP_NOW);
642 ioctl(ctl, RFCOMMRELEASEDEV, &req);
647 static void cmd_watch(int ctl, int dev, bdaddr_t *bdaddr, int argc, char **argv)
649 while (!__io_canceled) {
650 cmd_listen(ctl, dev, bdaddr, argc, argv);
655 static void cmd_create(int ctl, int dev, bdaddr_t *bdaddr, int argc, char **argv)
657 if (strcmp(argv[0], "all") == 0)
660 create_dev(ctl, dev, 0, bdaddr, argc, argv);
663 static void cmd_release(int ctl, int dev, bdaddr_t *bdaddr, int argc, char **argv)
665 if (strcmp(argv[0], "all") == 0)
668 release_dev(ctl, dev, 0);
671 static void cmd_show(int ctl, int dev, bdaddr_t *bdaddr, int argc, char **argv)
673 if (strcmp(argv[0], "all") == 0)
674 print_dev_list(ctl, 0);
676 struct rfcomm_dev_info di = { .id = atoi(argv[0]) };
677 if (ioctl(ctl, RFCOMMGETDEVINFO, &di) < 0) {
678 perror("Get info failed");
689 void (*func)(int ctl, int dev, bdaddr_t *bdaddr, int argc, char **argv);
693 { "bind", "create", cmd_create, "<dev> <bdaddr> [channel]", "Bind device" },
694 { "release", "unbind", cmd_release, "<dev>", "Release device" },
695 { "show", "info", cmd_show, "<dev>", "Show device" },
696 { "connect", "conn", cmd_connect, "<dev> <bdaddr> [channel]", "Connect device" },
697 { "listen", "server", cmd_listen, "<dev> [channel [cmd]]", "Listen" },
698 { "watch", "watch", cmd_watch, "<dev> [channel [cmd]]", "Watch" },
699 { NULL, NULL, NULL, 0, 0 }
702 static void usage(void)
706 printf("RFCOMM configuration utility ver %s\n", VERSION);
709 "\trfcomm [options] <command> <dev>\n"
713 "\t-i [hciX|bdaddr] Local HCI device or BD Address\n"
714 "\t-h, --help Display help\n"
715 "\t-r, --raw Switch TTY into raw mode\n"
716 "\t-A, --auth Enable authentication\n"
717 "\t-E, --encrypt Enable encryption\n"
718 "\t-S, --secure Secure connection\n"
719 "\t-M, --master Become the master of a piconet\n"
720 "\t-f, --config [file] Specify alternate config file\n"
721 "\t-a Show all devices (default)\n"
724 printf("Commands:\n");
725 for (i = 0; command[i].cmd; i++)
726 printf("\t%-8s %-24s\t%s\n",
728 command[i].opt ? command[i].opt : " ",
733 static struct option main_options[] = {
734 { "help", 0, 0, 'h' },
735 { "device", 1, 0, 'i' },
736 { "config", 1, 0, 'f' },
737 { "raw", 0, 0, 'r' },
738 { "auth", 0, 0, 'A' },
739 { "encrypt", 0, 0, 'E' },
740 { "secure", 0, 0, 'S' },
741 { "master", 0, 0, 'M' },
742 { "linger", 1, 0, 'L' },
746 int main(int argc, char *argv[])
749 int i, opt, ctl, dev_id, show_all = 0;
751 bacpy(&bdaddr, BDADDR_ANY);
753 while ((opt = getopt_long(argc, argv, "+i:f:rahAESML:", main_options, NULL)) != -1) {
756 if (strncmp(optarg, "hci", 3) == 0)
757 hci_devba(atoi(optarg + 3), &bdaddr);
759 str2ba(optarg, &bdaddr);
763 rfcomm_config_file = strdup(optarg);
795 linger = atoi(optarg);
815 ctl = socket(AF_BLUETOOTH, SOCK_RAW, BTPROTO_RFCOMM);
817 perror("Can't open RFCOMM control socket");
822 print_dev_list(ctl, 0);
827 if (strncmp(argv[1], "/dev/rfcomm", 11) == 0)
828 dev_id = atoi(argv[1] + 11);
829 else if (strncmp(argv[1], "rfcomm", 6) == 0)
830 dev_id = atoi(argv[1] + 6);
832 dev_id = atoi(argv[1]);
834 for (i = 0; command[i].cmd; i++) {
835 if (strncmp(command[i].cmd, argv[0], 4) && strncmp(command[i].alt, argv[0], 4))
839 command[i].func(ctl, dev_id, &bdaddr, argc, argv);