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