usr.bin/bluetooth/rfcomm_sppd/rfcomm_sppd.c

   1 /*
   2  * rfcomm_sppd.c
   3  */
   4
   5 /*-
   6  * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
   7  *
   8  * Copyright (c) 2003 Maksim Yevmenkin <m_evmenkin@yahoo.com>
   9  * All rights reserved.
  10  *
  11  * Redistribution and use in source and binary forms, with or without
  12  * modification, are permitted provided that the following conditions
  13  * are met:
  14  * 1. Redistributions of source code must retain the above copyright
  15  *    notice, this list of conditions and the following disclaimer.
  16  * 2. Redistributions in binary form must reproduce the above copyright
  17  *    notice, this list of conditions and the following disclaimer in the
  18  *    documentation and/or other materials provided with the distribution.
  19  *
  20  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
  21  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  22  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  23  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
  24  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  25  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  26  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  27  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  28  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  29  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  30  * SUCH DAMAGE.
  31  *
  32  * $Id: rfcomm_sppd.c,v 1.4 2003/09/07 18:15:55 max Exp $
  33  * $FreeBSD$
  34  */
  35
  36 #include <sys/stat.h>
  37 #include <sys/types.h>
  38 #define L2CAP_SOCKET_CHECKED
  39 #include <bluetooth.h>
  40 #include <ctype.h>
  41 #include <err.h>
  42 #include <errno.h>
  43 #include <fcntl.h>
  44 #include <grp.h>
  45 #include <limits.h>
  46 #include <paths.h>
  47 #include <sdp.h>
  48 #include <signal.h>
  49 #include <stdarg.h>
  50 #include <stdio.h>
  51 #include <stdlib.h>
  52 #include <string.h>
  53 #include <syslog.h>
  54 #include <termios.h>
  55 #include <unistd.h>
  56 #include <libutil.h>
  57
  58 #define SPPD_IDENT              "rfcomm_sppd"
  59 #define SPPD_BUFFER_SIZE        1024
  60 #define max(a, b)               (((a) > (b))? (a) : (b))
  61
  62 int             rfcomm_channel_lookup   (bdaddr_t const *local,
  63                                          bdaddr_t const *remote,
  64                                          int service, int *channel, int *error);
  65
  66 static int      sppd_ttys_open  (char **tty, int *amaster, int *aslave);
  67 static int      sppd_read       (int fd, char *buffer, int size);
  68 static int      sppd_write      (int fd, char *buffer, int size);
  69 static void     sppd_sighandler (int s);
  70 static void     usage           (void);
  71
  72 static int      done;   /* are we done? */
  73
  74 /* Main */
  75 int
  76 main(int argc, char *argv[])
  77 {
  78         struct sigaction         sa;
  79         struct sockaddr_rfcomm   ra;
  80         bdaddr_t                 addr;
  81         int                      n, background, channel, service,
  82                                  s, amaster, aslave, fd, doserver,
  83                                  dopty;
  84         fd_set                   rfd;
  85         char                    *tty = NULL, *ep = NULL, buf[SPPD_BUFFER_SIZE];
  86
  87         memcpy(&addr, NG_HCI_BDADDR_ANY, sizeof(addr));
  88         background = channel = 0;
  89         service = SDP_SERVICE_CLASS_SERIAL_PORT;
  90         doserver = 0;
  91         dopty = 0;
  92
  93         /* Parse command line options */
  94         while ((n = getopt(argc, argv, "a:bc:thS")) != -1) {
  95                 switch (n) {
  96                 case 'a': /* BDADDR */
  97                         if (!bt_aton(optarg, &addr)) {
  98                                 struct hostent  *he = NULL;
  99
 100                                 if ((he = bt_gethostbyname(optarg)) == NULL)
 101                                         errx(1, "%s: %s", optarg, hstrerror(h_errno));
 102
 103                                 memcpy(&addr, he->h_addr, sizeof(addr));
 104                         }
 105                         break;
 106
 107                 case 'c': /* RFCOMM channel */
 108                         channel = strtoul(optarg, &ep, 10);
 109                         if (*ep != '\0') {
 110                                 channel = 0;
 111                                 switch (tolower(optarg[0])) {
 112                                 case 'd': /* DialUp Networking */
 113                                         service = SDP_SERVICE_CLASS_DIALUP_NETWORKING;
 114                                         break;
 115
 116                                 case 'f': /* Fax */
 117                                         service = SDP_SERVICE_CLASS_FAX;
 118                                         break;
 119
 120                                 case 'l': /* LAN */
 121                                         service = SDP_SERVICE_CLASS_LAN_ACCESS_USING_PPP;
 122                                         break;
 123
 124                                 case 's': /* Serial Port */
 125                                         service = SDP_SERVICE_CLASS_SERIAL_PORT;
 126                                         break;
 127
 128                                 default:
 129                                         errx(1, "Unknown service name: %s",
 130                                                 optarg);
 131                                         /* NOT REACHED */
 132                                 }
 133                         }
 134                         break;
 135
 136                 case 'b': /* Run in background */
 137                         background = 1;
 138                         break;
 139
 140                 case 't': /* Open pseudo TTY */
 141                         dopty = 1;
 142                         break;
 143
 144                 case 'S':
 145                         doserver = 1;
 146                         break;
 147
 148                 case 'h':
 149                 default:
 150                         usage();
 151                         /* NOT REACHED */
 152                 }
 153         }
 154
 155         /* Check if we have everything we need */
 156         if (!doserver && memcmp(&addr, NG_HCI_BDADDR_ANY, sizeof(addr)) == 0)
 157                 usage();
 158                 /* NOT REACHED */
 159
 160         /* Set signal handlers */
 161         memset(&sa, 0, sizeof(sa));
 162         sa.sa_handler = sppd_sighandler;
 163
 164         if (sigaction(SIGTERM, &sa, NULL) < 0)
 165                 err(1, "Could not sigaction(SIGTERM)");
 166
 167         if (sigaction(SIGHUP, &sa, NULL) < 0)
 168                 err(1, "Could not sigaction(SIGHUP)");
 169
 170         if (sigaction(SIGINT, &sa, NULL) < 0)
 171                 err(1, "Could not sigaction(SIGINT)");
 172
 173         sa.sa_handler = SIG_IGN;
 174         sa.sa_flags = SA_NOCLDWAIT;
 175
 176         if (sigaction(SIGCHLD, &sa, NULL) < 0)
 177                 err(1, "Could not sigaction(SIGCHLD)");
 178
 179         /* Open TTYs */
 180         if (dopty) {
 181                 if (sppd_ttys_open(&tty, &amaster, &aslave) < 0)
 182                         exit(1);
 183
 184                 fd = amaster;
 185         } else {
 186                 if (background)
 187                         usage();
 188
 189                 amaster = STDIN_FILENO;
 190                 fd = STDOUT_FILENO;
 191         }
 192
 193         /* Open RFCOMM connection */
 194
 195         if (doserver) {
 196                 struct sockaddr_rfcomm   ma;
 197                 bdaddr_t                 bt_addr_any;
 198                 sdp_sp_profile_t         sp;
 199                 void                    *ss;
 200                 uint32_t                 sdp_handle;
 201                 int                      acceptsock, aaddrlen;
 202
 203                 acceptsock = socket(PF_BLUETOOTH, SOCK_STREAM,
 204                                         BLUETOOTH_PROTO_RFCOMM);
 205                 if (acceptsock < 0)
 206                         err(1, "Could not create socket");
 207
 208                 memcpy(&bt_addr_any, NG_HCI_BDADDR_ANY, sizeof(bt_addr_any));
 209
 210                 memset(&ma, 0, sizeof(ma));
 211                 ma.rfcomm_len = sizeof(ma);
 212                 ma.rfcomm_family = AF_BLUETOOTH;
 213                 memcpy(&ma.rfcomm_bdaddr, &bt_addr_any, sizeof(bt_addr_any));
 214                 ma.rfcomm_channel = channel;
 215
 216                 if (bind(acceptsock, (struct sockaddr *)&ma, sizeof(ma)) < 0)
 217                         err(1, "Could not bind socket on channel %d", channel);
 218                 if (listen(acceptsock, 10) != 0)
 219                         err(1, "Could not listen on socket");
 220
 221                 aaddrlen = sizeof(ma);
 222                 if (getsockname(acceptsock, (struct sockaddr *)&ma, &aaddrlen) < 0)
 223                         err(1, "Could not get socket name");
 224                 channel = ma.rfcomm_channel;
 225
 226                 ss = sdp_open_local(NULL);
 227                 if (ss == NULL)
 228                         errx(1, "Unable to create local SDP session");
 229                 if (sdp_error(ss) != 0)
 230                         errx(1, "Unable to open local SDP session. %s (%d)",
 231                             strerror(sdp_error(ss)), sdp_error(ss));
 232                 memset(&sp, 0, sizeof(sp));
 233                 sp.server_channel = channel;
 234
 235                 if (sdp_register_service(ss, SDP_SERVICE_CLASS_SERIAL_PORT,
 236                                 &bt_addr_any, (void *)&sp, sizeof(sp),
 237                                 &sdp_handle) != 0) {
 238                         errx(1, "Unable to register LAN service with "
 239                             "local SDP daemon. %s (%d)",
 240                             strerror(sdp_error(ss)), sdp_error(ss));
 241                 }
 242
 243                 s = -1;
 244                 while (s < 0) {
 245                         aaddrlen = sizeof(ra);
 246                         s = accept(acceptsock, (struct sockaddr *)&ra,
 247                             &aaddrlen);
 248                         if (s < 0)
 249                                 err(1, "Unable to accept()");
 250                         if (memcmp(&addr, NG_HCI_BDADDR_ANY, sizeof(addr)) &&
 251                             memcmp(&addr, &ra.rfcomm_bdaddr, sizeof(addr))) {
 252                                 warnx("Connect from wrong client");
 253                                 close(s);
 254                                 s = -1;
 255                         }
 256                 }
 257                 sdp_unregister_service(ss, sdp_handle);
 258                 sdp_close(ss);
 259                 close(acceptsock);
 260         } else {
 261                 /* Check channel, if was not set then obtain it via SDP */
 262                 if (channel == 0 && service != 0)
 263                         if (rfcomm_channel_lookup(NULL, &addr,
 264                                     service, &channel, &n) != 0)
 265                                 errc(1, n, "Could not obtain RFCOMM channel");
 266                 if (channel <= 0 || channel > 30)
 267                         errx(1, "Invalid RFCOMM channel number %d", channel);
 268
 269                 s = socket(PF_BLUETOOTH, SOCK_STREAM, BLUETOOTH_PROTO_RFCOMM);
 270                 if (s < 0)
 271                         err(1, "Could not create socket");
 272
 273                 memset(&ra, 0, sizeof(ra));
 274                 ra.rfcomm_len = sizeof(ra);
 275                 ra.rfcomm_family = AF_BLUETOOTH;
 276
 277                 if (bind(s, (struct sockaddr *) &ra, sizeof(ra)) < 0)
 278                         err(1, "Could not bind socket");
 279
 280                 memcpy(&ra.rfcomm_bdaddr, &addr, sizeof(ra.rfcomm_bdaddr));
 281                 ra.rfcomm_channel = channel;
 282
 283                 if (connect(s, (struct sockaddr *) &ra, sizeof(ra)) < 0)
 284                         err(1, "Could not connect socket");
 285         }
 286
 287         /* Became daemon if required */
 288         if (background && daemon(0, 0) < 0)
 289                 err(1, "Could not daemon()");
 290
 291         openlog(SPPD_IDENT, LOG_NDELAY|LOG_PERROR|LOG_PID, LOG_DAEMON);
 292         syslog(LOG_INFO, "Starting on %s...", (tty != NULL)? tty : "stdin/stdout");
 293
 294         /* Print used tty on stdout for wrappers to pick up */
 295         if (!background)
 296                 fprintf(stdout, "%s\n", tty);
 297
 298         for (done = 0; !done; ) {
 299                 FD_ZERO(&rfd);
 300                 FD_SET(amaster, &rfd);
 301                 FD_SET(s, &rfd);
 302
 303                 n = select(max(amaster, s) + 1, &rfd, NULL, NULL, NULL);
 304                 if (n < 0) {
 305                         if (errno == EINTR)
 306                                 continue;
 307
 308                         syslog(LOG_ERR, "Could not select(). %s",
 309                                         strerror(errno));
 310                         exit(1);
 311                 }
 312
 313                 if (n == 0)
 314                         continue;
 315
 316                 if (FD_ISSET(amaster, &rfd)) {
 317                         n = sppd_read(amaster, buf, sizeof(buf));
 318                         if (n < 0) {
 319                                 syslog(LOG_ERR, "Could not read master pty, " \
 320                                         "fd=%d. %s", amaster, strerror(errno));
 321                                 exit(1);
 322                         }
 323
 324                         if (n == 0)
 325                                 break; /* XXX */
 326
 327                         if (sppd_write(s, buf, n) < 0) {
 328                                 syslog(LOG_ERR, "Could not write to socket, " \
 329                                         "fd=%d, size=%d. %s",
 330                                         s, n, strerror(errno));
 331                                 exit(1);
 332                         }
 333                 }
 334
 335                 if (FD_ISSET(s, &rfd)) {
 336                         n = sppd_read(s, buf, sizeof(buf));
 337                         if (n < 0) {
 338                                 syslog(LOG_ERR, "Could not read socket, " \
 339                                         "fd=%d. %s", s, strerror(errno));
 340                                 exit(1);
 341                         }
 342
 343                         if (n == 0)
 344                                 break;
 345
 346                         if (sppd_write(fd, buf, n) < 0) {
 347                                 syslog(LOG_ERR, "Could not write to master " \
 348                                         "pty, fd=%d, size=%d. %s",
 349                                         fd, n, strerror(errno));
 350                                 exit(1);
 351                         }
 352                 }
 353         }
 354
 355         syslog(LOG_INFO, "Completed on %s", (tty != NULL)? tty : "stdin/stdout");
 356         closelog();
 357
 358         close(s);
 359
 360         if (tty != NULL) {
 361                 close(aslave);
 362                 close(amaster);
 363         }
 364
 365         return (0);
 366 }
 367
 368 /* Open TTYs */
 369 static int
 370 sppd_ttys_open(char **tty, int *amaster, int *aslave)
 371 {
 372         char             pty[PATH_MAX];
 373         struct termios   tio;
 374
 375         cfmakeraw(&tio);
 376
 377         if (openpty(amaster, aslave, pty, &tio, NULL) == -1) {
 378                 syslog(LOG_ERR, "Could not openpty(). %s", strerror(errno));
 379                 return (-1);
 380         }
 381
 382         if ((*tty = strdup(pty)) == NULL) {
 383                 syslog(LOG_ERR, "Could not strdup(). %s", strerror(errno));
 384                 close(*aslave);
 385                 close(*amaster);
 386                 return (-1);
 387         }
 388
 389         return (0);
 390 } /* sppd_ttys_open */
 391
 392 /* Read data */
 393 static int
 394 sppd_read(int fd, char *buffer, int size)
 395 {
 396         int     n;
 397
 398 again:
 399         n = read(fd, buffer, size);
 400         if (n < 0) {
 401                 if (errno == EINTR)
 402                         goto again;
 403
 404                 return (-1);
 405         }
 406
 407         return (n);
 408 } /* sppd_read */
 409
 410 /* Write data */
 411 static int
 412 sppd_write(int fd, char *buffer, int size)
 413 {
 414         int     n, wrote;
 415
 416         for (wrote = 0; size > 0; ) {
 417                 n = write(fd, buffer, size);
 418                 switch (n) {
 419                 case -1:
 420                         if (errno != EINTR)
 421                                 return (-1);
 422                         break;
 423
 424                 case 0:
 425                         /* XXX can happen? */
 426                         break;
 427
 428                 default:
 429                         wrote += n;
 430                         buffer += n;
 431                         size -= n;
 432                         break;
 433                 }
 434         }
 435
 436         return (wrote);
 437 } /* sppd_write */
 438
 439 /* Signal handler */
 440 static void
 441 sppd_sighandler(int s)
 442 {
 443         syslog(LOG_INFO, "Signal %d received. Total %d signals received\n",
 444                         s, ++ done);
 445 } /* sppd_sighandler */
 446
 447 /* Display usage and exit */
 448 static void
 449 usage(void)
 450 {
 451         fprintf(stdout,
 452 "Usage: %s options\n" \
 453 "Where options are:\n" \
 454 "\t-a address Peer address (required in client mode)\n" \
 455 "\t-b         Run in background\n" \
 456 "\t-c channel RFCOMM channel to connect to or listen on\n" \
 457 "\t-t         use slave pseudo tty (required in background mode)\n" \
 458 "\t-S         Server mode\n" \
 459 "\t-h         Display this message\n", SPPD_IDENT);
 460         exit(255);
 461 } /* usage */
 462