1 /*-
2 * SPDX-License-Identifier: BSD-2-Clause
3 *
4 * Copyright (c) 2011-2012 Stefan Bethke.
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
29 #include <sys/cdefs.h>
30 #include <ctype.h>
31 #include <err.h>
32 #include <errno.h>
33 #include <fcntl.h>
34 #include <stdio.h>
35 #include <stdlib.h>
36 #include <string.h>
37 #include <sysexits.h>
38 #include <unistd.h>
39 #include <sys/types.h>
40 #include <sys/ioctl.h>
41 #include <net/if.h>
42 #include <net/if_media.h>
43 #include <dev/etherswitch/etherswitch.h>
44
45 int get_media_subtype(int, const char *);
46 int get_media_mode(int, const char *);
47 int get_media_options(int, const char *);
48 int lookup_media_word(struct ifmedia_description *, const char *);
49 void print_media_word(int, int);
50 void print_media_word_ifconfig(int);
51
52 /* some constants */
53 #define IEEE802DOT1Q_VID_MAX 4094
54 #define IFMEDIAREQ_NULISTENTRIES 256
55
56 enum cmdmode {
57 MODE_NONE = 0,
58 MODE_PORT,
59 MODE_CONFIG,
60 MODE_VLANGROUP,
61 MODE_REGISTER,
62 MODE_PHYREG,
63 MODE_ATU
64 };
65
66 struct cfg {
67 int fd;
68 int verbose;
69 int mediatypes;
70 const char *controlfile;
71 etherswitch_conf_t conf;
72 etherswitch_info_t info;
73 enum cmdmode mode;
74 int unit;
75 };
76
77 struct cmds {
78 enum cmdmode mode;
79 const char *name;
80 int args;
81 int (*f)(struct cfg *, int argc, char *argv[]);
82 };
83 static struct cmds cmds[];
84
85 /* Must match the ETHERSWITCH_PORT_LED_* enum order */
86 static const char *ledstyles[] = { "default", "on", "off", "blink", NULL };
87
88 /*
89 * Print a value a la the %b format of the kernel's printf.
90 * Stolen from ifconfig.c.
91 */
92 static void
printb(const char * s,unsigned v,const char * bits)93 printb(const char *s, unsigned v, const char *bits)
94 {
95 int i, any = 0;
96 char c;
97
98 if (bits && *bits == 8)
99 printf("%s=%o", s, v);
100 else
101 printf("%s=%x", s, v);
102 bits++;
103 if (bits) {
104 putchar('<');
105 while ((i = *bits++) != '\0') {
106 if (v & (1 << (i-1))) {
107 if (any)
108 putchar(',');
109 any = 1;
110 for (; (c = *bits) > 32; bits++)
111 putchar(c);
112 } else
113 for (; *bits > 32; bits++)
114 ;
115 }
116 putchar('>');
117 }
118 }
119
120 static int
read_register(struct cfg * cfg,int r)121 read_register(struct cfg *cfg, int r)
122 {
123 struct etherswitch_reg er;
124
125 er.reg = r;
126 if (ioctl(cfg->fd, IOETHERSWITCHGETREG, &er) != 0)
127 err(EX_OSERR, "ioctl(IOETHERSWITCHGETREG)");
128 return (er.val);
129 }
130
131 static void
write_register(struct cfg * cfg,int r,int v)132 write_register(struct cfg *cfg, int r, int v)
133 {
134 struct etherswitch_reg er;
135
136 er.reg = r;
137 er.val = v;
138 if (ioctl(cfg->fd, IOETHERSWITCHSETREG, &er) != 0)
139 err(EX_OSERR, "ioctl(IOETHERSWITCHSETREG)");
140 }
141
142 static int
read_phyregister(struct cfg * cfg,int phy,int reg)143 read_phyregister(struct cfg *cfg, int phy, int reg)
144 {
145 struct etherswitch_phyreg er;
146
147 er.phy = phy;
148 er.reg = reg;
149 if (ioctl(cfg->fd, IOETHERSWITCHGETPHYREG, &er) != 0)
150 err(EX_OSERR, "ioctl(IOETHERSWITCHGETPHYREG)");
151 return (er.val);
152 }
153
154 static void
write_phyregister(struct cfg * cfg,int phy,int reg,int val)155 write_phyregister(struct cfg *cfg, int phy, int reg, int val)
156 {
157 struct etherswitch_phyreg er;
158
159 er.phy = phy;
160 er.reg = reg;
161 er.val = val;
162 if (ioctl(cfg->fd, IOETHERSWITCHSETPHYREG, &er) != 0)
163 err(EX_OSERR, "ioctl(IOETHERSWITCHSETPHYREG)");
164 }
165
166 static int
set_port_vid(struct cfg * cfg,int argc,char * argv[])167 set_port_vid(struct cfg *cfg, int argc, char *argv[])
168 {
169 int v;
170 etherswitch_port_t p;
171
172 if (argc < 2)
173 return (-1);
174
175 v = strtol(argv[1], NULL, 0);
176 if (v < 0 || v > IEEE802DOT1Q_VID_MAX)
177 errx(EX_USAGE, "pvid must be between 0 and %d",
178 IEEE802DOT1Q_VID_MAX);
179 bzero(&p, sizeof(p));
180 p.es_port = cfg->unit;
181 if (ioctl(cfg->fd, IOETHERSWITCHGETPORT, &p) != 0)
182 err(EX_OSERR, "ioctl(IOETHERSWITCHGETPORT)");
183 p.es_pvid = v;
184 if (ioctl(cfg->fd, IOETHERSWITCHSETPORT, &p) != 0)
185 err(EX_OSERR, "ioctl(IOETHERSWITCHSETPORT)");
186 return (0);
187 }
188
189 static int
set_port_flag(struct cfg * cfg,int argc,char * argv[])190 set_port_flag(struct cfg *cfg, int argc, char *argv[])
191 {
192 char *flag;
193 int n;
194 uint32_t f;
195 etherswitch_port_t p;
196
197 if (argc < 1)
198 return (-1);
199
200 n = 0;
201 f = 0;
202 flag = argv[0];
203 if (strcmp(flag, "none") != 0) {
204 if (*flag == '-') {
205 n++;
206 flag++;
207 }
208 if (strcasecmp(flag, "striptag") == 0)
209 f = ETHERSWITCH_PORT_STRIPTAG;
210 else if (strcasecmp(flag, "addtag") == 0)
211 f = ETHERSWITCH_PORT_ADDTAG;
212 else if (strcasecmp(flag, "firstlock") == 0)
213 f = ETHERSWITCH_PORT_FIRSTLOCK;
214 else if (strcasecmp(flag, "droptagged") == 0)
215 f = ETHERSWITCH_PORT_DROPTAGGED;
216 else if (strcasecmp(flag, "dropuntagged") == 0)
217 f = ETHERSWITCH_PORT_DROPUNTAGGED;
218 else if (strcasecmp(flag, "doubletag") == 0)
219 f = ETHERSWITCH_PORT_DOUBLE_TAG;
220 else if (strcasecmp(flag, "ingress") == 0)
221 f = ETHERSWITCH_PORT_INGRESS;
222 }
223 bzero(&p, sizeof(p));
224 p.es_port = cfg->unit;
225 if (ioctl(cfg->fd, IOETHERSWITCHGETPORT, &p) != 0)
226 err(EX_OSERR, "ioctl(IOETHERSWITCHGETPORT)");
227 if (n)
228 p.es_flags &= ~f;
229 else
230 p.es_flags |= f;
231 if (ioctl(cfg->fd, IOETHERSWITCHSETPORT, &p) != 0)
232 err(EX_OSERR, "ioctl(IOETHERSWITCHSETPORT)");
233 return (0);
234 }
235
236 static int
set_port_media(struct cfg * cfg,int argc,char * argv[])237 set_port_media(struct cfg *cfg, int argc, char *argv[])
238 {
239 etherswitch_port_t p;
240 int ifm_ulist[IFMEDIAREQ_NULISTENTRIES];
241 int subtype;
242
243 if (argc < 2)
244 return (-1);
245
246 bzero(&p, sizeof(p));
247 p.es_port = cfg->unit;
248 p.es_ifmr.ifm_ulist = ifm_ulist;
249 p.es_ifmr.ifm_count = IFMEDIAREQ_NULISTENTRIES;
250 if (ioctl(cfg->fd, IOETHERSWITCHGETPORT, &p) != 0)
251 err(EX_OSERR, "ioctl(IOETHERSWITCHGETPORT)");
252 if (p.es_ifmr.ifm_count == 0)
253 return (0);
254 subtype = get_media_subtype(IFM_TYPE(ifm_ulist[0]), argv[1]);
255 p.es_ifr.ifr_media = (p.es_ifmr.ifm_current & IFM_IMASK) |
256 IFM_TYPE(ifm_ulist[0]) | subtype;
257 if (ioctl(cfg->fd, IOETHERSWITCHSETPORT, &p) != 0)
258 err(EX_OSERR, "ioctl(IOETHERSWITCHSETPORT)");
259 return (0);
260 }
261
262 static int
set_port_mediaopt(struct cfg * cfg,int argc,char * argv[])263 set_port_mediaopt(struct cfg *cfg, int argc, char *argv[])
264 {
265 etherswitch_port_t p;
266 int ifm_ulist[IFMEDIAREQ_NULISTENTRIES];
267 int options;
268
269 if (argc < 2)
270 return (-1);
271
272 bzero(&p, sizeof(p));
273 p.es_port = cfg->unit;
274 p.es_ifmr.ifm_ulist = ifm_ulist;
275 p.es_ifmr.ifm_count = IFMEDIAREQ_NULISTENTRIES;
276 if (ioctl(cfg->fd, IOETHERSWITCHGETPORT, &p) != 0)
277 err(EX_OSERR, "ioctl(IOETHERSWITCHGETPORT)");
278 options = get_media_options(IFM_TYPE(ifm_ulist[0]), argv[1]);
279 if (options == -1)
280 errx(EX_USAGE, "invalid media options \"%s\"", argv[1]);
281 if (options & IFM_HDX) {
282 p.es_ifr.ifr_media &= ~IFM_FDX;
283 options &= ~IFM_HDX;
284 }
285 p.es_ifr.ifr_media |= options;
286 if (ioctl(cfg->fd, IOETHERSWITCHSETPORT, &p) != 0)
287 err(EX_OSERR, "ioctl(IOETHERSWITCHSETPORT)");
288 return (0);
289 }
290
291 static int
set_port_led(struct cfg * cfg,int argc,char * argv[])292 set_port_led(struct cfg *cfg, int argc, char *argv[])
293 {
294 etherswitch_port_t p;
295 int led;
296 int i;
297
298 if (argc < 3)
299 return (-1);
300
301 bzero(&p, sizeof(p));
302 p.es_port = cfg->unit;
303 if (ioctl(cfg->fd, IOETHERSWITCHGETPORT, &p) != 0)
304 err(EX_OSERR, "ioctl(IOETHERSWITCHGETPORT)");
305
306 led = strtol(argv[1], NULL, 0);
307 if (led < 1 || led > p.es_nleds)
308 errx(EX_USAGE, "invalid led number %s; must be between 1 and %d",
309 argv[1], p.es_nleds);
310
311 led--;
312
313 for (i=0; ledstyles[i] != NULL; i++) {
314 if (strcmp(argv[2], ledstyles[i]) == 0) {
315 p.es_led[led] = i;
316 break;
317 }
318 }
319 if (ledstyles[i] == NULL)
320 errx(EX_USAGE, "invalid led style \"%s\"", argv[2]);
321
322 if (ioctl(cfg->fd, IOETHERSWITCHSETPORT, &p) != 0)
323 err(EX_OSERR, "ioctl(IOETHERSWITCHSETPORT)");
324
325 return (0);
326 }
327
328 static int
set_vlangroup_vid(struct cfg * cfg,int argc,char * argv[])329 set_vlangroup_vid(struct cfg *cfg, int argc, char *argv[])
330 {
331 int v;
332 etherswitch_vlangroup_t vg;
333
334 if (argc < 2)
335 return (-1);
336
337 memset(&vg, 0, sizeof(vg));
338 v = strtol(argv[1], NULL, 0);
339 if (v < 0 || v > IEEE802DOT1Q_VID_MAX)
340 errx(EX_USAGE, "vlan must be between 0 and %d", IEEE802DOT1Q_VID_MAX);
341 vg.es_vlangroup = cfg->unit;
342 if (ioctl(cfg->fd, IOETHERSWITCHGETVLANGROUP, &vg) != 0)
343 err(EX_OSERR, "ioctl(IOETHERSWITCHGETVLANGROUP)");
344 vg.es_vid = v;
345 if (ioctl(cfg->fd, IOETHERSWITCHSETVLANGROUP, &vg) != 0)
346 err(EX_OSERR, "ioctl(IOETHERSWITCHSETVLANGROUP)");
347 return (0);
348 }
349
350 static int
set_vlangroup_members(struct cfg * cfg,int argc,char * argv[])351 set_vlangroup_members(struct cfg *cfg, int argc, char *argv[])
352 {
353 etherswitch_vlangroup_t vg;
354 int member, untagged;
355 char *c, *d;
356 int v;
357
358 if (argc < 2)
359 return (-1);
360
361 member = untagged = 0;
362 memset(&vg, 0, sizeof(vg));
363 if (strcmp(argv[1], "none") != 0) {
364 for (c=argv[1]; *c; c=d) {
365 v = strtol(c, &d, 0);
366 if (d == c)
367 break;
368 if (v < 0 || v >= cfg->info.es_nports)
369 errx(EX_USAGE, "Member port must be between 0 and %d", cfg->info.es_nports-1);
370 if (d[0] == ',' || d[0] == '\0' ||
371 ((d[0] == 't' || d[0] == 'T') && (d[1] == ',' || d[1] == '\0'))) {
372 if (d[0] == 't' || d[0] == 'T') {
373 untagged &= ~ETHERSWITCH_PORTMASK(v);
374 d++;
375 } else
376 untagged |= ETHERSWITCH_PORTMASK(v);
377 member |= ETHERSWITCH_PORTMASK(v);
378 d++;
379 } else
380 errx(EX_USAGE, "Invalid members specification \"%s\"", d);
381 }
382 }
383 vg.es_vlangroup = cfg->unit;
384 if (ioctl(cfg->fd, IOETHERSWITCHGETVLANGROUP, &vg) != 0)
385 err(EX_OSERR, "ioctl(IOETHERSWITCHGETVLANGROUP)");
386 vg.es_member_ports = member;
387 vg.es_untagged_ports = untagged;
388 if (ioctl(cfg->fd, IOETHERSWITCHSETVLANGROUP, &vg) != 0)
389 err(EX_OSERR, "ioctl(IOETHERSWITCHSETVLANGROUP)");
390 return (0);
391 }
392
393 static int
set_register(struct cfg * cfg,char * arg)394 set_register(struct cfg *cfg, char *arg)
395 {
396 int a, v;
397 char *c;
398
399 a = strtol(arg, &c, 0);
400 if (c==arg)
401 return (1);
402 if (*c == '=') {
403 v = strtoul(c+1, NULL, 0);
404 write_register(cfg, a, v);
405 }
406 printf("\treg 0x%04x=0x%08x\n", a, read_register(cfg, a));
407 return (0);
408 }
409
410 static int
set_phyregister(struct cfg * cfg,char * arg)411 set_phyregister(struct cfg *cfg, char *arg)
412 {
413 int phy, reg, val;
414 char *c, *d;
415
416 phy = strtol(arg, &c, 0);
417 if (c==arg)
418 return (1);
419 if (*c != '.')
420 return (1);
421 d = c+1;
422 reg = strtol(d, &c, 0);
423 if (d == c)
424 return (1);
425 if (*c == '=') {
426 val = strtoul(c+1, NULL, 0);
427 write_phyregister(cfg, phy, reg, val);
428 }
429 printf("\treg %d.0x%02x=0x%04x\n", phy, reg, read_phyregister(cfg, phy, reg));
430 return (0);
431 }
432
433 static int
set_vlan_mode(struct cfg * cfg,int argc,char * argv[])434 set_vlan_mode(struct cfg *cfg, int argc, char *argv[])
435 {
436 etherswitch_conf_t conf;
437
438 if (argc < 2)
439 return (-1);
440
441 bzero(&conf, sizeof(conf));
442 conf.cmd = ETHERSWITCH_CONF_VLAN_MODE;
443 if (strcasecmp(argv[1], "isl") == 0)
444 conf.vlan_mode = ETHERSWITCH_VLAN_ISL;
445 else if (strcasecmp(argv[1], "port") == 0)
446 conf.vlan_mode = ETHERSWITCH_VLAN_PORT;
447 else if (strcasecmp(argv[1], "dot1q") == 0)
448 conf.vlan_mode = ETHERSWITCH_VLAN_DOT1Q;
449 else if (strcasecmp(argv[1], "dot1q4k") == 0)
450 conf.vlan_mode = ETHERSWITCH_VLAN_DOT1Q_4K;
451 else if (strcasecmp(argv[1], "qinq") == 0)
452 conf.vlan_mode = ETHERSWITCH_VLAN_DOUBLE_TAG;
453 else
454 conf.vlan_mode = 0;
455 if (ioctl(cfg->fd, IOETHERSWITCHSETCONF, &conf) != 0)
456 err(EX_OSERR, "ioctl(IOETHERSWITCHSETCONF)");
457
458 return (0);
459 }
460
461 static int
atu_flush(struct cfg * cfg,int argc,char * argv[])462 atu_flush(struct cfg *cfg, int argc, char *argv[])
463 {
464 etherswitch_portid_t p;
465 int i, r;
466
467 bzero(&p, sizeof(p));
468
469 /* note: argv[0] is "flush" */
470 if (argc > 2 && strcasecmp(argv[1], "port") == 0) {
471 p.es_port = atoi(argv[2]);
472 i = IOETHERSWITCHFLUSHPORT;
473 r = 3;
474 } else if (argc > 1 && strcasecmp(argv[1], "all") == 0) {
475 p.es_port = 0;
476 r = 2;
477 i = IOETHERSWITCHFLUSHALL;
478 } else {
479 fprintf(stderr,
480 "%s: invalid verb (port <x> or all) (got %s)\n",
481 __func__, argv[1]);
482 return (-1);
483 }
484
485 if (ioctl(cfg->fd, i, &p) != 0)
486 err(EX_OSERR, "ioctl(ATU flush (ioctl %d, port %d))",
487 i, p.es_port);
488 return (r);
489 }
490
491 static int
atu_dump(struct cfg * cfg,int argc,char * argv[])492 atu_dump(struct cfg *cfg, int argc, char *argv[])
493 {
494 etherswitch_atu_table_t p;
495 etherswitch_atu_entry_t e;
496 uint32_t i;
497
498 (void) argc;
499 (void) argv;
500
501 /* Note: argv[0] is "dump" */
502 bzero(&p, sizeof(p));
503
504 if (ioctl(cfg->fd, IOETHERSWITCHGETTABLE, &p) != 0)
505 err(EX_OSERR, "ioctl(IOETHERSWITCHGETTABLE)");
506
507 /* And now, iterate to get entries */
508 for (i = 0; i < p.es_nitems; i++) {
509 bzero(&e, sizeof(e));
510 e.id = i;
511 if (ioctl(cfg->fd, IOETHERSWITCHGETTABLEENTRY, &e) != 0)
512 break;
513
514 printf(" [%d] %s: portmask 0x%08x\n", i,
515 ether_ntoa((void *) &e.es_macaddr),
516 e.es_portmask);
517 }
518
519 return (1);
520 }
521
522 static void
print_config(struct cfg * cfg)523 print_config(struct cfg *cfg)
524 {
525 const char *c;
526
527 /* Get the device name. */
528 c = strrchr(cfg->controlfile, '/');
529 if (c != NULL)
530 c = c + 1;
531 else
532 c = cfg->controlfile;
533
534 /* Print VLAN mode. */
535 if (cfg->conf.cmd & ETHERSWITCH_CONF_VLAN_MODE) {
536 printf("%s: VLAN mode: ", c);
537 switch (cfg->conf.vlan_mode) {
538 case ETHERSWITCH_VLAN_ISL:
539 printf("ISL\n");
540 break;
541 case ETHERSWITCH_VLAN_PORT:
542 printf("PORT\n");
543 break;
544 case ETHERSWITCH_VLAN_DOT1Q:
545 printf("DOT1Q\n");
546 break;
547 case ETHERSWITCH_VLAN_DOT1Q_4K:
548 printf("DOT1Q4K\n");
549 break;
550 case ETHERSWITCH_VLAN_DOUBLE_TAG:
551 printf("QinQ\n");
552 break;
553 default:
554 printf("none\n");
555 }
556 }
557
558 /* Print switch MAC address. */
559 if (cfg->conf.cmd & ETHERSWITCH_CONF_SWITCH_MACADDR) {
560 printf("%s: Switch MAC address: %s\n",
561 c,
562 ether_ntoa(&cfg->conf.switch_macaddr));
563 }
564 }
565
566 static void
print_port(struct cfg * cfg,int port)567 print_port(struct cfg *cfg, int port)
568 {
569 etherswitch_port_t p;
570 int ifm_ulist[IFMEDIAREQ_NULISTENTRIES];
571 int i;
572
573 bzero(&p, sizeof(p));
574 p.es_port = port;
575 p.es_ifmr.ifm_ulist = ifm_ulist;
576 p.es_ifmr.ifm_count = IFMEDIAREQ_NULISTENTRIES;
577 if (ioctl(cfg->fd, IOETHERSWITCHGETPORT, &p) != 0)
578 err(EX_OSERR, "ioctl(IOETHERSWITCHGETPORT)");
579 printf("port%d:\n", port);
580 if (cfg->conf.vlan_mode == ETHERSWITCH_VLAN_DOT1Q)
581 printf("\tpvid: %d\n", p.es_pvid);
582 printb("\tflags", p.es_flags, ETHERSWITCH_PORT_FLAGS_BITS);
583 printf("\n");
584 if (p.es_nleds) {
585 printf("\tled: ");
586 for (i = 0; i < p.es_nleds; i++) {
587 printf("%d:%s%s", i+1, ledstyles[p.es_led[i]], (i==p.es_nleds-1)?"":" ");
588 }
589 printf("\n");
590 }
591 printf("\tmedia: ");
592 print_media_word(p.es_ifmr.ifm_current, 1);
593 if (p.es_ifmr.ifm_active != p.es_ifmr.ifm_current) {
594 putchar(' ');
595 putchar('(');
596 print_media_word(p.es_ifmr.ifm_active, 0);
597 putchar(')');
598 }
599 putchar('\n');
600 printf("\tstatus: %s\n", (p.es_ifmr.ifm_status & IFM_ACTIVE) != 0 ? "active" : "no carrier");
601 if (cfg->mediatypes) {
602 printf("\tsupported media:\n");
603 if (p.es_ifmr.ifm_count > IFMEDIAREQ_NULISTENTRIES)
604 p.es_ifmr.ifm_count = IFMEDIAREQ_NULISTENTRIES;
605 for (i=0; i<p.es_ifmr.ifm_count; i++) {
606 printf("\t\tmedia ");
607 print_media_word(ifm_ulist[i], 0);
608 putchar('\n');
609 }
610 }
611 }
612
613 static void
print_vlangroup(struct cfg * cfg,int vlangroup)614 print_vlangroup(struct cfg *cfg, int vlangroup)
615 {
616 etherswitch_vlangroup_t vg;
617 int i, comma;
618
619 vg.es_vlangroup = vlangroup;
620 if (ioctl(cfg->fd, IOETHERSWITCHGETVLANGROUP, &vg) != 0)
621 err(EX_OSERR, "ioctl(IOETHERSWITCHGETVLANGROUP)");
622 if ((vg.es_vid & ETHERSWITCH_VID_VALID) == 0)
623 return;
624 vg.es_vid &= ETHERSWITCH_VID_MASK;
625 printf("vlangroup%d:\n", vlangroup);
626 if (cfg->conf.vlan_mode == ETHERSWITCH_VLAN_PORT)
627 printf("\tport: %d\n", vg.es_vid);
628 else
629 printf("\tvlan: %d\n", vg.es_vid);
630 printf("\tmembers ");
631 comma = 0;
632 if (vg.es_member_ports != 0)
633 for (i=0; i<cfg->info.es_nports; i++) {
634 if ((vg.es_member_ports & ETHERSWITCH_PORTMASK(i)) != 0) {
635 if (comma)
636 printf(",");
637 printf("%d", i);
638 if ((vg.es_untagged_ports & ETHERSWITCH_PORTMASK(i)) == 0)
639 printf("t");
640 comma = 1;
641 }
642 }
643 else
644 printf("none");
645 printf("\n");
646 }
647
648 static void
print_info(struct cfg * cfg)649 print_info(struct cfg *cfg)
650 {
651 const char *c;
652 int i;
653
654 c = strrchr(cfg->controlfile, '/');
655 if (c != NULL)
656 c = c + 1;
657 else
658 c = cfg->controlfile;
659 if (cfg->verbose) {
660 printf("%s: %s with %d ports and %d VLAN groups\n", c,
661 cfg->info.es_name, cfg->info.es_nports,
662 cfg->info.es_nvlangroups);
663 printf("%s: ", c);
664 printb("VLAN capabilities", cfg->info.es_vlan_caps,
665 ETHERSWITCH_VLAN_CAPS_BITS);
666 printf("\n");
667 }
668 print_config(cfg);
669 for (i=0; i<cfg->info.es_nports; i++) {
670 print_port(cfg, i);
671 }
672 for (i=0; i<cfg->info.es_nvlangroups; i++) {
673 print_vlangroup(cfg, i);
674 }
675 }
676
677 static void
usage(struct cfg * cfg __unused,char * argv[]__unused)678 usage(struct cfg *cfg __unused, char *argv[] __unused)
679 {
680 fprintf(stderr, "usage: etherswitchctl\n");
681 fprintf(stderr, "\tetherswitchcfg [-f control file] info\n");
682 fprintf(stderr, "\tetherswitchcfg [-f control file] config "
683 "command parameter\n");
684 fprintf(stderr, "\t\tconfig commands: vlan_mode\n");
685 fprintf(stderr, "\tetherswitchcfg [-f control file] phy "
686 "phy.register[=value]\n");
687 fprintf(stderr, "\tetherswitchcfg [-f control file] portX "
688 "[flags] command parameter\n");
689 fprintf(stderr, "\t\tport commands: pvid, media, mediaopt, led\n");
690 fprintf(stderr, "\tetherswitchcfg [-f control file] reg "
691 "register[=value]\n");
692 fprintf(stderr, "\tetherswitchcfg [-f control file] vlangroupX "
693 "command parameter\n");
694 fprintf(stderr, "\t\tvlangroup commands: vlan, members\n");
695 exit(EX_USAGE);
696 }
697
698 static void
newmode(struct cfg * cfg,enum cmdmode mode)699 newmode(struct cfg *cfg, enum cmdmode mode)
700 {
701 if (mode == cfg->mode)
702 return;
703 switch (cfg->mode) {
704 case MODE_NONE:
705 break;
706 case MODE_CONFIG:
707 /*
708 * Read the updated the configuration (it can be different
709 * from the last time we read it).
710 */
711 if (ioctl(cfg->fd, IOETHERSWITCHGETCONF, &cfg->conf) != 0)
712 err(EX_OSERR, "ioctl(IOETHERSWITCHGETCONF)");
713 print_config(cfg);
714 break;
715 case MODE_PORT:
716 print_port(cfg, cfg->unit);
717 break;
718 case MODE_VLANGROUP:
719 print_vlangroup(cfg, cfg->unit);
720 break;
721 case MODE_REGISTER:
722 case MODE_PHYREG:
723 case MODE_ATU:
724 break;
725 }
726 cfg->mode = mode;
727 }
728
729 int
main(int argc,char * argv[])730 main(int argc, char *argv[])
731 {
732 int ch;
733 struct cfg cfg;
734 int i;
735
736 bzero(&cfg, sizeof(cfg));
737 cfg.controlfile = "/dev/etherswitch0";
738 while ((ch = getopt(argc, argv, "f:mv?")) != -1)
739 switch(ch) {
740 case 'f':
741 cfg.controlfile = optarg;
742 break;
743 case 'm':
744 cfg.mediatypes++;
745 break;
746 case 'v':
747 cfg.verbose++;
748 break;
749 case '?':
750 /* FALLTHROUGH */
751 default:
752 usage(&cfg, argv);
753 }
754 argc -= optind;
755 argv += optind;
756 cfg.fd = open(cfg.controlfile, O_RDONLY);
757 if (cfg.fd < 0)
758 err(EX_UNAVAILABLE, "Can't open control file: %s", cfg.controlfile);
759 if (ioctl(cfg.fd, IOETHERSWITCHGETINFO, &cfg.info) != 0)
760 err(EX_OSERR, "ioctl(IOETHERSWITCHGETINFO)");
761 if (ioctl(cfg.fd, IOETHERSWITCHGETCONF, &cfg.conf) != 0)
762 err(EX_OSERR, "ioctl(IOETHERSWITCHGETCONF)");
763 if (argc == 0) {
764 print_info(&cfg);
765 return (0);
766 }
767 cfg.mode = MODE_NONE;
768 while (argc > 0) {
769 switch(cfg.mode) {
770 case MODE_NONE:
771 if (strcmp(argv[0], "info") == 0) {
772 print_info(&cfg);
773 } else if (sscanf(argv[0], "port%d", &cfg.unit) == 1) {
774 if (cfg.unit < 0 || cfg.unit >= cfg.info.es_nports)
775 errx(EX_USAGE, "port unit must be between 0 and %d", cfg.info.es_nports - 1);
776 newmode(&cfg, MODE_PORT);
777 } else if (sscanf(argv[0], "vlangroup%d", &cfg.unit) == 1) {
778 if (cfg.unit < 0 || cfg.unit >= cfg.info.es_nvlangroups)
779 errx(EX_USAGE,
780 "vlangroup unit must be between 0 and %d",
781 cfg.info.es_nvlangroups - 1);
782 newmode(&cfg, MODE_VLANGROUP);
783 } else if (strcmp(argv[0], "config") == 0) {
784 newmode(&cfg, MODE_CONFIG);
785 } else if (strcmp(argv[0], "phy") == 0) {
786 newmode(&cfg, MODE_PHYREG);
787 } else if (strcmp(argv[0], "reg") == 0) {
788 newmode(&cfg, MODE_REGISTER);
789 } else if (strcmp(argv[0], "help") == 0) {
790 usage(&cfg, argv);
791 } else if (strcmp(argv[0], "atu") == 0) {
792 newmode(&cfg, MODE_ATU);
793 } else {
794 errx(EX_USAGE, "Unknown command \"%s\"", argv[0]);
795 }
796 break;
797 case MODE_PORT:
798 case MODE_CONFIG:
799 case MODE_VLANGROUP:
800 case MODE_ATU:
801 for(i=0; cmds[i].name != NULL; i++) {
802 int r;
803 if (cfg.mode == cmds[i].mode &&
804 strcmp(argv[0], cmds[i].name) == 0) {
805 if ((cmds[i].args != -1) &&
806 (argc < (cmds[i].args + 1))) {
807 printf("%s needs %d argument%s\n",
808 cmds[i].name, cmds[i].args,
809 (cmds[i].args==1)?"":",");
810 break;
811 }
812
813 r = (cmds[i].f)(&cfg, argc, argv);
814
815 /* -1 here means "error" */
816 if (r == -1) {
817 argc = 0;
818 break;
819 }
820
821 /* Legacy return value */
822 if (r == 0)
823 r = cmds[i].args;
824
825 argc -= r;
826 argv += r;
827 break;
828 }
829 }
830 if (cmds[i].name == NULL) {
831 newmode(&cfg, MODE_NONE);
832 continue;
833 }
834 break;
835 case MODE_REGISTER:
836 if (set_register(&cfg, argv[0]) != 0) {
837 newmode(&cfg, MODE_NONE);
838 continue;
839 }
840 break;
841 case MODE_PHYREG:
842 if (set_phyregister(&cfg, argv[0]) != 0) {
843 newmode(&cfg, MODE_NONE);
844 continue;
845 }
846 break;
847 }
848 argc--;
849 argv++;
850 }
851 /* switch back to command mode to print configuration for last command */
852 newmode(&cfg, MODE_NONE);
853 close(cfg.fd);
854 return (0);
855 }
856
857 static struct cmds cmds[] = {
858 { MODE_PORT, "pvid", 1, set_port_vid },
859 { MODE_PORT, "media", 1, set_port_media },
860 { MODE_PORT, "mediaopt", 1, set_port_mediaopt },
861 { MODE_PORT, "led", 2, set_port_led },
862 { MODE_PORT, "addtag", 0, set_port_flag },
863 { MODE_PORT, "-addtag", 0, set_port_flag },
864 { MODE_PORT, "ingress", 0, set_port_flag },
865 { MODE_PORT, "-ingress", 0, set_port_flag },
866 { MODE_PORT, "striptag", 0, set_port_flag },
867 { MODE_PORT, "-striptag", 0, set_port_flag },
868 { MODE_PORT, "doubletag", 0, set_port_flag },
869 { MODE_PORT, "-doubletag", 0, set_port_flag },
870 { MODE_PORT, "firstlock", 0, set_port_flag },
871 { MODE_PORT, "-firstlock", 0, set_port_flag },
872 { MODE_PORT, "droptagged", 0, set_port_flag },
873 { MODE_PORT, "-droptagged", 0, set_port_flag },
874 { MODE_PORT, "dropuntagged", 0, set_port_flag },
875 { MODE_PORT, "-dropuntagged", 0, set_port_flag },
876 { MODE_CONFIG, "vlan_mode", 1, set_vlan_mode },
877 { MODE_VLANGROUP, "vlan", 1, set_vlangroup_vid },
878 { MODE_VLANGROUP, "members", 1, set_vlangroup_members },
879 { MODE_ATU, "flush", -1, atu_flush },
880 { MODE_ATU, "dump", -1, atu_dump },
881 { 0, NULL, 0, NULL }
882 };
883