X-Git-Url: http://rtime.felk.cvut.cz/gitweb/socketcan-devel.git/blobdiff_plain/45d3b9b03290acc9e8710f3e30a0801704446c8a..7242dfaaacd11619e0ab730d9e9601112e97c05a:/can-utils/slcan_attach.c diff --git a/can-utils/slcan_attach.c b/can-utils/slcan_attach.c index 57c6239..89366be 100644 --- a/can-utils/slcan_attach.c +++ b/can-utils/slcan_attach.c @@ -5,15 +5,14 @@ /* * slcan_attach.c - userspace tool for serial line CAN interface driver SLCAN * - * Copyright (c) 2002-2005 Volkswagen Group Electronic Research + * Copyright (c) 2002-2007 Volkswagen Group Electronic Research * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright - * notice, this list of conditions, the following disclaimer and - * the referenced file 'COPYING'. + * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. @@ -23,8 +22,8 @@ * * Alternatively, provided that this notice is retained in full, this * software may be distributed under the terms of the GNU General - * Public License ("GPL") version 2 as distributed in the 'COPYING' - * file from the main directory of the linux kernel source. + * Public License ("GPL") version 2, in which case the provisions of the + * GPL apply INSTEAD OF those given above. * * The provided data structures and external interfaces from this code * are not restricted to be used by modules with a GPL compatible license. @@ -48,52 +47,187 @@ #include #include +#include #include #include #include #include +#include -#define N_SLCAN 16 /* bad hack until it's not inside the Kernel */ +#define LDISC_N_SLCAN 17 /* default slcan line discipline since Kernel 2.6.25 */ -void usage(char *name) +void print_usage(char *prg) { - fprintf(stderr, "Usage: %s [-d] tty\n", name); + fprintf(stderr, "\nUsage: %s [options] tty\n\n", prg); + fprintf(stderr, "Options: -o (send open command 'O\\r')\n"); + fprintf(stderr, " -c (send close command 'C\\r')\n"); + fprintf(stderr, " -f (read status flags with 'F\\r' to reset error states)\n"); + fprintf(stderr, " -s (set CAN speed 0..8)\n"); + fprintf(stderr, " -b (set bit time register value)\n"); + fprintf(stderr, " -d (only detach line discipline)\n"); + fprintf(stderr, " -w (attach - wait for keypess - detach)\n"); + fprintf(stderr, " -n (assign created netdevice name)\n"); + fprintf(stderr, "\nExamples:\n"); + fprintf(stderr, "slcan_attach -w -o -f -s6 -c /dev/ttyS1\n"); + fprintf(stderr, "slcan_attach /dev/ttyS1\n"); + fprintf(stderr, "slcan_attach -d /dev/ttyS1\n"); + fprintf(stderr, "slcan_attach -w -n can15 /dev/ttyS1\n"); + fprintf(stderr, "\n"); exit(1); } int main(int argc, char **argv) { int fd; - int ldisc; + int ldisc = LDISC_N_SLCAN; int detach = 0; + int waitkey = 0; + int send_open = 0; + int send_close = 0; + int send_read_status_flags = 0; + char *speed = NULL; + char *btr = NULL; + char buf[IFNAMSIZ+1]; char *tty; + char *name = NULL; int opt; - while ((opt = getopt(argc, argv, "d")) != -1) { + while ((opt = getopt(argc, argv, "l:dwocfs:b:n:?")) != -1) { switch (opt) { + case 'l': + fprintf(stderr, "Ignored option '-l'\n"); + break; + case 'd': detach = 1; break; + + case 'w': + waitkey = 1; + break; + + case 'o': + send_open = 1; + break; + + case 'c': + send_close = 1; + break; + + case 'f': + send_read_status_flags = 1; + break; + + case 's': + speed = optarg; + if (strlen(speed) > 1) + print_usage(argv[0]); + break; + + case 'b': + btr = optarg; + if (strlen(btr) > 6) + print_usage(argv[0]); + break; + + case 'n': + name = optarg; + if (strlen(name) > IFNAMSIZ-1) + print_usage(argv[0]); + break; + + case '?': default: - usage(argv[0]); + print_usage(argv[0]); break; } } if (argc - optind != 1) - usage(argv[0]); + print_usage(argv[0]); tty = argv[optind]; - if ((fd = open (tty, O_RDONLY | O_NOCTTY)) < 0) { + if ((fd = open (tty, O_WRONLY | O_NOCTTY)) < 0) { perror(tty); exit(1); } - ldisc = detach ? N_TTY : N_SLCAN; - if (ioctl (fd, TIOCSETD, &ldisc) < 0) { - perror("ioctl"); - exit(1); + if (waitkey || !detach) { + + if (speed) { + sprintf(buf, "C\rS%s\r", speed); + write(fd, buf, strlen(buf)); + } + + if (btr) { + sprintf(buf, "C\rs%s\r", btr); + write(fd, buf, strlen(buf)); + } + + if (send_read_status_flags) { + sprintf(buf, "F\r"); + write(fd, buf, strlen(buf)); + } + + if (send_open) { + sprintf(buf, "O\r"); + write(fd, buf, strlen(buf)); + } + + /* set slcan line discipline on given tty */ + if (ioctl (fd, TIOCSETD, &ldisc) < 0) { + perror("ioctl TIOCSETD"); + exit(1); + } + + /* retrieve the name of the created CAN netdevice */ + if (ioctl (fd, SIOCGIFNAME, buf) < 0) { + perror("ioctl SIOCGIFNAME"); + exit(1); + } + + printf("attached tty %s to netdevice %s\n", tty, buf); + + /* try to rename the created device if requested */ + if (name) { + struct ifreq ifr; + int s = socket(PF_INET, SOCK_DGRAM, 0); + + printf("rename netdevice %s to %s ... ", buf, name); + + if (s < 0) + perror("socket for interface rename"); + else { + strncpy (ifr.ifr_name, buf, IFNAMSIZ); + strncpy (ifr.ifr_newname, name, IFNAMSIZ); + + if (ioctl(s, SIOCSIFNAME, &ifr) < 0) + printf("failed!\n"); + else + printf("ok.\n"); + + close(s); + } + } + } + + if (waitkey) { + printf("Press any key to detach %s ...\n", tty); + getchar(); + } + + if (waitkey || detach) { + ldisc = N_TTY; + if (ioctl (fd, TIOCSETD, &ldisc) < 0) { + perror("ioctl"); + exit(1); + } + + if (send_close) { + sprintf(buf, "C\r"); + write(fd, buf, strlen(buf)); + } } close(fd);