kernel: Add mps(4) to our GENERIC kernels.
[dragonfly.git] / usr.bin / tset / map.c
1 /*-
2  * Copyright (c) 1991, 1993
3  *      The Regents of the University of California.  All rights reserved.
4  *
5  * Redistribution and use in source and binary forms, with or without
6  * modification, are permitted provided that the following conditions
7  * are met:
8  * 1. Redistributions of source code must retain the above copyright
9  *    notice, this list of conditions and the following disclaimer.
10  * 2. Redistributions in binary form must reproduce the above copyright
11  *    notice, this list of conditions and the following disclaimer in the
12  *    documentation and/or other materials provided with the distribution.
13  * 3. All advertising materials mentioning features or use of this software
14  *    must display the following acknowledgement:
15  *      This product includes software developed by the University of
16  *      California, Berkeley and its contributors.
17  * 4. Neither the name of the University nor the names of its contributors
18  *    may be used to endorse or promote products derived from this software
19  *    without specific prior written permission.
20  *
21  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
22  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
23  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
24  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
25  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
26  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
27  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
28  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
29  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
30  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
31  * SUCH DAMAGE.
32  *
33  * @(#)map.c    8.1 (Berkeley) 6/9/93
34  * $FreeBSD: src/usr.bin/tset/map.c,v 1.7 1999/08/30 08:27:30 peter Exp $
35  * $DragonFly: src/usr.bin/tset/map.c,v 1.5 2004/08/30 18:06:50 eirikn Exp $
36  */
37
38 #include <sys/types.h>
39 #include <err.h>
40 #include <stdlib.h>
41 #include <string.h>
42 #include <termios.h>
43 #include "extern.h"
44
45 extern speed_t Ospeed;
46 speed_t tset_baudrate(char *);
47
48 /* Baud rate conditionals for mapping. */
49 #define GT              0x01
50 #define EQ              0x02
51 #define LT              0x04
52 #define NOT             0x08
53 #define GE              (GT | EQ)
54 #define LE              (LT | EQ)
55
56 typedef struct map {
57         struct map *next;       /* Linked list of maps. */
58         char *porttype;         /* Port type, or "" for any. */
59         char *type;             /* Terminal type to select. */
60         int conditional;        /* Baud rate conditionals bitmask. */
61         speed_t speed;          /* Baud rate to compare against. */
62 } MAP;
63
64 MAP *cur, *maplist;
65
66 /*
67  * Syntax for -m:
68  * [port-type][test baudrate]:terminal-type
69  * The baud rate tests are: >, <, @, =, !
70  */
71 void
72 add_mapping(const char *port, char *arg)
73 {
74         MAP *mapp;
75         char *copy, *p, *termp;
76
77         copy = strdup(arg);
78         mapp = malloc((u_int)sizeof(MAP));
79         if (copy == NULL || mapp == NULL)
80                 errx(1, "malloc");
81         mapp->next = NULL;
82         if (maplist == NULL)
83                 cur = maplist = mapp;
84         else {
85                 cur->next = mapp;
86                 cur =  mapp;
87         }
88
89         mapp->porttype = arg;
90         mapp->conditional = 0;
91
92         arg = strpbrk(arg, "><@=!:");
93
94         if (arg == NULL) {                      /* [?]term */
95                 mapp->type = mapp->porttype;
96                 mapp->porttype = NULL;
97                 goto done;
98         }
99
100         if (arg == mapp->porttype)              /* [><@=! baud]:term */
101                 termp = mapp->porttype = NULL;
102         else
103                 termp = arg;
104
105         for (;; ++arg)                          /* Optional conditionals. */
106                 switch(*arg) {
107                 case '<':
108                         if (mapp->conditional & GT)
109                                 goto badmopt;
110                         mapp->conditional |= LT;
111                         break;
112                 case '>':
113                         if (mapp->conditional & LT)
114                                 goto badmopt;
115                         mapp->conditional |= GT;
116                         break;
117                 case '@':
118                 case '=':                       /* Not documented. */
119                         mapp->conditional |= EQ;
120                         break;
121                 case '!':
122                         mapp->conditional |= NOT;
123                         break;
124                 default:
125                         goto next;
126                 }
127
128 next:   if (*arg == ':') {
129                 if (mapp->conditional)
130                         goto badmopt;
131                 ++arg;
132         } else {                                /* Optional baudrate. */
133                 arg = strchr(p = arg, ':');
134                 if (arg == NULL)
135                         goto badmopt;
136                 *arg++ = '\0';
137                 mapp->speed = tset_baudrate(p);
138         }
139
140         if (*arg == '\0')                       /* Non-optional type. */
141                 goto badmopt;
142
143         mapp->type = arg;
144
145         /* Terminate porttype, if specified. */
146         if (termp != NULL)
147                 *termp = '\0';
148
149         /* If a NOT conditional, reverse the test. */
150         if (mapp->conditional & NOT)
151                 mapp->conditional = ~mapp->conditional & (EQ | GT | LT);
152
153         /* If user specified a port with an option flag, set it. */
154 done:   if (port) {
155                 if (mapp->porttype)
156 badmopt:                errx(1, "illegal -m option format: %s", copy);
157                 mapp->porttype = strdup(port);
158         }
159
160 #ifdef MAPDEBUG
161         (void)printf("port: %s\n", mapp->porttype ? mapp->porttype : "ANY");
162         (void)printf("type: %s\n", mapp->type);
163         (void)printf("conditional: ");
164         p = "";
165         if (mapp->conditional & GT) {
166                 (void)printf("GT");
167                 p = "/";
168         }
169         if (mapp->conditional & EQ) {
170                 (void)printf("%sEQ", p);
171                 p = "/";
172         }
173         if (mapp->conditional & LT)
174                 (void)printf("%sLT", p);
175         (void)printf("\nspeed: %d\n", mapp->speed);
176 #endif
177 }
178
179 /*
180  * Return the type of terminal to use for a port of type 'type', as specified
181  * by the first applicable mapping in 'map'.  If no mappings apply, return
182  * 'type'.
183  */
184 const char *
185 mapped(const char *type)
186 {
187         MAP *mapp;
188         int match;
189
190         match = 0;
191         for (mapp = maplist; mapp; mapp = mapp->next)
192                 if (mapp->porttype == NULL || !strcmp(mapp->porttype, type)) {
193                         switch (mapp->conditional) {
194                         case 0:                 /* No test specified. */
195                                 match = 1;
196                                 break;
197                         case EQ:
198                                 match = (Ospeed == mapp->speed);
199                                 break;
200                         case GE:
201                                 match = (Ospeed >= mapp->speed);
202                                 break;
203                         case GT:
204                                 match = (Ospeed > mapp->speed);
205                                 break;
206                         case LE:
207                                 match = (Ospeed <= mapp->speed);
208                                 break;
209                         case LT:
210                                 match = (Ospeed < mapp->speed);
211                                 break;
212                         }
213                         if (match)
214                                 return (mapp->type);
215                 }
216         /* No match found; return given type. */
217         return (type);
218 }
219
220 typedef struct speeds {
221         const char *string;
222         speed_t speed;
223 } SPEEDS;
224
225 SPEEDS speeds[] = {
226         { "0",          B0 },
227         { "134.5",      B134 },
228         { "exta",       B19200 },
229         { "extb",       B38400 },
230         { NULL,         0 }
231 };
232
233 speed_t
234 tset_baudrate(char *rate)
235 {
236         SPEEDS *sp;
237         speed_t speed;
238
239         /* The baudrate number can be preceded by a 'B', which is ignored. */
240         if (*rate == 'B')
241                 ++rate;
242
243         for (sp = speeds; sp->string; ++sp)
244                 if (!strcasecmp(rate, sp->string))
245                         return (sp->speed);
246         speed = atol(rate);
247         if (speed == 0)
248                 errx(1, "unknown baud rate %s", rate);
249         return speed;
250 }