2 * slcand.c - userspace daemon for serial line CAN interface driver SLCAN
4 * Copyright (c) 2009 Robert Haddon <robert.haddon@verari.com>
5 * Copyright (c) 2009 Verari Systems Inc.
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License as published by
9 * the Free Software Foundation; either version 2 of the License, or
10 * (at your option) any later version.
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
17 * You should have received a copy of the GNU General Public License
18 * along with this program; if not, write to the Free Software
19 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
21 * Send feedback to <linux-can@vger.kernel.org>
29 #include <sys/types.h>
31 #include <sys/socket.h>
37 #include <sys/ioctl.h>
40 #include <linux/tty.h>
41 #include <linux/sockios.h>
43 /* Change this to whatever your daemon is called */
44 #define DAEMON_NAME "slcand"
46 /* Change this to the user under which to run */
47 #define RUN_AS_USER "root"
49 /* The length of ttypath buffer */
50 #define TTYPATH_LENGTH 64
52 /* UART flow control types */
57 void print_usage(char *prg)
59 fprintf(stderr, "\nUsage: %s [options] <tty> [canif-name]\n\n", prg);
60 fprintf(stderr, "Options: -o (send open command 'O\\r')\n");
61 fprintf(stderr, " -c (send close command 'C\\r')\n");
62 fprintf(stderr, " -f (read status flags with 'F\\r' to reset error states)\n");
63 fprintf(stderr, " -l (send listen only command 'L\\r', overrides -o)\n");
64 fprintf(stderr, " -s <speed> (set CAN speed 0..8)\n");
65 fprintf(stderr, " -S <speed> (set UART speed in baud)\n");
66 fprintf(stderr, " -t <type> (set UART flow control type 'hw' or 'sw')\n");
67 fprintf(stderr, " -b <btr> (set bit time register value)\n");
68 fprintf(stderr, " -F (stay in foreground; no daemonize)\n");
69 fprintf(stderr, " -h (show this help page)\n");
70 fprintf(stderr, "\nExamples:\n");
71 fprintf(stderr, "slcand -o -c -f -s6 ttyUSB0\n");
72 fprintf(stderr, "slcand -o -c -f -s6 ttyUSB0 can0\n");
73 fprintf(stderr, "slcand -o -c -f -s6 /dev/ttyUSB0\n");
74 fprintf(stderr, "\n");
78 static int slcand_running;
80 static char ttypath[TTYPATH_LENGTH];
82 static void child_handler(int signum)
92 syslog(LOG_NOTICE, "received signal %i on %s", signum, ttypath);
93 exit_code = EXIT_FAILURE;
98 syslog(LOG_NOTICE, "received signal %i on %s", signum, ttypath);
99 exit_code = EXIT_SUCCESS;
105 static int look_up_uart_speed(long int s)
162 int main(int argc, char *argv[])
165 char const *devprefix = "/dev/";
167 char buf[IFNAMSIZ+1];
176 int send_read_status_flags = 0;
178 char *uart_speed_str = NULL;
179 long int uart_speed = 0;
180 int flow_type = FLOW_NONE;
182 int run_as_daemon = 1;
189 while ((opt = getopt(argc, argv, "ocfls:S:t:b:?hF")) != -1) {
198 send_read_status_flags = 1;
205 if (strlen(speed) > 1)
206 print_usage(argv[0]);
209 uart_speed_str = optarg;
211 uart_speed = strtol(uart_speed_str, NULL, 10);
213 print_usage(argv[0]);
214 if (look_up_uart_speed(uart_speed) == -1) {
215 fprintf(stderr, "Unsupported UART speed (%lu)\n", uart_speed);
220 if (!strcmp(optarg, "hw")) {
222 } else if (!strcmp(optarg, "sw")) {
225 fprintf(stderr, "Unsupported flow type (%s)\n", optarg);
232 print_usage(argv[0]);
240 print_usage(argv[0]);
245 /* Initialize the logging interface */
246 openlog(DAEMON_NAME, LOG_PID, LOG_LOCAL5);
248 /* Parse serial device name and optional can interface name */
251 print_usage(argv[0]);
253 name = argv[optind + 1];
255 /* Prepare the tty device name string */
256 pch = strstr(tty, devprefix);
258 snprintf(ttypath, TTYPATH_LENGTH, "%s%s", devprefix, tty);
260 snprintf(ttypath, TTYPATH_LENGTH, "%s", tty);
262 syslog(LOG_INFO, "starting on TTY device %s", ttypath);
267 syslog(LOG_ERR, "failed to daemonize");
272 /* Trap signals that we expect to receive */
273 signal(SIGINT, child_handler);
274 signal(SIGTERM, child_handler);
280 /* Now we are a daemon -- do the work for which we were paid */
281 fd = open(ttypath, O_RDWR | O_NONBLOCK | O_NOCTTY);
283 syslog(LOG_NOTICE, "failed to open TTY device %s\n", ttypath);
288 /* Configure baud rate */
289 memset(&tios, 0, sizeof(struct termios));
290 if (tcgetattr(fd, &tios) < 0) {
291 syslog(LOG_NOTICE, "failed to get attributes for TTY device %s: %s\n", ttypath, strerror(errno));
295 /* Get old values for later restore */
296 old_ispeed = cfgetispeed(&tios);
297 old_ospeed = cfgetospeed(&tios);
299 /* Reset UART settings */
301 tios.c_iflag &= ~IXOFF;
302 tios.c_cflag &= ~CRTSCTS;
305 cfsetispeed(&tios, look_up_uart_speed(uart_speed));
306 cfsetospeed(&tios, look_up_uart_speed(uart_speed));
309 if (flow_type == FLOW_HW)
310 tios.c_cflag |= CRTSCTS;
311 else if (flow_type == FLOW_SW)
312 tios.c_iflag |= (IXON | IXOFF);
315 if (tcsetattr(fd, TCSADRAIN, &tios) < 0)
316 syslog(LOG_NOTICE, "Cannot set attributes for device \"%s\": %s!\n", ttypath, strerror(errno));
319 sprintf(buf, "C\rS%s\r", speed);
320 write(fd, buf, strlen(buf));
324 sprintf(buf, "C\rs%s\r", btr);
325 write(fd, buf, strlen(buf));
328 if (send_read_status_flags) {
330 write(fd, buf, strlen(buf));
335 write(fd, buf, strlen(buf));
336 } else if (send_open) {
338 write(fd, buf, strlen(buf));
341 /* set slcan like discipline on given tty */
342 if (ioctl(fd, TIOCSETD, &ldisc) < 0) {
343 perror("ioctl TIOCSETD");
347 /* retrieve the name of the created CAN netdevice */
348 if (ioctl(fd, SIOCGIFNAME, buf) < 0) {
349 perror("ioctl SIOCGIFNAME");
353 syslog(LOG_NOTICE, "attached TTY %s to netdevice %s\n", ttypath, buf);
355 /* try to rename the created netdevice */
358 int s = socket(PF_INET, SOCK_DGRAM, 0);
361 perror("socket for interface rename");
363 strncpy(ifr.ifr_name, buf, IFNAMSIZ);
364 strncpy(ifr.ifr_newname, name, IFNAMSIZ);
366 if (ioctl(s, SIOCSIFNAME, &ifr) < 0) {
367 syslog(LOG_NOTICE, "netdevice %s rename to %s failed\n", buf, name);
368 perror("ioctl SIOCSIFNAME rename");
371 syslog(LOG_NOTICE, "netdevice %s renamed to %s\n", buf, name);
378 while (slcand_running)
379 sleep(1); /* wait 1 second */
381 /* Reset line discipline */
382 syslog(LOG_INFO, "stopping on TTY device %s", ttypath);
384 if (ioctl(fd, TIOCSETD, &ldisc) < 0) {
385 perror("ioctl TIOCSETD");
391 write(fd, buf, strlen(buf));
394 /* Reset old rates */
395 cfsetispeed(&tios, old_ispeed);
396 cfsetospeed(&tios, old_ospeed);
399 if (tcsetattr(fd, TCSADRAIN, &tios) < 0)
400 syslog(LOG_NOTICE, "Cannot set attributes for device \"%s\": %s!\n", ttypath, strerror(errno));
403 syslog(LOG_NOTICE, "terminated on %s", ttypath);