]>
Commit | Line | Data |
---|---|---|
1e8d11c4 TS |
1 | /* line discipline loading daemon |
2 | * open a serial device and attach a line discipline on it | |
3 | * | |
4 | * Usage: | |
5 | * ldattach GIGASET_M101 /dev/ttyS0 | |
6 | * | |
7 | * ===================================================================== | |
8 | * This program is free software; you can redistribute it and/or | |
9 | * modify it under the terms of the GNU General Public License as | |
10 | * published by the Free Software Foundation; either version 2 of | |
11 | * the License, or (at your option) any later version. | |
12 | * ===================================================================== | |
13 | */ | |
14 | ||
28e91b83 SK |
15 | #include <errno.h> |
16 | #include <fcntl.h> | |
17 | #include <getopt.h> | |
1e8d11c4 | 18 | #include <stdio.h> |
28e91b83 | 19 | #include <stdlib.h> |
1e8d11c4 | 20 | #include <string.h> |
1e8d11c4 | 21 | #include <sys/ioctl.h> |
28e91b83 SK |
22 | #include <sys/stat.h> |
23 | #include <sys/types.h> | |
f8132752 | 24 | #include <termios.h> |
1e8d11c4 | 25 | #include <unistd.h> |
1e8d11c4 | 26 | |
becc79d5 | 27 | #include "c.h" |
8596f639 | 28 | #include "all-io.h" |
fcba4577 | 29 | #include "nls.h" |
7b2d3de4 | 30 | #include "strutils.h" |
efb8854f | 31 | #include "closestream.h" |
fcba4577 | 32 | |
8596f639 KZ |
33 | #include <signal.h> |
34 | #include <sys/socket.h> | |
35 | #include <linux/if.h> | |
36 | ||
37 | #include <linux/tty.h> /* for N_GSM0710 */ | |
38 | ||
39 | #ifdef LINUX_GSMMUX_H | |
40 | # include <linux/gsmmux.h> /* Add by guowenxue */ | |
41 | #else | |
42 | struct gsm_config | |
43 | { | |
44 | unsigned int adaption; | |
45 | unsigned int encapsulation; | |
46 | unsigned int initiator; | |
47 | unsigned int t1; | |
48 | unsigned int t2; | |
49 | unsigned int t3; | |
50 | unsigned int n2; | |
51 | unsigned int mru; | |
52 | unsigned int mtu; | |
53 | unsigned int k; | |
54 | unsigned int i; | |
55 | unsigned int unused[8]; /* Padding for expansion without | |
56 | breaking stuff */ | |
57 | }; | |
58 | # define GSMIOC_GETCONF _IOR('G', 0, struct gsm_config) | |
59 | # define GSMIOC_SETCONF _IOW('G', 1, struct gsm_config) | |
60 | #endif | |
61 | ||
1e8d11c4 | 62 | #ifndef N_GIGASET_M101 |
f8132752 | 63 | # define N_GIGASET_M101 16 |
1e8d11c4 TS |
64 | #endif |
65 | ||
d5f36dec TS |
66 | #ifndef N_PPS |
67 | # define N_PPS 18 | |
68 | #endif | |
69 | ||
58c17460 TS |
70 | #ifndef N_GSM0710 |
71 | # define N_GSM0710 21 | |
72 | #endif | |
73 | ||
8596f639 KZ |
74 | #define MAXINTROPARMLEN 32 |
75 | ||
f8132752 KZ |
76 | /* attach a line discipline ioctl */ |
77 | #ifndef TIOCSETD | |
78 | # define TIOCSETD 0x5423 | |
1e8d11c4 TS |
79 | #endif |
80 | ||
1e8d11c4 TS |
81 | static int debug = 0; |
82 | ||
7b549aff | 83 | struct ld_table { |
28e91b83 SK |
84 | const char *name; |
85 | int value; | |
7b549aff KZ |
86 | }; |
87 | ||
1e8d11c4 | 88 | /* currently supported line disciplines, plus some aliases */ |
28e91b83 SK |
89 | static const struct ld_table ld_discs[] = { |
90 | { "TTY", N_TTY }, | |
91 | { "SLIP", N_SLIP }, | |
92 | { "MOUSE", N_MOUSE }, | |
93 | { "PPP", N_PPP }, | |
94 | { "STRIP", N_STRIP }, | |
95 | { "AX25", N_AX25 }, | |
96 | { "X25", N_X25 }, | |
97 | { "6PACK", N_6PACK }, | |
98 | { "R3964", N_R3964 }, | |
99 | { "IRDA", N_IRDA }, | |
100 | { "HDLC", N_HDLC }, | |
101 | { "SYNC_PPP", N_SYNC_PPP }, | |
102 | { "SYNCPPP", N_SYNC_PPP }, | |
103 | { "HCI", N_HCI }, | |
58c17460 | 104 | { "GIGASET_M101", N_GIGASET_M101 }, |
a8023b9a SK |
105 | { "M101", N_GIGASET_M101 }, |
106 | { "GIGASET", N_GIGASET_M101 }, | |
58c17460 TS |
107 | { "PPS", N_PPS }, |
108 | { "GSM0710", N_GSM0710}, | |
8596f639 | 109 | { NULL, 0 } |
1e8d11c4 TS |
110 | }; |
111 | ||
b091b880 TS |
112 | /* known c_iflag names */ |
113 | static const struct ld_table ld_iflags[] = | |
114 | { | |
115 | { "IGNBRK", IGNBRK }, | |
116 | { "BRKINT", BRKINT }, | |
117 | { "IGNPAR", IGNPAR }, | |
118 | { "PARMRK", PARMRK }, | |
119 | { "INPCK", INPCK }, | |
120 | { "ISTRIP", ISTRIP }, | |
121 | { "INLCR", INLCR }, | |
122 | { "IGNCR", IGNCR }, | |
123 | { "ICRNL", ICRNL }, | |
124 | { "IUCLC", IUCLC }, | |
125 | { "IXON", IXON }, | |
126 | { "IXANY", IXANY }, | |
127 | { "IXOFF", IXOFF }, | |
128 | { "IMAXBEL", IMAXBEL }, | |
129 | { "IUTF8", IUTF8 }, | |
28e91b83 | 130 | { NULL, 0 } |
b091b880 TS |
131 | }; |
132 | ||
d91757a0 | 133 | static void dbg(char *fmt, ...) |
3a134012 SK |
134 | { |
135 | va_list args; | |
136 | ||
137 | if (debug == 0) | |
138 | return; | |
139 | fflush(NULL); | |
3a134012 | 140 | va_start(args, fmt); |
31f85fce SK |
141 | #ifdef HAVE_VWARNX |
142 | vwarnx(fmt, args); | |
143 | #else | |
144 | fprintf(stderr, "%s: ", program_invocation_short_name); | |
3a134012 | 145 | vfprintf(stderr, fmt, args); |
3a134012 | 146 | fprintf(stderr, "\n"); |
31f85fce SK |
147 | #endif |
148 | va_end(args); | |
3a134012 SK |
149 | fflush(NULL); |
150 | return; | |
151 | } | |
152 | ||
7b549aff | 153 | static int lookup_table(const struct ld_table *tab, const char *str) |
1e8d11c4 | 154 | { |
28e91b83 | 155 | const struct ld_table *t; |
1e8d11c4 | 156 | |
28e91b83 SK |
157 | for (t = tab; t && t->name; t++) |
158 | if (!strcasecmp(t->name, str)) | |
159 | return t->value; | |
160 | return -1; | |
1e8d11c4 TS |
161 | } |
162 | ||
28e91b83 | 163 | static void print_table(FILE * out, const struct ld_table *tab) |
1e8d11c4 | 164 | { |
28e91b83 SK |
165 | const struct ld_table *t; |
166 | int i; | |
167 | ||
168 | for (t = tab, i = 1; t && t->name; t++, i++) { | |
b5225af3 TS |
169 | fprintf(out, " %-12s", t->name); |
170 | if (!(i % 5)) | |
28e91b83 SK |
171 | fputc('\n', out); |
172 | } | |
7b549aff KZ |
173 | } |
174 | ||
b091b880 TS |
175 | static int parse_iflag(char *str, int *set_iflag, int *clr_iflag) |
176 | { | |
28e91b83 | 177 | int iflag; |
7b2d3de4 | 178 | char *s; |
28e91b83 SK |
179 | |
180 | for (s = strtok(str, ","); s != NULL; s = strtok(NULL, ",")) { | |
181 | if (*s == '-') | |
182 | s++; | |
7b2d3de4 | 183 | if ((iflag = lookup_table(ld_iflags, s)) < 0) |
20a39982 | 184 | iflag = strtos32_or_err(s, _("invalid iflag")); |
28e91b83 SK |
185 | if (s > str && *(s - 1) == '-') |
186 | *clr_iflag |= iflag; | |
187 | else | |
188 | *set_iflag |= iflag; | |
b091b880 | 189 | } |
28e91b83 SK |
190 | dbg("iflag (set/clear): %d/%d", *set_iflag, *clr_iflag); |
191 | return 0; | |
b091b880 TS |
192 | } |
193 | ||
194 | ||
5118d1be | 195 | static void __attribute__((__noreturn__)) usage(void) |
7b549aff | 196 | { |
5118d1be | 197 | FILE *out = stdout; |
b5b28b43 | 198 | |
a8023b9a SK |
199 | fputs(USAGE_HEADER, out); |
200 | fprintf(out, _(" %s [options] <ldisc> <device>\n"), program_invocation_short_name); | |
a8023b9a | 201 | |
451dbcfa BS |
202 | fputs(USAGE_SEPARATOR, out); |
203 | fputs(_("Attach a line discipline to a serial line.\n"), out); | |
204 | ||
205 | fputs(USAGE_OPTIONS, out); | |
a8023b9a SK |
206 | fputs(_(" -d, --debug print verbose messages to stderr\n"), out); |
207 | fputs(_(" -s, --speed <value> set serial line speed\n"), out); | |
8596f639 KZ |
208 | fputs(_(" -c, --intro-command <string> intro sent before ldattach\n"), out); |
209 | fputs(_(" -p, --pause <seconds> pause between intro and ldattach\n"), out); | |
a8023b9a SK |
210 | fputs(_(" -7, --sevenbits set character size to 7 bits\n"), out); |
211 | fputs(_(" -8, --eightbits set character size to 8 bits\n"), out); | |
212 | fputs(_(" -n, --noparity set parity to none\n"), out); | |
213 | fputs(_(" -e, --evenparity set parity to even\n"), out); | |
214 | fputs(_(" -o, --oddparity set parity to odd\n"), out); | |
215 | fputs(_(" -1, --onestopbit set stop bits to one\n"), out); | |
216 | fputs(_(" -2, --twostopbits set stop bits to two\n"), out); | |
217 | fputs(_(" -i, --iflag [-]<iflag> set input mode flag\n"), out); | |
5ff20423 | 218 | |
a8023b9a | 219 | fputs(USAGE_SEPARATOR, out); |
f45f3ec3 | 220 | printf(USAGE_HELP_OPTIONS(25)); |
158e4182 | 221 | |
28e91b83 SK |
222 | fputs(_("\nKnown <ldisc> names:\n"), out); |
223 | print_table(out, ld_discs); | |
158e4182 KZ |
224 | fputs(USAGE_SEPARATOR, out); |
225 | ||
28e91b83 SK |
226 | fputs(_("\nKnown <iflag> names:\n"), out); |
227 | print_table(out, ld_iflags); | |
158e4182 | 228 | |
f45f3ec3 | 229 | printf(USAGE_MAN_TAIL("ldattach(8)")); |
5118d1be | 230 | exit(EXIT_SUCCESS); |
1e8d11c4 TS |
231 | } |
232 | ||
f8132752 KZ |
233 | static int my_cfsetspeed(struct termios *ts, int speed) |
234 | { | |
235 | /* Standard speeds | |
236 | * -- cfsetspeed() is able to translate number to Bxxx constants | |
237 | */ | |
238 | if (cfsetspeed(ts, speed) == 0) | |
239 | return 0; | |
240 | ||
241 | /* Nonstandard speeds | |
28e91b83 SK |
242 | * -- we have to bypass glibc and set the speed manually (because glibc |
243 | * checks for speed and supports Bxxx bit rates only)... | |
f8132752 | 244 | */ |
963413a1 | 245 | #if _HAVE_STRUCT_TERMIOS_C_ISPEED |
28e91b83 | 246 | # define BOTHER 0010000 /* non standard rate */ |
f8132752 KZ |
247 | dbg("using non-standard speeds"); |
248 | ts->c_ospeed = ts->c_ispeed = speed; | |
249 | ts->c_cflag &= ~CBAUD; | |
250 | ts->c_cflag |= BOTHER; | |
251 | return 0; | |
252 | #else | |
253 | return -1; | |
254 | #endif | |
255 | } | |
256 | ||
8596f639 KZ |
257 | static void handler(int s) |
258 | { | |
31f85fce | 259 | dbg("got SIG %i -> exiting", s); |
8596f639 KZ |
260 | exit(EXIT_SUCCESS); |
261 | } | |
262 | ||
263 | static void gsm0710_set_conf(int tty_fd) | |
264 | { | |
265 | struct gsm_config c; | |
266 | ||
267 | /* Add by guowenxue */ | |
268 | /* get n_gsm configuration */ | |
269 | ioctl(tty_fd, GSMIOC_GETCONF, &c); | |
270 | /* we are initiator and need encoding 0 (basic) */ | |
271 | c.initiator = 1; | |
272 | c.encapsulation = 0; | |
273 | /* our modem defaults to a maximum size of 127 bytes */ | |
274 | c.mru = 127; | |
275 | c.mtu = 127; | |
276 | /* set the new configuration */ | |
277 | ioctl(tty_fd, GSMIOC_SETCONF, &c); | |
278 | /* Add by guowenxue end*/ | |
279 | } | |
280 | ||
1e8d11c4 TS |
281 | int main(int argc, char **argv) |
282 | { | |
28e91b83 SK |
283 | int tty_fd; |
284 | struct termios ts; | |
285 | int speed = 0, bits = '-', parity = '-', stop = '-'; | |
286 | int set_iflag = 0, clr_iflag = 0; | |
287 | int ldisc; | |
288 | int optc; | |
28e91b83 | 289 | char *dev; |
8596f639 KZ |
290 | int intropause = 1; |
291 | char *introparm = NULL; | |
292 | ||
28e91b83 SK |
293 | static const struct option opttbl[] = { |
294 | {"speed", required_argument, NULL, 's'}, | |
295 | {"sevenbits", no_argument, NULL, '7'}, | |
296 | {"eightbits", no_argument, NULL, '8'}, | |
297 | {"noparity", no_argument, NULL, 'n'}, | |
298 | {"evenparity", no_argument, NULL, 'e'}, | |
299 | {"oddparity", no_argument, NULL, 'o'}, | |
300 | {"onestopbit", no_argument, NULL, '1'}, | |
301 | {"twostopbits", no_argument, NULL, '2'}, | |
302 | {"iflag", required_argument, NULL, 'i'}, | |
303 | {"help", no_argument, NULL, 'h'}, | |
304 | {"version", no_argument, NULL, 'V'}, | |
305 | {"debug", no_argument, NULL, 'd'}, | |
8596f639 KZ |
306 | {"intro-command", no_argument, NULL, 'c'}, |
307 | {"pause", no_argument, NULL, 'p'}, | |
28e91b83 SK |
308 | {NULL, 0, NULL, 0} |
309 | }; | |
310 | ||
8596f639 KZ |
311 | signal(SIGKILL, handler); |
312 | signal(SIGINT, handler); | |
313 | ||
28e91b83 SK |
314 | setlocale(LC_ALL, ""); |
315 | bindtextdomain(PACKAGE, LOCALEDIR); | |
316 | textdomain(PACKAGE); | |
25b7045e | 317 | close_stdout_atexit(); |
28e91b83 SK |
318 | |
319 | /* parse options */ | |
28e91b83 | 320 | if (argc == 0) |
5118d1be RM |
321 | errx(EXIT_FAILURE, _("bad usage")); |
322 | ||
28e91b83 | 323 | while ((optc = |
8596f639 | 324 | getopt_long(argc, argv, "dhV78neo12s:i:c:p:", opttbl, |
28e91b83 SK |
325 | NULL)) >= 0) { |
326 | switch (optc) { | |
327 | case 'd': | |
3a134012 | 328 | debug = 1; |
28e91b83 SK |
329 | break; |
330 | case '1': | |
331 | case '2': | |
332 | stop = optc; | |
333 | break; | |
334 | case '7': | |
335 | case '8': | |
336 | bits = optc; | |
337 | break; | |
338 | case 'n': | |
339 | case 'e': | |
340 | case 'o': | |
341 | parity = optc; | |
342 | break; | |
343 | case 's': | |
20a39982 | 344 | speed = strtos32_or_err(optarg, _("invalid speed argument")); |
28e91b83 | 345 | break; |
8596f639 KZ |
346 | case 'p': |
347 | intropause = strtou32_or_err(optarg, _("invalid pause argument")); | |
348 | if (intropause > 10) | |
349 | errx(EXIT_FAILURE, "invalid pause: %s", optarg); | |
350 | break; | |
351 | case 'c': | |
352 | introparm = optarg; | |
353 | break; | |
28e91b83 SK |
354 | case 'i': |
355 | parse_iflag(optarg, &set_iflag, &clr_iflag); | |
356 | break; | |
2c308875 | 357 | |
28e91b83 | 358 | case 'V': |
2c308875 | 359 | print_version(EXIT_SUCCESS); |
28e91b83 | 360 | case 'h': |
5118d1be | 361 | usage(); |
28e91b83 | 362 | default: |
677ec86c | 363 | errtryhelp(EXIT_FAILURE); |
28e91b83 SK |
364 | } |
365 | } | |
366 | ||
5118d1be RM |
367 | if (argc - optind != 2) { |
368 | warnx(_("not enough arguments")); | |
369 | errtryhelp(EXIT_FAILURE); | |
370 | } | |
28e91b83 SK |
371 | /* parse line discipline specification */ |
372 | ldisc = lookup_table(ld_discs, argv[optind]); | |
7b2d3de4 | 373 | if (ldisc < 0) |
20a39982 | 374 | ldisc = strtos32_or_err(argv[optind], _("invalid line discipline argument")); |
28e91b83 | 375 | |
5687494a TS |
376 | /* ldisc specific option settings */ |
377 | if (ldisc == N_GIGASET_M101) { | |
378 | /* device specific defaults for line speed and data format */ | |
158e4182 KZ |
379 | if (speed == 0) |
380 | speed = 115200; | |
381 | if (bits == '-') | |
382 | bits = '8'; | |
383 | if (parity == '-') | |
384 | parity = 'n'; | |
385 | if (stop == '-') | |
386 | stop = '1'; | |
5687494a TS |
387 | } |
388 | ||
28e91b83 SK |
389 | /* open device */ |
390 | dev = argv[optind + 1]; | |
391 | if ((tty_fd = open(dev, O_RDWR | O_NOCTTY)) < 0) | |
392 | err(EXIT_FAILURE, _("cannot open %s"), dev); | |
393 | if (!isatty(tty_fd)) | |
394 | errx(EXIT_FAILURE, _("%s is not a serial line"), dev); | |
395 | ||
396 | dbg("opened %s", dev); | |
397 | ||
398 | /* set line speed and format */ | |
399 | if (tcgetattr(tty_fd, &ts) < 0) | |
400 | err(EXIT_FAILURE, | |
401 | _("cannot get terminal attributes for %s"), dev); | |
402 | cfmakeraw(&ts); | |
403 | if (speed && my_cfsetspeed(&ts, speed) < 0) | |
404 | errx(EXIT_FAILURE, _("speed %d unsupported"), speed); | |
405 | ||
406 | switch (stop) { | |
1e8d11c4 | 407 | case '1': |
28e91b83 SK |
408 | ts.c_cflag &= ~CSTOPB; |
409 | break; | |
1e8d11c4 | 410 | case '2': |
28e91b83 SK |
411 | ts.c_cflag |= CSTOPB; |
412 | break; | |
ba64bbd2 SK |
413 | case '-': |
414 | break; | |
415 | default: | |
416 | abort(); | |
28e91b83 SK |
417 | } |
418 | switch (bits) { | |
1e8d11c4 | 419 | case '7': |
28e91b83 SK |
420 | ts.c_cflag = (ts.c_cflag & ~CSIZE) | CS7; |
421 | break; | |
1e8d11c4 | 422 | case '8': |
28e91b83 SK |
423 | ts.c_cflag = (ts.c_cflag & ~CSIZE) | CS8; |
424 | break; | |
ba64bbd2 SK |
425 | case '-': |
426 | break; | |
427 | default: | |
428 | abort(); | |
28e91b83 SK |
429 | } |
430 | switch (parity) { | |
1e8d11c4 | 431 | case 'n': |
28e91b83 SK |
432 | ts.c_cflag &= ~(PARENB | PARODD); |
433 | break; | |
1e8d11c4 | 434 | case 'e': |
28e91b83 SK |
435 | ts.c_cflag |= PARENB; |
436 | ts.c_cflag &= ~PARODD; | |
437 | break; | |
1e8d11c4 | 438 | case 'o': |
28e91b83 SK |
439 | ts.c_cflag |= (PARENB | PARODD); |
440 | break; | |
ba64bbd2 SK |
441 | case '-': |
442 | break; | |
443 | default: | |
444 | abort(); | |
1e8d11c4 | 445 | } |
28e91b83 SK |
446 | |
447 | ts.c_cflag |= CREAD; /* just to be on the safe side */ | |
448 | ts.c_iflag |= set_iflag; | |
449 | ts.c_iflag &= ~clr_iflag; | |
450 | ||
451 | if (tcsetattr(tty_fd, TCSAFLUSH, &ts) < 0) | |
452 | err(EXIT_FAILURE, | |
453 | _("cannot set terminal attributes for %s"), dev); | |
454 | ||
455 | dbg("set to raw %d %c%c%c: cflag=0x%x", | |
456 | speed, bits, parity, stop, ts.c_cflag); | |
457 | ||
8596f639 KZ |
458 | if (introparm && *introparm) |
459 | { | |
460 | dbg("intro command is '%s'", introparm); | |
461 | if (write_all(tty_fd, introparm, strlen(introparm)) != 0) | |
462 | err(EXIT_FAILURE, | |
463 | _("cannot write intro command to %s"), dev); | |
464 | ||
465 | if (intropause) { | |
466 | dbg("waiting for %d seconds", intropause); | |
467 | sleep(intropause); | |
468 | } | |
469 | } | |
470 | ||
5687494a | 471 | /* Attach the line discipline. */ |
28e91b83 SK |
472 | if (ioctl(tty_fd, TIOCSETD, &ldisc) < 0) |
473 | err(EXIT_FAILURE, _("cannot set line discipline")); | |
474 | ||
475 | dbg("line discipline set to %d", ldisc); | |
476 | ||
5687494a | 477 | /* ldisc specific post-attach actions */ |
8596f639 KZ |
478 | if (ldisc == N_GSM0710) |
479 | gsm0710_set_conf(tty_fd); | |
480 | ||
28e91b83 SK |
481 | /* Go into background if not in debug mode. */ |
482 | if (!debug && daemon(0, 0) < 0) | |
483 | err(EXIT_FAILURE, _("cannot daemonize")); | |
484 | ||
485 | /* Sleep to keep the line discipline active. */ | |
486 | pause(); | |
487 | ||
488 | exit(EXIT_SUCCESS); | |
1e8d11c4 | 489 | } |