Home | History | Annotate | Line # | Download | only in ifconfig
lagg.c revision 1.2
      1  1.2  christos /*	$NetBSD: lagg.c,v 1.2 2021/06/21 03:14:40 christos 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.2  christos __RCSID("$NetBSD: lagg.c,v 1.2 2021/06/21 03:14:40 christos 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.1  yamaguch 	   .k_type = KW_T_INT, .k_int = LAGGLACPOPT_DUMPDU}
    136  1.1  yamaguch 	, {.k_word = "-dumpdu", .k_key = "lacpdumpdu",
    137  1.1  yamaguch 	   .k_type = KW_T_INT, .k_int = -LAGGLACPOPT_DUMPDU}
    138  1.1  yamaguch 	, {.k_word = "stopdu", .k_key = "lacpstopdu",
    139  1.1  yamaguch 	   .k_type = KW_T_INT, .k_int = LAGGLACPOPT_STOPDU}
    140  1.1  yamaguch 	, {.k_word = "-stopdu", .k_key = "lacpstopdu",
    141  1.1  yamaguch 	   .k_type = KW_T_INT, .k_int = -LAGGLACPOPT_STOPDU}
    142  1.1  yamaguch 	, {.k_word = "optimistic", .k_key = "lacpoptimistic",
    143  1.1  yamaguch 	   .k_type = KW_T_INT, .k_int = LAGGLACPOPT_OPTIMISTIC}
    144  1.1  yamaguch 	, {.k_word = "-optimistic", .k_key = "lacpoptimistic",
    145  1.1  yamaguch 	   .k_type = KW_T_INT, .k_int = -LAGGLACPOPT_OPTIMISTIC}
    146  1.1  yamaguch 	, {.k_word = "maxports", .k_nextparser = &lagglacpmaxports.pi_parser}
    147  1.1  yamaguch 	, {.k_word = "-maxports", .k_key = "lacpmaxports",
    148  1.1  yamaguch 	   .k_type = KW_T_INT, .k_int = 0}
    149  1.1  yamaguch 	, {.k_word = "multi-linkspeed", .k_key = "lacpmultils",
    150  1.1  yamaguch 	   .k_type = KW_T_INT, .k_int = LAGGLACPOPT_MULTILS}
    151  1.1  yamaguch 	, {.k_word = "-multi-linkspeed", .k_key = "lacpmultils",
    152  1.1  yamaguch 	   .k_type = KW_T_INT, .k_int = -LAGGLACPOPT_MULTILS}
    153  1.1  yamaguch };
    154  1.1  yamaguch struct pkw	 lagglacp = PKW_INITIALIZER(&lagglacp, "lagg-lacp-option",
    155  1.1  yamaguch 		    setlagglacp, NULL, lagglacpkw, __arraycount(lagglacpkw),
    156  1.1  yamaguch 		    &lagglacp_root.pb_parser);
    157  1.1  yamaguch 
    158  1.1  yamaguch static const struct kwinst	 laggfailkw[] = {
    159  1.1  yamaguch 	  {.k_word = "rx-all", .k_key = "failrxall",
    160  1.1  yamaguch 	   .k_type = KW_T_INT, .k_int = LAGGFAILOPT_RXALL}
    161  1.1  yamaguch 	, {.k_word = "-rx-all", .k_key = "failrxall",
    162  1.1  yamaguch 	   .k_type = KW_T_INT, .k_int = -LAGGFAILOPT_RXALL}
    163  1.1  yamaguch };
    164  1.1  yamaguch struct pkw	 laggfail = PKW_INITIALIZER(&laggfail, "lagg-failover-option",
    165  1.1  yamaguch 		    setlaggfail, NULL, laggfailkw, __arraycount(laggfailkw),
    166  1.1  yamaguch 		    &laggfail_root.pb_parser);
    167  1.1  yamaguch 
    168  1.1  yamaguch static const struct kwinst	 laggkw[] = {
    169  1.1  yamaguch 	  {.k_word = "laggproto", .k_nextparser = &laggproto.ps_parser}
    170  1.1  yamaguch 	, {.k_word = "-laggproto", .k_key = "laggproto", .k_type = KW_T_STR,
    171  1.1  yamaguch 	   .k_str = "none", .k_exec = setlaggproto}
    172  1.1  yamaguch 	, {.k_word = "laggport", .k_key = "laggportcmd", .k_type = KW_T_INT,
    173  1.1  yamaguch 	   .k_int = LAGGPORT_ADD, .k_nextparser = &laggaddport.pif_parser}
    174  1.1  yamaguch 	, {.k_word = "-laggport", .k_key = "laggportcmd", .k_type = KW_T_INT,
    175  1.1  yamaguch 	   .k_int = LAGGPORT_DEL, .k_nextparser = &laggdelport.pif_parser}
    176  1.1  yamaguch 	, {.k_word = "lagglacp", .k_nextparser = &lagglacp.pk_parser}
    177  1.1  yamaguch 	, {.k_word = "laggportpri", .k_nextparser = &laggportpri_if.pif_parser}
    178  1.1  yamaguch 	, {.k_word = "laggfailover", .k_nextparser = &laggfail.pk_parser}
    179  1.1  yamaguch };
    180  1.1  yamaguch struct pkw	 lagg = PKW_INITIALIZER(&lagg, "lagg", NULL, NULL,
    181  1.1  yamaguch 		    laggkw, __arraycount(laggkw), NULL);
    182  1.1  yamaguch 
    183  1.1  yamaguch static const struct kwinst	 laggportkw[] = {
    184  1.1  yamaguch 	  {.k_word = "pri", .k_nextparser = &laggportoptpri.pi_parser}
    185  1.1  yamaguch };
    186  1.1  yamaguch struct pkw	laggportopt = PKW_INITIALIZER(&laggportopt, "lagg-port-option",
    187  1.1  yamaguch 		    NULL, NULL, laggportkw, __arraycount(laggportkw), NULL);
    188  1.1  yamaguch 
    189  1.1  yamaguch struct branch	 laggport_brs[] = {
    190  1.1  yamaguch 	  {.b_nextparser = &laggportopt.pk_parser}
    191  1.1  yamaguch 	, {.b_nextparser = &command_root.pb_parser}
    192  1.1  yamaguch };
    193  1.1  yamaguch struct branch	 lagglacp_brs[] = {
    194  1.1  yamaguch 	  {.b_nextparser = &lagglacp.pk_parser}
    195  1.1  yamaguch 	, {.b_nextparser = &command_root.pb_parser}
    196  1.1  yamaguch };
    197  1.1  yamaguch struct branch	 laggfail_brs[] = {
    198  1.1  yamaguch 	  {.b_nextparser = &laggfail.pk_parser}
    199  1.1  yamaguch 	, {.b_nextparser = &command_root.pb_parser}
    200  1.1  yamaguch };
    201  1.1  yamaguch 
    202  1.1  yamaguch static void
    203  1.1  yamaguch lagg_constructor(void)
    204  1.1  yamaguch {
    205  1.1  yamaguch 	struct pbranch _laggport_root = PBRANCH_INITIALIZER(&laggport_root,
    206  1.1  yamaguch 	    "laggport-root", laggport_brs, __arraycount(laggport_brs), true);
    207  1.1  yamaguch 	struct pbranch _lagglacp_root = PBRANCH_INITIALIZER(&lagglacp_root,
    208  1.1  yamaguch 	    "lagglacp-root", lagglacp_brs, __arraycount(lagglacp_brs), true);
    209  1.1  yamaguch 	struct pbranch _laggfail_root = PBRANCH_INITIALIZER(&laggfail_root,
    210  1.1  yamaguch 	    "laggfail-root", laggfail_brs, __arraycount(laggfail_brs), true);
    211  1.1  yamaguch 
    212  1.1  yamaguch 	laggport_root = _laggport_root;
    213  1.1  yamaguch 	lagglacp_root = _lagglacp_root;
    214  1.1  yamaguch 	laggfail_root = _laggfail_root;
    215  1.1  yamaguch 
    216  1.1  yamaguch 	cmdloop_branch_init(&branch, &lagg.pk_parser);
    217  1.1  yamaguch 	status_func_init(&status, lagg_status);
    218  1.1  yamaguch 	usage_func_init(&usage, lagg_usage);
    219  1.1  yamaguch 
    220  1.1  yamaguch 	register_cmdloop_branch(&branch);
    221  1.1  yamaguch 	register_status(&status);
    222  1.1  yamaguch 	register_usage(&usage);
    223  1.1  yamaguch }
    224  1.1  yamaguch 
    225  1.1  yamaguch static int
    226  1.1  yamaguch is_laggif(prop_dictionary_t env)
    227  1.1  yamaguch {
    228  1.1  yamaguch 	const char *ifname;
    229  1.1  yamaguch 	size_t i, len;
    230  1.1  yamaguch 
    231  1.1  yamaguch 	if ((ifname = getifname(env)) == NULL)
    232  1.1  yamaguch 		return 0;
    233  1.1  yamaguch 
    234  1.1  yamaguch 	if (strncmp(ifname, "lagg", 4) != 0)
    235  1.1  yamaguch 		return 0;
    236  1.1  yamaguch 
    237  1.1  yamaguch 	len = strlen(ifname);
    238  1.1  yamaguch 	for (i = 4; i < len; i++) {
    239  1.1  yamaguch 		if (!isdigit((unsigned char)ifname[i]))
    240  1.1  yamaguch 			return 0;
    241  1.1  yamaguch 	}
    242  1.1  yamaguch 
    243  1.1  yamaguch 	return 1;
    244  1.1  yamaguch }
    245  1.1  yamaguch 
    246  1.1  yamaguch static struct lagg_req *
    247  1.1  yamaguch getlagg(prop_dictionary_t env)
    248  1.1  yamaguch {
    249  1.1  yamaguch 	struct lagg_req *req = NULL, *p;
    250  1.1  yamaguch 	size_t nports, bufsiz;
    251  1.1  yamaguch 	int i;
    252  1.1  yamaguch 
    253  1.1  yamaguch 	if (!is_laggif(env)) {
    254  1.1  yamaguch 		if (lagg_debug)
    255  1.1  yamaguch 			warnx("valid only with lagg(4) interfaces");
    256  1.1  yamaguch 		goto done;
    257  1.1  yamaguch 	}
    258  1.1  yamaguch 
    259  1.1  yamaguch 	for (i = 0, nports = 0; i < LAGG_RETRY_MAX; i++) {
    260  1.1  yamaguch 		bufsiz = sizeof(*req);
    261  1.1  yamaguch 		bufsiz += sizeof(req->lrq_reqports[0]) * nports;
    262  1.1  yamaguch 		p = realloc(req, bufsiz);
    263  1.1  yamaguch 		if (p == NULL)
    264  1.1  yamaguch 			break;
    265  1.1  yamaguch 
    266  1.1  yamaguch 		req = p;
    267  1.1  yamaguch 		memset(req, 0, bufsiz);
    268  1.1  yamaguch 		req->lrq_nports = nports;
    269  1.1  yamaguch 		if (indirect_ioctl(env, SIOCGLAGG, req) == 0)
    270  1.1  yamaguch 			goto done;
    271  1.1  yamaguch 
    272  1.1  yamaguch 		if (errno != ENOMEM)
    273  1.1  yamaguch 			break;
    274  1.1  yamaguch 		nports = req->lrq_nports + 3; /* 3: additional space */
    275  1.1  yamaguch 	}
    276  1.1  yamaguch 
    277  1.1  yamaguch 	if (req != NULL) {
    278  1.1  yamaguch 		free(req);
    279  1.1  yamaguch 		req = NULL;
    280  1.1  yamaguch 	}
    281  1.1  yamaguch 
    282  1.1  yamaguch done:
    283  1.1  yamaguch 	return req;
    284  1.1  yamaguch }
    285  1.1  yamaguch 
    286  1.1  yamaguch static void
    287  1.1  yamaguch freelagg(struct lagg_req *req)
    288  1.1  yamaguch {
    289  1.1  yamaguch 
    290  1.1  yamaguch 	free(req);
    291  1.1  yamaguch }
    292  1.1  yamaguch 
    293  1.1  yamaguch static void
    294  1.1  yamaguch lagg_status(prop_dictionary_t env, prop_dictionary_t oenv)
    295  1.1  yamaguch {
    296  1.1  yamaguch 	struct lagg_req *req;
    297  1.1  yamaguch 	struct laggreqport *port;
    298  1.1  yamaguch 	const char *proto;
    299  1.1  yamaguch 	char str[256];
    300  1.1  yamaguch 	size_t i;
    301  1.1  yamaguch 
    302  1.1  yamaguch 	req = getlagg(env);
    303  1.1  yamaguch 	if (req == NULL)
    304  1.1  yamaguch 		return;
    305  1.1  yamaguch 
    306  1.1  yamaguch 	if (req->lrq_proto >= LAGG_PROTO_MAX ||
    307  1.1  yamaguch 	    (proto = laggprotostr[req->lrq_proto]) == NULL) {
    308  1.1  yamaguch 		proto = "unknown";
    309  1.1  yamaguch 	}
    310  1.1  yamaguch 
    311  1.1  yamaguch 	printf("\tlaggproto %s", proto);
    312  1.1  yamaguch 	if (vflag)
    313  1.1  yamaguch 		lagg_status_proto(req->lrq_proto, &req->lrq_reqproto);
    314  1.1  yamaguch 	putchar('\n');
    315  1.1  yamaguch 
    316  1.1  yamaguch 	if (req->lrq_nports > 0) {
    317  1.1  yamaguch 		printf("\tlaggport:\n");
    318  1.1  yamaguch 		for (i = 0; i < req->lrq_nports; i++) {
    319  1.1  yamaguch 			port = &req->lrq_reqports[i];
    320  1.1  yamaguch 			snprintb(str, sizeof(str),
    321  1.1  yamaguch 			    LAGG_PORT_BITS, port->rp_flags);
    322  1.1  yamaguch 
    323  1.1  yamaguch 			printf("\t\t%.*s pri=%u flags=%s",
    324  1.1  yamaguch 			    IFNAMSIZ, port->rp_portname,
    325  1.1  yamaguch 			    (unsigned int)port->rp_prio,
    326  1.1  yamaguch 			    str);
    327  1.1  yamaguch 			if (vflag)
    328  1.1  yamaguch 				lagg_status_port(req->lrq_proto, port);
    329  1.1  yamaguch 			putchar('\n');
    330  1.1  yamaguch 		}
    331  1.1  yamaguch 	}
    332  1.1  yamaguch 
    333  1.1  yamaguch 	freelagg(req);
    334  1.1  yamaguch }
    335  1.1  yamaguch 
    336  1.1  yamaguch static int
    337  1.1  yamaguch setlaggproto(prop_dictionary_t env, prop_dictionary_t oenv)
    338  1.1  yamaguch {
    339  1.1  yamaguch 	prop_object_t obj;
    340  1.1  yamaguch 	struct lagg_req req;
    341  1.1  yamaguch 	const char *proto;
    342  1.1  yamaguch 	size_t i, proto_len;
    343  1.1  yamaguch 
    344  1.1  yamaguch 	memset(&req, 0, sizeof(req));
    345  1.1  yamaguch 
    346  1.1  yamaguch 	obj = prop_dictionary_get(env, "laggproto");
    347  1.1  yamaguch 	if (obj == NULL) {
    348  1.1  yamaguch 		errno = ENOENT;
    349  1.1  yamaguch 		return -1;
    350  1.1  yamaguch 	}
    351  1.1  yamaguch 
    352  1.1  yamaguch 	switch (prop_object_type(obj)) {
    353  1.1  yamaguch 	case PROP_TYPE_DATA:
    354  1.1  yamaguch 		proto = prop_data_value(obj);
    355  1.1  yamaguch 		proto_len = prop_data_size(obj);
    356  1.1  yamaguch 		break;
    357  1.1  yamaguch 	case PROP_TYPE_STRING:
    358  1.1  yamaguch 		proto = prop_string_value(obj);
    359  1.1  yamaguch 		proto_len = prop_string_size(obj);
    360  1.1  yamaguch 		break;
    361  1.1  yamaguch 	default:
    362  1.1  yamaguch 		errno = EFAULT;
    363  1.1  yamaguch 		return -1;
    364  1.1  yamaguch 	}
    365  1.1  yamaguch 
    366  1.1  yamaguch 	for (i = 0; i < LAGG_PROTO_MAX; i++) {
    367  1.1  yamaguch 		if (strncmp(proto, laggprotostr[i], proto_len) == 0)
    368  1.1  yamaguch 			break;
    369  1.1  yamaguch 	}
    370  1.1  yamaguch 
    371  1.1  yamaguch 	if (i >= LAGG_PROTO_MAX) {
    372  1.1  yamaguch 		errno = EPROTONOSUPPORT;
    373  1.1  yamaguch 		return -1;
    374  1.1  yamaguch 	}
    375  1.1  yamaguch 
    376  1.1  yamaguch 	req.lrq_ioctl = LAGGIOC_SETPROTO;
    377  1.1  yamaguch 	req.lrq_proto = i;
    378  1.1  yamaguch 
    379  1.1  yamaguch 	if (indirect_ioctl(env, SIOCSLAGG, &req) == -1)
    380  1.1  yamaguch 		return -1;
    381  1.1  yamaguch 
    382  1.1  yamaguch 	return 0;
    383  1.1  yamaguch }
    384  1.1  yamaguch 
    385  1.1  yamaguch static int
    386  1.1  yamaguch setlaggport(prop_dictionary_t env, prop_dictionary_t oenv __unused)
    387  1.1  yamaguch {
    388  1.1  yamaguch 	struct lagg_req req;
    389  1.1  yamaguch 	struct laggreqport *rp;
    390  1.1  yamaguch 	const char *ifname;
    391  1.1  yamaguch 	enum lagg_ioctl ioc;
    392  1.1  yamaguch 	int64_t lpcmd, pri;
    393  1.1  yamaguch 
    394  1.2  christos 	if (!prop_dictionary_get_string(env, "laggport", &ifname)) {
    395  1.1  yamaguch 		if (lagg_debug)
    396  1.1  yamaguch 			warnx("%s.%d", __func__, __LINE__);
    397  1.1  yamaguch 		errno = ENOENT;
    398  1.1  yamaguch 		return -1;
    399  1.1  yamaguch 	}
    400  1.1  yamaguch 
    401  1.1  yamaguch 	memset(&req, 0, sizeof(req));
    402  1.1  yamaguch 	req.lrq_nports = 1;
    403  1.1  yamaguch 	rp = &req.lrq_reqports[0];
    404  1.1  yamaguch 	strlcpy(rp->rp_portname, ifname, sizeof(rp->rp_portname));
    405  1.1  yamaguch 	ioc = LAGGIOC_NOCMD;
    406  1.1  yamaguch 
    407  1.1  yamaguch 	if (prop_dictionary_get_int64(env, "laggportcmd", &lpcmd)) {
    408  1.1  yamaguch 		if (lpcmd == LAGGPORT_ADD) {
    409  1.1  yamaguch 			ioc = LAGGIOC_ADDPORT;
    410  1.1  yamaguch 		} else {
    411  1.1  yamaguch 			ioc = LAGGIOC_DELPORT;
    412  1.1  yamaguch 		}
    413  1.1  yamaguch 	}
    414  1.1  yamaguch 
    415  1.1  yamaguch 	if (prop_dictionary_get_int64(env, "laggportpri", &pri)) {
    416  1.1  yamaguch 		ioc = LAGGIOC_SETPORTPRI;
    417  1.1  yamaguch 		rp->rp_prio = (uint32_t)pri;
    418  1.1  yamaguch 	}
    419  1.1  yamaguch 
    420  1.1  yamaguch 	if (ioc != LAGGIOC_NOCMD) {
    421  1.1  yamaguch 		req.lrq_ioctl = ioc;
    422  1.1  yamaguch 		if (indirect_ioctl(env, SIOCSLAGG, &req) == -1) {
    423  1.1  yamaguch 			if (lagg_debug) {
    424  1.1  yamaguch 				warn("cmd=%d", ioc);
    425  1.1  yamaguch 			}
    426  1.1  yamaguch 			return -1;
    427  1.1  yamaguch 		}
    428  1.1  yamaguch 	}
    429  1.1  yamaguch 
    430  1.1  yamaguch 	return 0;
    431  1.1  yamaguch }
    432  1.1  yamaguch 
    433  1.1  yamaguch static int
    434  1.1  yamaguch setlagglacp(prop_dictionary_t env, prop_dictionary_t oenv __unused)
    435  1.1  yamaguch {
    436  1.1  yamaguch 	struct lagg_req req_add, req_del;
    437  1.1  yamaguch 	struct laggreq_lacp *add_lacp, *del_lacp;
    438  1.1  yamaguch 	int64_t v;
    439  1.1  yamaguch 
    440  1.1  yamaguch 	memset(&req_add, 0, sizeof(req_add));
    441  1.1  yamaguch 	memset(&req_del, 0, sizeof(req_del));
    442  1.1  yamaguch 
    443  1.1  yamaguch 	req_add.lrq_proto = req_del.lrq_proto = LAGG_PROTO_LACP;
    444  1.1  yamaguch 	req_add.lrq_ioctl = req_del.lrq_ioctl = LAGGIOC_SETPROTOOPT;
    445  1.1  yamaguch 	add_lacp = &req_add.lrq_reqproto.rp_lacp;
    446  1.1  yamaguch 	del_lacp = &req_del.lrq_reqproto.rp_lacp;
    447  1.1  yamaguch 
    448  1.1  yamaguch 	add_lacp->command = LAGGIOC_LACPSETFLAGS;
    449  1.1  yamaguch 	del_lacp->command = LAGGIOC_LACPCLRFLAGS;
    450  1.1  yamaguch 
    451  1.1  yamaguch 	if (prop_dictionary_get_int64(env, "lacpdumpdu", &v)) {
    452  1.1  yamaguch 		if (v == LAGGLACPOPT_DUMPDU) {
    453  1.1  yamaguch 			add_lacp->flags |= LAGGREQLACP_DUMPDU;
    454  1.1  yamaguch 		} else {
    455  1.1  yamaguch 			del_lacp->flags |= LAGGREQLACP_DUMPDU;
    456  1.1  yamaguch 		}
    457  1.1  yamaguch 	}
    458  1.1  yamaguch 
    459  1.1  yamaguch 	if (prop_dictionary_get_int64(env, "lacpstopdu", &v)) {
    460  1.1  yamaguch 		if (v == LAGGLACPOPT_STOPDU) {
    461  1.1  yamaguch 			add_lacp->flags |= LAGGREQLACP_STOPDU;
    462  1.1  yamaguch 		} else {
    463  1.1  yamaguch 			del_lacp->flags |= LAGGREQLACP_STOPDU;
    464  1.1  yamaguch 		}
    465  1.1  yamaguch 	}
    466  1.1  yamaguch 
    467  1.1  yamaguch 	if (prop_dictionary_get_int64(env, "lacpoptimistic", &v)) {
    468  1.1  yamaguch 		if (v == LAGGLACPOPT_OPTIMISTIC) {
    469  1.1  yamaguch 			add_lacp->flags |= LAGGREQLACP_OPTIMISTIC;
    470  1.1  yamaguch 		} else {
    471  1.1  yamaguch 			del_lacp->flags |= LAGGREQLACP_OPTIMISTIC;
    472  1.1  yamaguch 		}
    473  1.1  yamaguch 	}
    474  1.1  yamaguch 
    475  1.1  yamaguch 	if (prop_dictionary_get_int64(env, "lacpmultils", &v)) {
    476  1.1  yamaguch 		if (v == LAGGLACPOPT_MULTILS) {
    477  1.1  yamaguch 			add_lacp->flags |= LAGGREQLACP_MULTILS;
    478  1.1  yamaguch 		} else {
    479  1.1  yamaguch 			del_lacp->flags |= LAGGREQLACP_MULTILS;
    480  1.1  yamaguch 		}
    481  1.1  yamaguch 	}
    482  1.1  yamaguch 
    483  1.1  yamaguch 	if (del_lacp->flags != 0) {
    484  1.1  yamaguch 		if (indirect_ioctl(env, SIOCSLAGG, &req_del) == -1) {
    485  1.1  yamaguch 			if (lagg_debug) {
    486  1.1  yamaguch 				warn("cmd=%d, pcmd=%d",
    487  1.1  yamaguch 				    req_del.lrq_ioctl,
    488  1.1  yamaguch 				    del_lacp->command);
    489  1.1  yamaguch 			}
    490  1.1  yamaguch 			return -1;
    491  1.1  yamaguch 		}
    492  1.1  yamaguch 	}
    493  1.1  yamaguch 
    494  1.1  yamaguch 	if (add_lacp->flags != 0) {
    495  1.1  yamaguch 		if (indirect_ioctl(env, SIOCSLAGG, &req_add) == -1) {
    496  1.1  yamaguch 			if (lagg_debug) {
    497  1.1  yamaguch 				warn("cmd=%d, pcmd=%d",
    498  1.1  yamaguch 				    req_add.lrq_ioctl,
    499  1.1  yamaguch 				    add_lacp->command);
    500  1.1  yamaguch 			}
    501  1.1  yamaguch 			return -1;
    502  1.1  yamaguch 		}
    503  1.1  yamaguch 	}
    504  1.1  yamaguch 
    505  1.1  yamaguch 	return 0;
    506  1.1  yamaguch }
    507  1.1  yamaguch 
    508  1.1  yamaguch static int
    509  1.1  yamaguch setlagglacpmaxports(prop_dictionary_t env,
    510  1.1  yamaguch     prop_dictionary_t oenv __unused)
    511  1.1  yamaguch {
    512  1.1  yamaguch 	struct lagg_req req;
    513  1.1  yamaguch 	struct laggreq_lacp *lrq_lacp;
    514  1.1  yamaguch 	int64_t v;
    515  1.1  yamaguch 
    516  1.1  yamaguch 	memset(&req, 0, sizeof(req));
    517  1.1  yamaguch 	req.lrq_proto = LAGG_PROTO_LACP;
    518  1.1  yamaguch 	req.lrq_ioctl = LAGGIOC_SETPROTOOPT;
    519  1.1  yamaguch 	lrq_lacp = &req.lrq_reqproto.rp_lacp;
    520  1.1  yamaguch 
    521  1.1  yamaguch 	if (!prop_dictionary_get_int64(env, "lacpmaxports", &v)) {
    522  1.1  yamaguch 		if (lagg_debug)
    523  1.1  yamaguch 			warnx("%s.%d", __func__, __LINE__);
    524  1.1  yamaguch 		errno = ENOENT;
    525  1.1  yamaguch 		return -1;
    526  1.1  yamaguch 	}
    527  1.1  yamaguch 
    528  1.1  yamaguch 	if (v <= 0) {
    529  1.1  yamaguch 		lrq_lacp->command = LAGGIOC_LACPCLRMAXPORTS;
    530  1.1  yamaguch 	} else if (v > 0){
    531  1.1  yamaguch 		lrq_lacp->command = LAGGIOC_LACPSETMAXPORTS;
    532  1.1  yamaguch 		lrq_lacp->maxports = (size_t)v;
    533  1.1  yamaguch 	}
    534  1.1  yamaguch 
    535  1.1  yamaguch 	if (indirect_ioctl(env, SIOCSLAGG, &req) == -1) {
    536  1.1  yamaguch 		err(EXIT_FAILURE, "SIOCSLAGGPROTO");
    537  1.1  yamaguch 	}
    538  1.1  yamaguch 
    539  1.1  yamaguch 	return 0;
    540  1.1  yamaguch }
    541  1.1  yamaguch 
    542  1.1  yamaguch static int
    543  1.1  yamaguch setlaggfail(prop_dictionary_t env,
    544  1.1  yamaguch     prop_dictionary_t oenv __unused)
    545  1.1  yamaguch {
    546  1.1  yamaguch 	struct lagg_req req_add, req_del;
    547  1.1  yamaguch 	struct laggreq_fail *add_fail, *del_fail;
    548  1.1  yamaguch 	int64_t v;
    549  1.1  yamaguch 
    550  1.1  yamaguch 	memset(&req_add, 0, sizeof(req_add));
    551  1.1  yamaguch 	memset(&req_del, 0, sizeof(req_del));
    552  1.1  yamaguch 
    553  1.1  yamaguch 	req_add.lrq_proto = req_del.lrq_proto = LAGG_PROTO_FAILOVER;
    554  1.1  yamaguch 	req_add.lrq_ioctl = req_del.lrq_ioctl = LAGGIOC_SETPROTOOPT;
    555  1.1  yamaguch 	add_fail = &req_add.lrq_reqproto.rp_fail;
    556  1.1  yamaguch 	del_fail = &req_del.lrq_reqproto.rp_fail;
    557  1.1  yamaguch 
    558  1.1  yamaguch 	add_fail->command = LAGGIOC_FAILSETFLAGS;
    559  1.1  yamaguch 	del_fail->command = LAGGIOC_FAILCLRFLAGS;
    560  1.1  yamaguch 
    561  1.1  yamaguch 	if (prop_dictionary_get_int64(env, "failrxall", &v)) {
    562  1.1  yamaguch 		if (v == LAGGFAILOPT_RXALL) {
    563  1.1  yamaguch 			add_fail->flags |= LAGGREQFAIL_RXALL;
    564  1.1  yamaguch 		} else {
    565  1.1  yamaguch 			del_fail->flags |= LAGGREQFAIL_RXALL;
    566  1.1  yamaguch 		}
    567  1.1  yamaguch 	}
    568  1.1  yamaguch 
    569  1.1  yamaguch 	if (del_fail->flags != 0) {
    570  1.1  yamaguch 		if (indirect_ioctl(env, SIOCSLAGG, &req_del) == -1) {
    571  1.1  yamaguch 			if (lagg_debug) {
    572  1.1  yamaguch 				warn("cmd=%d, pcmd=%d",
    573  1.1  yamaguch 				    req_del.lrq_ioctl,
    574  1.1  yamaguch 				    del_fail->command);
    575  1.1  yamaguch 			}
    576  1.1  yamaguch 			return -1;
    577  1.1  yamaguch 		}
    578  1.1  yamaguch 	}
    579  1.1  yamaguch 
    580  1.1  yamaguch 	if (add_fail->flags != 0) {
    581  1.1  yamaguch 		if (indirect_ioctl(env, SIOCSLAGG, &req_add) == -1) {
    582  1.1  yamaguch 			if (lagg_debug) {
    583  1.1  yamaguch 				warn("cmd=%d, pcmd=%d",
    584  1.1  yamaguch 				    req_add.lrq_ioctl,
    585  1.1  yamaguch 				    add_fail->command);
    586  1.1  yamaguch 			}
    587  1.1  yamaguch 			return -1;
    588  1.1  yamaguch 		}
    589  1.1  yamaguch 	}
    590  1.1  yamaguch 
    591  1.1  yamaguch 	return 0;
    592  1.1  yamaguch }
    593  1.1  yamaguch 
    594  1.1  yamaguch static void
    595  1.1  yamaguch lagg_usage(prop_dictionary_t env __unused)
    596  1.1  yamaguch {
    597  1.1  yamaguch 
    598  1.1  yamaguch 	fprintf(stderr, "\t[ laggproto p ]\n");
    599  1.1  yamaguch 	fprintf(stderr, "\t[ laggport i [ pri n ] ] "
    600  1.1  yamaguch 	    "[ -laggport i ]\n");
    601  1.1  yamaguch 	fprintf(stderr, "\t[ laggportpri i [ pri n]]\n");
    602  1.1  yamaguch 	fprintf(stderr, "\t[ lagglacp [ dumpdu | -dumpdu ] "
    603  1.1  yamaguch 	    "[ stopdu | -stopdu ]\n"
    604  1.1  yamaguch 	    "\t\t[ maxports n | -maxports ] [ optimistic | -optimistic ] ]\n");
    605  1.1  yamaguch 	fprintf(stderr, "\t[ laggfailover] [ rx-all | -rx-all ]\n");
    606  1.1  yamaguch }
    607  1.1  yamaguch static void
    608  1.1  yamaguch lacp_format_id(char *buf, size_t len,
    609  1.1  yamaguch     uint16_t system_prio, uint8_t *system_mac, uint16_t system_key)
    610  1.1  yamaguch {
    611  1.1  yamaguch 
    612  1.1  yamaguch 	snprintf(buf, len, "[%04X,%02X-%02X-%02X-%02X-%02X-%02X,"
    613  1.1  yamaguch 	    "%04X]",
    614  1.1  yamaguch 	    system_prio,
    615  1.1  yamaguch 	    (unsigned int)system_mac[0],(unsigned int)system_mac[1],
    616  1.1  yamaguch 	    (unsigned int)system_mac[2],(unsigned int)system_mac[3],
    617  1.1  yamaguch 	    (unsigned int)system_mac[4],(unsigned int)system_mac[5],
    618  1.1  yamaguch 	    system_key);
    619  1.1  yamaguch }
    620  1.1  yamaguch 
    621  1.1  yamaguch static void
    622  1.1  yamaguch lagg_status_proto(lagg_proto pr, struct laggreqproto *req)
    623  1.1  yamaguch {
    624  1.1  yamaguch 	struct laggreq_lacp *lacp;
    625  1.1  yamaguch 	char str[256];
    626  1.1  yamaguch 
    627  1.1  yamaguch 	switch (pr) {
    628  1.1  yamaguch 	case LAGG_PROTO_LACP:
    629  1.1  yamaguch 		lacp = &req->rp_lacp;
    630  1.1  yamaguch 
    631  1.1  yamaguch 		printf("\n");
    632  1.1  yamaguch 		snprintb(str, sizeof(str), LAGGREQLACP_BITS,
    633  1.1  yamaguch 		    lacp->flags);
    634  1.1  yamaguch 		printf("\t\tmax ports=%zu, flags=%s\n",
    635  1.1  yamaguch 		    lacp->maxports, str);
    636  1.1  yamaguch 
    637  1.1  yamaguch 		lacp_format_id(str, sizeof(str), lacp->actor_prio,
    638  1.1  yamaguch 		    lacp->actor_mac, lacp->actor_key);
    639  1.1  yamaguch 		printf("\t\tactor=%s\n", str);
    640  1.1  yamaguch 
    641  1.1  yamaguch 		lacp_format_id(str, sizeof(str), lacp->partner_prio,
    642  1.1  yamaguch 		    lacp->partner_mac, lacp->partner_key);
    643  1.1  yamaguch 		printf("\t\tpartner=%s", str);
    644  1.1  yamaguch 		break;
    645  1.1  yamaguch 	default:
    646  1.1  yamaguch 		break;
    647  1.1  yamaguch 	}
    648  1.1  yamaguch }
    649  1.1  yamaguch 
    650  1.1  yamaguch static void
    651  1.1  yamaguch lagg_status_port(lagg_proto pr, struct laggreqport *req)
    652  1.1  yamaguch {
    653  1.1  yamaguch 	struct laggreq_lacpport *lacp;
    654  1.1  yamaguch 	char str[256];
    655  1.1  yamaguch 
    656  1.1  yamaguch 	switch (pr) {
    657  1.1  yamaguch 	case LAGG_PROTO_LACP:
    658  1.1  yamaguch 		lacp = &req->rp_lacpport;
    659  1.1  yamaguch 
    660  1.1  yamaguch 		putchar('\n');
    661  1.1  yamaguch 
    662  1.1  yamaguch 		snprintb(str, sizeof(str), LACP_STATE_BITS, lacp->actor_state);
    663  1.1  yamaguch 		printf("\t\t\tactor: state=%s\n",str);
    664  1.1  yamaguch 
    665  1.1  yamaguch 		lacp_format_id(str, sizeof(str), lacp->partner_prio,
    666  1.1  yamaguch 		    lacp->partner_mac, lacp->partner_key);
    667  1.1  yamaguch 		printf("\t\t\tpartner=%s\n", str);
    668  1.1  yamaguch 		snprintb(str, sizeof(str), LACP_STATE_BITS,
    669  1.1  yamaguch 		    lacp->partner_state);
    670  1.1  yamaguch 		printf("\t\t\tpartner: port=%04X prio=%04X state=%s",
    671  1.1  yamaguch 		    lacp->partner_portno, lacp->partner_portprio, str);
    672  1.1  yamaguch 		break;
    673  1.1  yamaguch 	default:
    674  1.1  yamaguch 		break;
    675  1.1  yamaguch 	}
    676  1.1  yamaguch }
    677