usr.sbin/bluetooth/hcseriald/hcseriald.c

   1 /*
   2  * hcseriald.c
   3  *
   4  * Copyright (c) 2001-2002 Maksim Yevmenkin <m_evmenkin@yahoo.com>
   5  * All rights reserved.
   6  *
   7  * Redistribution and use in source and binary forms, with or without
   8  * modification, are permitted provided that the following conditions
   9  * are met:
  10  * 1. Redistributions of source code must retain the above copyright
  11  *    notice, this list of conditions and the following disclaimer.
  12  * 2. Redistributions in binary form must reproduce the above copyright
  13  *    notice, this list of conditions and the following disclaimer in the
  14  *    documentation and/or other materials provided with the distribution.
  15  *
  16  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
  17  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  18  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  19  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
  20  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  21  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  22  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  23  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  24  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  25  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  26  * SUCH DAMAGE.
  27  *
  28  * $Id: hcseriald.c,v 1.3 2003/05/21 22:40:32 max Exp $
  29  * $FreeBSD$
  30  */
  31
  32 #include <sys/types.h>
  33 #include <sys/ioctl.h>
  34
  35 #include <netgraph/ng_message.h>
  36 #include <netgraph.h>
  37 #include <netgraph/bluetooth/include/ng_h4.h>
  38
  39 #include <errno.h>
  40 #include <fcntl.h>
  41 #include <signal.h>
  42 #include <stdarg.h>
  43 #include <stdio.h>
  44 #include <stdlib.h>
  45 #include <string.h>
  46 #include <syslog.h>
  47 #include <termios.h>
  48 #include <unistd.h>
  49
  50 /* Prototypes */
  51 static int      open_device     (char const *, speed_t, char const *);
  52 static void     sighandler      (int);
  53 static void     usage           ();
  54
  55 static char const * const       hcseriald = "hcseriald";
  56 static int                      done = 0;
  57
  58 int
  59 main(int argc, char *argv[])
  60 {
  61         char                    *device = NULL, *name = NULL;
  62         speed_t                  speed = 115200;
  63         int                      n, detach = 1;
  64         char                     p[FILENAME_MAX];
  65         FILE                    *f = NULL;
  66         struct sigaction         sa;
  67
  68         /* Process command line arguments */
  69         while ((n = getopt(argc, argv, "df:n:s:h")) != -1) {
  70                 switch (n) {
  71                 case 'd':
  72                         detach = 0;
  73                         break;
  74
  75                 case 'f':
  76                         device = optarg;
  77                         break;
  78
  79                 case 'n':
  80                         name = optarg;
  81                         break;
  82
  83                 case 's':
  84                         speed = atoi(optarg);
  85                         if (speed < 0)
  86                                 usage(argv[0]);
  87                         break;
  88
  89                 case 'h':
  90                 default:
  91                         usage(argv[0]);
  92                         break;
  93                 }
  94         }
  95
  96         if (device == NULL || name == NULL)
  97                 usage(argv[0]);
  98
  99         openlog(hcseriald, LOG_PID | LOG_NDELAY, LOG_USER);
 100
 101         /* Open device */
 102         n = open_device(device, speed, name);
 103
 104         if (detach) {
 105                 pid_t   pid = fork();
 106
 107                 if (pid == (pid_t) -1) {
 108                         syslog(LOG_ERR, "Could not fork(). %s (%d)",
 109                                 strerror(errno), errno);
 110                         exit(1);
 111                 }
 112
 113                 if (pid != 0)
 114                         exit(0);
 115
 116                 if (daemon(0, 0) < 0) {
 117                         syslog(LOG_ERR, "Could not daemon(0, 0). %s (%d)",
 118                                 strerror(errno), errno);
 119                         exit(1);
 120                 }
 121         }
 122
 123         /* Write PID file */
 124         snprintf(p, sizeof(p), "/var/run/%s.%s.pid", hcseriald, name);
 125         f = fopen(p, "w");
 126         if (f == NULL) {
 127                 syslog(LOG_ERR, "Could not fopen(%s). %s (%d)",
 128                         p, strerror(errno), errno);
 129                 exit(1);
 130         }
 131         fprintf(f, "%d", getpid());
 132         fclose(f);
 133
 134         /* Install signal handler */
 135         memset(&sa, 0, sizeof(sa));
 136         sa.sa_handler = sighandler;
 137
 138         if (sigaction(SIGTERM, &sa, NULL) < 0) {
 139                 syslog(LOG_ERR, "Could not sigaction(SIGTERM). %s (%d)",
 140                         strerror(errno), errno);
 141                 exit(1);
 142         }
 143
 144         if (sigaction(SIGHUP, &sa, NULL) < 0) {
 145                 syslog(LOG_ERR, "Could not sigaction(SIGHUP). %s (%d)",
 146                         strerror(errno), errno);
 147                 exit(1);
 148         }
 149
 150         if (sigaction(SIGINT, &sa, NULL) < 0) {
 151                 syslog(LOG_ERR, "Could not sigaction(SIGINT). %s (%d)",
 152                         strerror(errno), errno);
 153                 exit(1);
 154         }
 155
 156         /* Keep running */
 157         while (!done)
 158                 select(0, NULL, NULL, NULL, NULL);
 159
 160         /* Remove PID file and close device */
 161         unlink(p);
 162         close(n);
 163         closelog();
 164
 165         return (0);
 166 } /* main */
 167
 168 /* Open terminal, set settings, push H4 line discipline and set node name */
 169 static int
 170 open_device(char const *device, speed_t speed, char const *name)
 171 {
 172         int             fd, disc, cs, ds;
 173         struct termios  t;
 174         struct nodeinfo ni;
 175         struct ngm_name n;
 176         char            p[NG_NODESIZ];
 177
 178         /* Open terminal device and setup H4 line discipline */
 179         fd = open(device, O_RDWR|O_NOCTTY);
 180         if (fd < 0) {
 181                 syslog(LOG_ERR, "Could not open(%s). %s (%d)",
 182                         device, strerror(errno), errno);
 183                 exit(1);
 184         }
 185
 186         tcflush(fd, TCIOFLUSH);
 187
 188         if (tcgetattr(fd, &t) < 0) {
 189                 syslog(LOG_ERR, "Could not tcgetattr(%s). %s (%d)",
 190                         device, strerror(errno), errno);
 191                 exit(1);
 192         }
 193
 194         cfmakeraw(&t);
 195
 196         t.c_cflag |= CLOCAL;    /* clocal */
 197         t.c_cflag &= ~CSIZE;    /* cs8 */
 198         t.c_cflag |= CS8;       /* cs8 */
 199         t.c_cflag &= ~PARENB;   /* -parenb */
 200         t.c_cflag &= ~CSTOPB;   /* -cstopb */
 201         t.c_cflag |= CRTSCTS;   /* crtscts */
 202
 203         if (tcsetattr(fd, TCSANOW, &t) < 0) {
 204                 syslog(LOG_ERR, "Could not tcsetattr(%s). %s (%d)",
 205                         device, strerror(errno), errno);
 206                 exit(1);
 207         }
 208
 209         tcflush(fd, TCIOFLUSH);
 210
 211         if (cfsetspeed(&t, speed) < 0) {
 212                 syslog(LOG_ERR, "Could not cfsetspeed(%s). %s (%d)",
 213                         device, strerror(errno), errno);
 214                 exit(1);
 215         }
 216
 217         if (tcsetattr(fd, TCSANOW, &t) < 0) {
 218                 syslog(LOG_ERR, "Could not tcsetattr(%s). %s (%d)",
 219                         device, strerror(errno), errno);
 220                 exit(1);
 221         }
 222
 223         disc = H4DISC;
 224         if (ioctl(fd, TIOCSETD, &disc) < 0) {
 225                 syslog(LOG_ERR, "Could not ioctl(%s, TIOCSETD, %d). %s (%d)",
 226                         device, disc, strerror(errno), errno);
 227                 exit(1);
 228         }
 229
 230         /* Get default name of the Netgraph node */
 231         memset(&ni, 0, sizeof(ni));
 232         if (ioctl(fd, NGIOCGINFO, &ni) < 0) {
 233                 syslog(LOG_ERR, "Could not ioctl(%d, NGIOGINFO). %s (%d)",
 234                         fd, strerror(errno), errno);
 235                 exit(1);
 236         }
 237
 238         /* Assign new name to the Netgraph node */
 239         snprintf(p, sizeof(p), "%s:", ni.name);
 240         snprintf(n.name, sizeof(n.name), "%s", name);
 241
 242         if (NgMkSockNode(NULL, &cs, &ds) < 0) {
 243                 syslog(LOG_ERR, "Could not NgMkSockNode(). %s (%d)",
 244                         strerror(errno), errno);
 245                 exit(1);
 246         }
 247
 248         if (NgSendMsg(cs, p, NGM_GENERIC_COOKIE, NGM_NAME, &n, sizeof(n)) < 0) {
 249                 syslog(LOG_ERR, "Could not NgSendMsg(%d, %s, NGM_NAME, %s). " \
 250                         "%s (%d)", cs, p, n.name, strerror(errno), errno);
 251                 exit(1);
 252         }
 253
 254         close(cs);
 255         close(ds);
 256
 257         return (fd);
 258 } /* open_device */
 259
 260 /* Signal handler */
 261 static void
 262 sighandler(int s)
 263 {
 264         done = 1;
 265 } /* sighandler */
 266
 267 /* Usage */
 268 static void
 269 usage(void)
 270 {
 271         fprintf(stderr, "Usage: %s -f device -n node_name [-s speed -d -h]\n" \
 272                         "Where:\n" \
 273                         "\t-f device    tty device name, ex. /dev/cuad1\n" \
 274                         "\t-n node_name set Netgraph node name to node_name\n" \
 275                         "\t-s speed     set tty speed, ex. 115200\n" \
 276                         "\t-d           run in foreground\n" \
 277                         "\t-h           display this message\n",
 278                         hcseriald);
 279         exit(255);
 280 } /* usage */
 281