1 /*        $NetBSD: lagg.c,v 1.8 2024/04/09 08:53:08 yamaguchi Exp $   */
2 
3 /*
4  * Copyright (c) 2021 Internet Initiative Japan Inc.
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 NETBSD FOUNDATION, INC. AND CONTRIBUTORS
17  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
18  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
19  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
20  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
21  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
22  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
23  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
24  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
25  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
26  * POSSIBILITY OF SUCH DAMAGE.
27  */
28 
29 #include <sys/cdefs.h>
30 #if !defined(lint)
31 __RCSID("$NetBSD: lagg.c,v 1.8 2024/04/09 08:53:08 yamaguchi Exp $");
32 #endif /* !defined(lint) */
33 
34 #include <sys/param.h>
35 
36 #include <sys/ioctl.h>
37 
38 #include <net/if.h>
39 #include <net/if_ether.h>
40 #include <net/if_lagg.h>
41 
42 #include <ctype.h>
43 #include <err.h>
44 #include <errno.h>
45 #include <string.h>
46 #include <stdio.h>
47 #include <stdlib.h>
48 #include <util.h>
49 
50 #include "env.h"
51 #include "extern.h"
52 #include "util.h"
53 
54 static status_func_t           status;
55 static usage_func_t  usage;
56 static cmdloop_branch_t        branch;
57 
58 static void         lagg_constructor(void) __attribute__((constructor));
59 static void         lagg_status(prop_dictionary_t, prop_dictionary_t);
60 static void         lagg_usage(prop_dictionary_t);
61 
62 static int          setlaggproto(prop_dictionary_t, prop_dictionary_t);
63 static int          setlaggport(prop_dictionary_t, prop_dictionary_t);
64 static int          setlagglacp(prop_dictionary_t, prop_dictionary_t);
65 static int          setlagglacpmaxports(prop_dictionary_t, prop_dictionary_t);
66 static int          setlaggfail(prop_dictionary_t, prop_dictionary_t);
67 static void         lagg_status_proto(lagg_proto, struct laggreqproto *);
68 static void         lagg_status_port(lagg_proto, struct laggreqport *);
69 
70 #ifdef LAGG_DEBUG
71 static const bool    lagg_debug = true;
72 #else
73 static const bool    lagg_debug = false;
74 #endif
75 
76 #define LAGG_RETRY_MAX 10
77 
78 static const char   *laggprotostr[LAGG_PROTO_MAX] = {
79           [LAGG_PROTO_NONE] = "none",
80           [LAGG_PROTO_LACP] = "lacp",
81           [LAGG_PROTO_FAILOVER] = "failover",
82           [LAGG_PROTO_LOADBALANCE] = "loadbalance",
83 };
84 
85 enum laggportcmd {
86           LAGGPORT_NOCMD = 1,
87           LAGGPORT_ADD,
88           LAGGPORT_DEL,
89 };
90 
91 enum lagglacpcmd {
92           LAGGLACP_ADD = 1,
93           LAGGLACP_DEL,
94 };
95 
96 enum lagglacpopt {
97           LAGGLACPOPT_DUMPDU = 1,
98           LAGGLACPOPT_STOPDU,
99           LAGGLACPOPT_OPTIMISTIC,
100           LAGGLACPOPT_MULTILS,
101 };
102 
103 enum laggfailopt {
104           LAGGFAILOPT_RXALL = 1,
105 };
106 
107 struct pbranch       laggport_root;
108 struct pbranch       lagglacp_root;
109 struct pbranch       laggfail_root;
110 
111 struct pstr          laggproto = PSTR_INITIALIZER(&laggproto, "lagg-protocol",
112                         setlaggproto, "laggproto", &command_root.pb_parser);
113 struct piface        laggaddport = PIFACE_INITIALIZER(&laggaddport,
114                         "lagg-port-interface", setlaggport, "laggport",
115                         &laggport_root.pb_parser);
116 struct piface        laggdelport = PIFACE_INITIALIZER(&laggdelport,
117                         "lagg-port-interface", setlaggport, "laggport",
118                         &command_root.pb_parser);
119 struct pinteger      laggportoptpri =  PINTEGER_INITIALIZER1(&laggportoptpri,
120                         "lagg-port-priority", 0, UINT16_MAX, 10,
121                         setlaggport, "laggportpri", &laggport_root.pb_parser);
122 struct pinteger      lagglacpmaxports = PINTEGER_INITIALIZER1(&lagglacpmaxports,
123                         "lagg-lacp-maxports", 1, UINT32_MAX, 10,
124                         setlagglacpmaxports, "lacpmaxports",
125                         &lagglacp_root.pb_parser);
126 struct pinteger      laggportpri_num = PINTEGER_INITIALIZER1(&laggportpri_num,
127                         "lagg-port-priority", 0, UINT16_MAX, 10,
128                         setlaggport, "laggportpri", &command_root.pb_parser);
129 struct piface        laggportpri_if = PIFACE_INITIALIZER(&laggportpri_if,
130                         "lagg-port-interface", NULL, "laggport",
131                         &laggportpri_num.pi_parser);
132 
133 static const struct kwinst     lagglacpkw[] = {
134             {.k_word = "dumpdu", .k_key = "lacpdumpdu",
135              .k_type = KW_T_INT, .k_int = LAGGLACPOPT_DUMPDU,
136              .k_exec = setlagglacp}
137           , {.k_word = "-dumpdu", .k_key = "lacpdumpdu",
138              .k_type = KW_T_INT, .k_int = -LAGGLACPOPT_DUMPDU,
139              .k_exec = setlagglacp}
140           , {.k_word = "stopdu", .k_key = "lacpstopdu",
141              .k_type = KW_T_INT, .k_int = LAGGLACPOPT_STOPDU,
142              .k_exec = setlagglacp}
143           , {.k_word = "-stopdu", .k_key = "lacpstopdu",
144              .k_type = KW_T_INT, .k_int = -LAGGLACPOPT_STOPDU,
145              .k_exec = setlagglacp}
146           , {.k_word = "optimistic", .k_key = "lacpoptimistic",
147              .k_type = KW_T_INT, .k_int = LAGGLACPOPT_OPTIMISTIC,
148              .k_exec = setlagglacp}
149           , {.k_word = "-optimistic", .k_key = "lacpoptimistic",
150              .k_type = KW_T_INT, .k_int = -LAGGLACPOPT_OPTIMISTIC,
151              .k_exec = setlagglacp}
152           , {.k_word = "maxports", .k_nextparser = &lagglacpmaxports.pi_parser}
153           , {.k_word = "-maxports", .k_key = "lacpmaxports",
154              .k_type = KW_T_INT, .k_int = 0, .k_exec = setlagglacpmaxports}
155           , {.k_word = "multi-linkspeed", .k_key = "lacpmultils",
156              .k_type = KW_T_INT, .k_int = LAGGLACPOPT_MULTILS,
157              .k_exec = setlagglacp}
158           , {.k_word = "-multi-linkspeed", .k_key = "lacpmultils",
159              .k_type = KW_T_INT, .k_int = -LAGGLACPOPT_MULTILS,
160              .k_exec = setlagglacp}
161 };
162 struct pkw           lagglacp = PKW_INITIALIZER(&lagglacp, "lagg-lacp-option",
163                         NULL, NULL, lagglacpkw, __arraycount(lagglacpkw),
164                         &lagglacp_root.pb_parser);
165 
166 static const struct kwinst     laggfailkw[] = {
167             {.k_word = "rx-all", .k_key = "failrxall",
168              .k_type = KW_T_INT, .k_int = LAGGFAILOPT_RXALL}
169           , {.k_word = "-rx-all", .k_key = "failrxall",
170              .k_type = KW_T_INT, .k_int = -LAGGFAILOPT_RXALL}
171 };
172 struct pkw           laggfail = PKW_INITIALIZER(&laggfail, "lagg-failover-option",
173                         setlaggfail, NULL, laggfailkw, __arraycount(laggfailkw),
174                         &laggfail_root.pb_parser);
175 
176 static const struct kwinst     laggkw[] = {
177             {.k_word = "laggproto", .k_nextparser = &laggproto.ps_parser}
178           , {.k_word = "-laggproto", .k_key = "laggproto", .k_type = KW_T_STR,
179              .k_str = "none", .k_exec = setlaggproto}
180           , {.k_word = "laggport", .k_key = "laggportcmd", .k_type = KW_T_INT,
181              .k_int = LAGGPORT_ADD, .k_nextparser = &laggaddport.pif_parser}
182           , {.k_word = "-laggport", .k_key = "laggportcmd", .k_type = KW_T_INT,
183              .k_int = LAGGPORT_DEL, .k_nextparser = &laggdelport.pif_parser}
184           , {.k_word = "lagglacp", .k_nextparser = &lagglacp.pk_parser}
185           , {.k_word = "laggportpri", .k_nextparser = &laggportpri_if.pif_parser}
186           , {.k_word = "laggfailover", .k_nextparser = &laggfail.pk_parser}
187 };
188 struct pkw           lagg = PKW_INITIALIZER(&lagg, "lagg", NULL, NULL,
189                         laggkw, __arraycount(laggkw), NULL);
190 
191 static const struct kwinst     laggportkw[] = {
192             {.k_word = "pri", .k_nextparser = &laggportoptpri.pi_parser}
193 };
194 struct pkw          laggportopt = PKW_INITIALIZER(&laggportopt, "lagg-port-option",
195                         NULL, NULL, laggportkw, __arraycount(laggportkw), NULL);
196 
197 struct branch        laggport_brs[] = {
198             {.b_nextparser = &laggportopt.pk_parser}
199           , {.b_nextparser = &command_root.pb_parser}
200 };
201 struct branch        lagglacp_brs[] = {
202             {.b_nextparser = &lagglacp.pk_parser}
203           , {.b_nextparser = &command_root.pb_parser}
204 };
205 struct branch        laggfail_brs[] = {
206             {.b_nextparser = &laggfail.pk_parser}
207           , {.b_nextparser = &command_root.pb_parser}
208 };
209 
210 static void
lagg_constructor(void)211 lagg_constructor(void)
212 {
213           struct pbranch _laggport_root = PBRANCH_INITIALIZER(&laggport_root,
214               "laggport-root", laggport_brs, __arraycount(laggport_brs), true);
215           struct pbranch _lagglacp_root = PBRANCH_INITIALIZER(&lagglacp_root,
216               "lagglacp-root", lagglacp_brs, __arraycount(lagglacp_brs), true);
217           struct pbranch _laggfail_root = PBRANCH_INITIALIZER(&laggfail_root,
218               "laggfail-root", laggfail_brs, __arraycount(laggfail_brs), true);
219 
220           laggport_root = _laggport_root;
221           lagglacp_root = _lagglacp_root;
222           laggfail_root = _laggfail_root;
223 
224           cmdloop_branch_init(&branch, &lagg.pk_parser);
225           status_func_init(&status, lagg_status);
226           usage_func_init(&usage, lagg_usage);
227 
228           register_cmdloop_branch(&branch);
229           register_status(&status);
230           register_usage(&usage);
231 }
232 
233 static int
is_laggif(prop_dictionary_t env)234 is_laggif(prop_dictionary_t env)
235 {
236           const char *ifname;
237           size_t i, len;
238 
239           if ((ifname = getifname(env)) == NULL)
240                     return 0;
241 
242           if (strncmp(ifname, "lagg", 4) != 0)
243                     return 0;
244 
245           len = strlen(ifname);
246           for (i = 4; i < len; i++) {
247                     if (!isdigit((unsigned char)ifname[i]))
248                               return 0;
249           }
250 
251           return 1;
252 }
253 
254 static struct lagg_req *
getlagg(prop_dictionary_t env)255 getlagg(prop_dictionary_t env)
256 {
257           struct lagg_req *req = NULL, *p;
258           size_t nports, bufsiz;
259           int i;
260 
261           if (!is_laggif(env)) {
262                     if (lagg_debug)
263                               warnx("valid only with lagg(4) interfaces");
264                     goto done;
265           }
266 
267           for (i = 0, nports = 0; i < LAGG_RETRY_MAX; i++) {
268                     bufsiz = sizeof(*req);
269                     bufsiz += sizeof(req->lrq_reqports[0]) * nports;
270                     p = realloc(req, bufsiz);
271                     if (p == NULL)
272                               break;
273 
274                     req = p;
275                     memset(req, 0, bufsiz);
276                     req->lrq_nports = nports;
277                     if (indirect_ioctl(env, SIOCGLAGG, req) == 0)
278                               goto done;
279 
280                     if (errno != ENOBUFS)
281                               break;
282                     nports = req->lrq_nports;
283           }
284 
285           if (req != NULL) {
286                     free(req);
287                     req = NULL;
288           }
289 
290 done:
291           return req;
292 }
293 
294 static void
freelagg(struct lagg_req * req)295 freelagg(struct lagg_req *req)
296 {
297 
298           free(req);
299 }
300 
301 static void
lagg_status(prop_dictionary_t env,prop_dictionary_t oenv)302 lagg_status(prop_dictionary_t env, prop_dictionary_t oenv)
303 {
304           struct lagg_req *req;
305           struct laggreqport *port;
306           const char *proto;
307           char str[256];
308           size_t i;
309 
310           req = getlagg(env);
311           if (req == NULL)
312                     return;
313 
314           if (req->lrq_proto >= LAGG_PROTO_MAX ||
315               (proto = laggprotostr[req->lrq_proto]) == NULL) {
316                     proto = "unknown";
317           }
318 
319           printf("\tlaggproto %s", proto);
320           if (vflag)
321                     lagg_status_proto(req->lrq_proto, &req->lrq_reqproto);
322           putchar('\n');
323 
324           if (req->lrq_nports > 0) {
325                     printf("\tlaggport:\n");
326                     for (i = 0; i < req->lrq_nports; i++) {
327                               port = &req->lrq_reqports[i];
328                               snprintb(str, sizeof(str),
329                                   LAGG_PORT_BITS, port->rp_flags);
330 
331                               printf("\t\t%.*s pri=%u flags=%s",
332                                   IFNAMSIZ, port->rp_portname,
333                                   (unsigned int)port->rp_prio,
334                                   str);
335                               if (vflag)
336                                         lagg_status_port(req->lrq_proto, port);
337                               putchar('\n');
338                     }
339           }
340 
341           freelagg(req);
342 }
343 
344 static int
setlaggproto(prop_dictionary_t env,prop_dictionary_t oenv)345 setlaggproto(prop_dictionary_t env, prop_dictionary_t oenv)
346 {
347           prop_object_t obj;
348           struct lagg_req req;
349           const char *proto;
350           size_t i, proto_len;
351 
352           memset(&req, 0, sizeof(req));
353 
354           obj = prop_dictionary_get(env, "laggproto");
355           if (obj == NULL) {
356                     errno = ENOENT;
357                     return -1;
358           }
359 
360           switch (prop_object_type(obj)) {
361           case PROP_TYPE_DATA:
362                     proto = prop_data_value(obj);
363                     proto_len = prop_data_size(obj);
364                     break;
365           case PROP_TYPE_STRING:
366                     proto = prop_string_value(obj);
367                     proto_len = prop_string_size(obj);
368                     break;
369           default:
370                     errno = EFAULT;
371                     return -1;
372           }
373 
374           for (i = 0; i < LAGG_PROTO_MAX; i++) {
375                     if (strncmp(proto, laggprotostr[i], proto_len) == 0)
376                               break;
377           }
378 
379           if (i >= LAGG_PROTO_MAX) {
380                     errno = EPROTONOSUPPORT;
381                     return -1;
382           }
383 
384           req.lrq_ioctl = LAGGIOC_SETPROTO;
385           req.lrq_proto = i;
386 
387           if (indirect_ioctl(env, SIOCSLAGG, &req) == -1)
388                     return -1;
389 
390           return 0;
391 }
392 
393 static int
setlaggport(prop_dictionary_t env,prop_dictionary_t oenv __unused)394 setlaggport(prop_dictionary_t env, prop_dictionary_t oenv __unused)
395 {
396           struct lagg_req *req;
397           struct laggreqport *rp;
398           const char *ifname;
399           enum lagg_ioctl ioc;
400           int64_t lpcmd, pri;
401           int rv;
402           size_t sz;
403 
404           if (!prop_dictionary_get_string(env, "laggport", &ifname)) {
405                     if (lagg_debug)
406                               warnx("%s.%d", __func__, __LINE__);
407                     errno = ENOENT;
408                     return -1;
409           }
410 
411           sz = sizeof(*req) + sizeof(req->lrq_reqports[0]) * 1;
412           req = calloc(1, sz);
413           if (req == NULL) {
414                     errno = ENOBUFS;
415                     return -1;
416           }
417 
418           req->lrq_nports = 1;
419           rp = &req->lrq_reqports[0];
420           strlcpy(rp->rp_portname, ifname, sizeof(rp->rp_portname));
421           ioc = LAGGIOC_NOCMD;
422 
423           if (prop_dictionary_get_int64(env, "laggportcmd", &lpcmd)) {
424                     if (lpcmd == LAGGPORT_ADD) {
425                               ioc = LAGGIOC_ADDPORT;
426                     } else {
427                               ioc = LAGGIOC_DELPORT;
428                     }
429           }
430 
431           if (prop_dictionary_get_int64(env, "laggportpri", &pri)) {
432                     ioc = LAGGIOC_SETPORTPRI;
433                     rp->rp_prio = (uint32_t)pri;
434           }
435 
436           if (ioc != LAGGIOC_NOCMD) {
437                     req->lrq_ioctl = ioc;
438                     rv = indirect_ioctl(env, SIOCSLAGG, req);
439                     if (lagg_debug && rv == -1)
440                               warn("cmd=%d", ioc);
441           } else {
442                     rv = 0;
443           }
444 
445           free(req);
446 
447           return rv;
448 }
449 
450 static int
setlagglacp(prop_dictionary_t env,prop_dictionary_t oenv __unused)451 setlagglacp(prop_dictionary_t env, prop_dictionary_t oenv __unused)
452 {
453           struct lagg_req req_add, req_del;
454           struct laggreq_lacp *add_lacp, *del_lacp;
455           int64_t v;
456 
457           memset(&req_add, 0, sizeof(req_add));
458           memset(&req_del, 0, sizeof(req_del));
459 
460           req_add.lrq_proto = req_del.lrq_proto = LAGG_PROTO_LACP;
461           req_add.lrq_ioctl = req_del.lrq_ioctl = LAGGIOC_SETPROTOOPT;
462           add_lacp = &req_add.lrq_reqproto.rp_lacp;
463           del_lacp = &req_del.lrq_reqproto.rp_lacp;
464 
465           add_lacp->command = LAGGIOC_LACPSETFLAGS;
466           del_lacp->command = LAGGIOC_LACPCLRFLAGS;
467 
468           if (prop_dictionary_get_int64(env, "lacpdumpdu", &v)) {
469                     if (v == LAGGLACPOPT_DUMPDU) {
470                               add_lacp->flags |= LAGGREQLACP_DUMPDU;
471                     } else {
472                               del_lacp->flags |= LAGGREQLACP_DUMPDU;
473                     }
474           }
475 
476           if (prop_dictionary_get_int64(env, "lacpstopdu", &v)) {
477                     if (v == LAGGLACPOPT_STOPDU) {
478                               add_lacp->flags |= LAGGREQLACP_STOPDU;
479                     } else {
480                               del_lacp->flags |= LAGGREQLACP_STOPDU;
481                     }
482           }
483 
484           if (prop_dictionary_get_int64(env, "lacpoptimistic", &v)) {
485                     if (v == LAGGLACPOPT_OPTIMISTIC) {
486                               add_lacp->flags |= LAGGREQLACP_OPTIMISTIC;
487                     } else {
488                               del_lacp->flags |= LAGGREQLACP_OPTIMISTIC;
489                     }
490           }
491 
492           if (prop_dictionary_get_int64(env, "lacpmultils", &v)) {
493                     if (v == LAGGLACPOPT_MULTILS) {
494                               add_lacp->flags |= LAGGREQLACP_MULTILS;
495                     } else {
496                               del_lacp->flags |= LAGGREQLACP_MULTILS;
497                     }
498           }
499 
500           if (del_lacp->flags != 0) {
501                     if (indirect_ioctl(env, SIOCSLAGG, &req_del) == -1) {
502                               if (lagg_debug) {
503                                         warn("cmd=%d, pcmd=%d",
504                                             req_del.lrq_ioctl,
505                                             del_lacp->command);
506                               }
507                               return -1;
508                     }
509           }
510 
511           if (add_lacp->flags != 0) {
512                     if (indirect_ioctl(env, SIOCSLAGG, &req_add) == -1) {
513                               if (lagg_debug) {
514                                         warn("cmd=%d, pcmd=%d",
515                                             req_add.lrq_ioctl,
516                                             add_lacp->command);
517                               }
518                               return -1;
519                     }
520           }
521 
522           return 0;
523 }
524 
525 static int
setlagglacpmaxports(prop_dictionary_t env,prop_dictionary_t oenv __unused)526 setlagglacpmaxports(prop_dictionary_t env,
527     prop_dictionary_t oenv __unused)
528 {
529           struct lagg_req req;
530           struct laggreq_lacp *lrq_lacp;
531           int64_t v;
532 
533           memset(&req, 0, sizeof(req));
534           req.lrq_proto = LAGG_PROTO_LACP;
535           req.lrq_ioctl = LAGGIOC_SETPROTOOPT;
536           lrq_lacp = &req.lrq_reqproto.rp_lacp;
537 
538           if (!prop_dictionary_get_int64(env, "lacpmaxports", &v)) {
539                     if (lagg_debug)
540                               warnx("%s.%d", __func__, __LINE__);
541                     errno = ENOENT;
542                     return -1;
543           }
544 
545           if (v <= 0) {
546                     lrq_lacp->command = LAGGIOC_LACPCLRMAXPORTS;
547           } else if (v > 0){
548                     lrq_lacp->command = LAGGIOC_LACPSETMAXPORTS;
549                     lrq_lacp->maxports = (size_t)v;
550           }
551 
552           if (indirect_ioctl(env, SIOCSLAGG, &req) == -1) {
553                     err(EXIT_FAILURE, "SIOCSLAGGPROTO");
554           }
555 
556           return 0;
557 }
558 
559 static int
setlaggfail(prop_dictionary_t env,prop_dictionary_t oenv __unused)560 setlaggfail(prop_dictionary_t env,
561     prop_dictionary_t oenv __unused)
562 {
563           struct lagg_req req_add, req_del;
564           struct laggreq_fail *add_fail, *del_fail;
565           int64_t v;
566 
567           memset(&req_add, 0, sizeof(req_add));
568           memset(&req_del, 0, sizeof(req_del));
569 
570           req_add.lrq_proto = req_del.lrq_proto = LAGG_PROTO_FAILOVER;
571           req_add.lrq_ioctl = req_del.lrq_ioctl = LAGGIOC_SETPROTOOPT;
572           add_fail = &req_add.lrq_reqproto.rp_fail;
573           del_fail = &req_del.lrq_reqproto.rp_fail;
574 
575           add_fail->command = LAGGIOC_FAILSETFLAGS;
576           del_fail->command = LAGGIOC_FAILCLRFLAGS;
577 
578           if (prop_dictionary_get_int64(env, "failrxall", &v)) {
579                     if (v == LAGGFAILOPT_RXALL) {
580                               add_fail->flags |= LAGGREQFAIL_RXALL;
581                     } else {
582                               del_fail->flags |= LAGGREQFAIL_RXALL;
583                     }
584           }
585 
586           if (del_fail->flags != 0) {
587                     if (indirect_ioctl(env, SIOCSLAGG, &req_del) == -1) {
588                               if (lagg_debug) {
589                                         warn("cmd=%d, pcmd=%d",
590                                             req_del.lrq_ioctl,
591                                             del_fail->command);
592                               }
593                               return -1;
594                     }
595           }
596 
597           if (add_fail->flags != 0) {
598                     if (indirect_ioctl(env, SIOCSLAGG, &req_add) == -1) {
599                               if (lagg_debug) {
600                                         warn("cmd=%d, pcmd=%d",
601                                             req_add.lrq_ioctl,
602                                             add_fail->command);
603                               }
604                               return -1;
605                     }
606           }
607 
608           return 0;
609 }
610 
611 static void
lagg_usage(prop_dictionary_t env __unused)612 lagg_usage(prop_dictionary_t env __unused)
613 {
614 
615           fprintf(stderr, "\t[ laggproto p ]\n");
616           fprintf(stderr, "\t[ laggport i [ pri n ] ] "
617               "[ -laggport i ]\n");
618           fprintf(stderr, "\t[ laggportpri i [ pri n]]\n");
619           fprintf(stderr, "\t[ lagglacp [ dumpdu | -dumpdu ] "
620               "[ stopdu | -stopdu ]\n"
621               "\t\t[ maxports n | -maxports ] [ optimistic | -optimistic ] ]\n");
622           fprintf(stderr, "\t[ laggfailover] [ rx-all | -rx-all ]\n");
623 }
624 static void
lacp_format_id(char * buf,size_t len,uint16_t system_prio,uint8_t * system_mac,uint16_t system_key)625 lacp_format_id(char *buf, size_t len,
626     uint16_t system_prio, uint8_t *system_mac, uint16_t system_key)
627 {
628 
629           snprintf(buf, len, "[%04X,%02X-%02X-%02X-%02X-%02X-%02X,"
630               "%04X]",
631               system_prio,
632               (unsigned int)system_mac[0],(unsigned int)system_mac[1],
633               (unsigned int)system_mac[2],(unsigned int)system_mac[3],
634               (unsigned int)system_mac[4],(unsigned int)system_mac[5],
635               system_key);
636 }
637 
638 static void
lagg_status_proto(lagg_proto pr,struct laggreqproto * req)639 lagg_status_proto(lagg_proto pr, struct laggreqproto *req)
640 {
641           struct laggreq_lacp *lacp;
642           char str[256];
643 
644           switch (pr) {
645           case LAGG_PROTO_LACP:
646                     lacp = &req->rp_lacp;
647 
648                     printf("\n");
649                     snprintb(str, sizeof(str), LAGGREQLACP_BITS,
650                         lacp->flags);
651                     printf("\t\tmax ports=%zu, flags=%s\n",
652                         lacp->maxports, str);
653 
654                     lacp_format_id(str, sizeof(str), lacp->actor_prio,
655                         lacp->actor_mac, lacp->actor_key);
656                     printf("\t\tactor=%s\n", str);
657 
658                     lacp_format_id(str, sizeof(str), lacp->partner_prio,
659                         lacp->partner_mac, lacp->partner_key);
660                     printf("\t\tpartner=%s", str);
661                     break;
662           default:
663                     break;
664           }
665 }
666 
667 static void
lagg_status_port(lagg_proto pr,struct laggreqport * req)668 lagg_status_port(lagg_proto pr, struct laggreqport *req)
669 {
670           struct laggreq_lacpport *lacp;
671           char str[256];
672 
673           switch (pr) {
674           case LAGG_PROTO_LACP:
675                     lacp = &req->rp_lacpport;
676 
677                     putchar('\n');
678 
679                     snprintb(str, sizeof(str), LACP_STATE_BITS, lacp->actor_state);
680                     printf("\t\t\tactor: state=%s\n",str);
681 
682                     lacp_format_id(str, sizeof(str), lacp->partner_prio,
683                         lacp->partner_mac, lacp->partner_key);
684                     printf("\t\t\tpartner=%s\n", str);
685                     snprintb(str, sizeof(str), LACP_STATE_BITS,
686                         lacp->partner_state);
687                     printf("\t\t\tpartner: port=%04X prio=%04X state=%s",
688                         lacp->partner_portno, lacp->partner_portprio, str);
689                     break;
690           default:
691                     break;
692           }
693 }
694