lagg.c revision 1.5 1 1.5 yamaguch /* $NetBSD: lagg.c,v 1.5 2024/04/04 07:55:32 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.5 yamaguch __RCSID("$NetBSD: lagg.c,v 1.5 2024/04/04 07:55:32 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.1 yamaguch nports = req->lrq_nports + 3; /* 3: additional space */
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 {
397 1.5 yamaguch struct lagg_req req;
398 1.5 yamaguch struct laggreqport port[1];
399 1.5 yamaguch } _req;
400 1.5 yamaguch struct lagg_req *req;
401 1.1 yamaguch struct laggreqport *rp;
402 1.1 yamaguch const char *ifname;
403 1.1 yamaguch enum lagg_ioctl ioc;
404 1.1 yamaguch int64_t lpcmd, pri;
405 1.1 yamaguch
406 1.2 christos if (!prop_dictionary_get_string(env, "laggport", &ifname)) {
407 1.1 yamaguch if (lagg_debug)
408 1.1 yamaguch warnx("%s.%d", __func__, __LINE__);
409 1.1 yamaguch errno = ENOENT;
410 1.1 yamaguch return -1;
411 1.1 yamaguch }
412 1.1 yamaguch
413 1.5 yamaguch memset(&_req, 0, sizeof(_req));
414 1.5 yamaguch req = (struct lagg_req *)&_req;
415 1.5 yamaguch rp = &req->lrq_reqports[0];
416 1.5 yamaguch
417 1.1 yamaguch strlcpy(rp->rp_portname, ifname, sizeof(rp->rp_portname));
418 1.1 yamaguch ioc = LAGGIOC_NOCMD;
419 1.1 yamaguch
420 1.1 yamaguch if (prop_dictionary_get_int64(env, "laggportcmd", &lpcmd)) {
421 1.1 yamaguch if (lpcmd == LAGGPORT_ADD) {
422 1.1 yamaguch ioc = LAGGIOC_ADDPORT;
423 1.1 yamaguch } else {
424 1.1 yamaguch ioc = LAGGIOC_DELPORT;
425 1.1 yamaguch }
426 1.1 yamaguch }
427 1.1 yamaguch
428 1.1 yamaguch if (prop_dictionary_get_int64(env, "laggportpri", &pri)) {
429 1.1 yamaguch ioc = LAGGIOC_SETPORTPRI;
430 1.1 yamaguch rp->rp_prio = (uint32_t)pri;
431 1.1 yamaguch }
432 1.1 yamaguch
433 1.1 yamaguch if (ioc != LAGGIOC_NOCMD) {
434 1.5 yamaguch req->lrq_ioctl = ioc;
435 1.5 yamaguch if (indirect_ioctl(env, SIOCSLAGG, req) == -1) {
436 1.1 yamaguch if (lagg_debug) {
437 1.1 yamaguch warn("cmd=%d", ioc);
438 1.1 yamaguch }
439 1.1 yamaguch return -1;
440 1.1 yamaguch }
441 1.1 yamaguch }
442 1.1 yamaguch
443 1.1 yamaguch return 0;
444 1.1 yamaguch }
445 1.1 yamaguch
446 1.1 yamaguch static int
447 1.1 yamaguch setlagglacp(prop_dictionary_t env, prop_dictionary_t oenv __unused)
448 1.1 yamaguch {
449 1.1 yamaguch struct lagg_req req_add, req_del;
450 1.1 yamaguch struct laggreq_lacp *add_lacp, *del_lacp;
451 1.1 yamaguch int64_t v;
452 1.1 yamaguch
453 1.1 yamaguch memset(&req_add, 0, sizeof(req_add));
454 1.1 yamaguch memset(&req_del, 0, sizeof(req_del));
455 1.1 yamaguch
456 1.1 yamaguch req_add.lrq_proto = req_del.lrq_proto = LAGG_PROTO_LACP;
457 1.1 yamaguch req_add.lrq_ioctl = req_del.lrq_ioctl = LAGGIOC_SETPROTOOPT;
458 1.1 yamaguch add_lacp = &req_add.lrq_reqproto.rp_lacp;
459 1.1 yamaguch del_lacp = &req_del.lrq_reqproto.rp_lacp;
460 1.1 yamaguch
461 1.1 yamaguch add_lacp->command = LAGGIOC_LACPSETFLAGS;
462 1.1 yamaguch del_lacp->command = LAGGIOC_LACPCLRFLAGS;
463 1.1 yamaguch
464 1.1 yamaguch if (prop_dictionary_get_int64(env, "lacpdumpdu", &v)) {
465 1.1 yamaguch if (v == LAGGLACPOPT_DUMPDU) {
466 1.1 yamaguch add_lacp->flags |= LAGGREQLACP_DUMPDU;
467 1.1 yamaguch } else {
468 1.1 yamaguch del_lacp->flags |= LAGGREQLACP_DUMPDU;
469 1.1 yamaguch }
470 1.1 yamaguch }
471 1.1 yamaguch
472 1.1 yamaguch if (prop_dictionary_get_int64(env, "lacpstopdu", &v)) {
473 1.1 yamaguch if (v == LAGGLACPOPT_STOPDU) {
474 1.1 yamaguch add_lacp->flags |= LAGGREQLACP_STOPDU;
475 1.1 yamaguch } else {
476 1.1 yamaguch del_lacp->flags |= LAGGREQLACP_STOPDU;
477 1.1 yamaguch }
478 1.1 yamaguch }
479 1.1 yamaguch
480 1.1 yamaguch if (prop_dictionary_get_int64(env, "lacpoptimistic", &v)) {
481 1.1 yamaguch if (v == LAGGLACPOPT_OPTIMISTIC) {
482 1.1 yamaguch add_lacp->flags |= LAGGREQLACP_OPTIMISTIC;
483 1.1 yamaguch } else {
484 1.1 yamaguch del_lacp->flags |= LAGGREQLACP_OPTIMISTIC;
485 1.1 yamaguch }
486 1.1 yamaguch }
487 1.1 yamaguch
488 1.1 yamaguch if (prop_dictionary_get_int64(env, "lacpmultils", &v)) {
489 1.1 yamaguch if (v == LAGGLACPOPT_MULTILS) {
490 1.1 yamaguch add_lacp->flags |= LAGGREQLACP_MULTILS;
491 1.1 yamaguch } else {
492 1.1 yamaguch del_lacp->flags |= LAGGREQLACP_MULTILS;
493 1.1 yamaguch }
494 1.1 yamaguch }
495 1.1 yamaguch
496 1.1 yamaguch if (del_lacp->flags != 0) {
497 1.1 yamaguch if (indirect_ioctl(env, SIOCSLAGG, &req_del) == -1) {
498 1.1 yamaguch if (lagg_debug) {
499 1.1 yamaguch warn("cmd=%d, pcmd=%d",
500 1.1 yamaguch req_del.lrq_ioctl,
501 1.1 yamaguch del_lacp->command);
502 1.1 yamaguch }
503 1.1 yamaguch return -1;
504 1.1 yamaguch }
505 1.1 yamaguch }
506 1.1 yamaguch
507 1.1 yamaguch if (add_lacp->flags != 0) {
508 1.1 yamaguch if (indirect_ioctl(env, SIOCSLAGG, &req_add) == -1) {
509 1.1 yamaguch if (lagg_debug) {
510 1.1 yamaguch warn("cmd=%d, pcmd=%d",
511 1.1 yamaguch req_add.lrq_ioctl,
512 1.1 yamaguch add_lacp->command);
513 1.1 yamaguch }
514 1.1 yamaguch return -1;
515 1.1 yamaguch }
516 1.1 yamaguch }
517 1.1 yamaguch
518 1.1 yamaguch return 0;
519 1.1 yamaguch }
520 1.1 yamaguch
521 1.1 yamaguch static int
522 1.1 yamaguch setlagglacpmaxports(prop_dictionary_t env,
523 1.1 yamaguch prop_dictionary_t oenv __unused)
524 1.1 yamaguch {
525 1.1 yamaguch struct lagg_req req;
526 1.1 yamaguch struct laggreq_lacp *lrq_lacp;
527 1.1 yamaguch int64_t v;
528 1.1 yamaguch
529 1.1 yamaguch memset(&req, 0, sizeof(req));
530 1.1 yamaguch req.lrq_proto = LAGG_PROTO_LACP;
531 1.1 yamaguch req.lrq_ioctl = LAGGIOC_SETPROTOOPT;
532 1.1 yamaguch lrq_lacp = &req.lrq_reqproto.rp_lacp;
533 1.1 yamaguch
534 1.1 yamaguch if (!prop_dictionary_get_int64(env, "lacpmaxports", &v)) {
535 1.1 yamaguch if (lagg_debug)
536 1.1 yamaguch warnx("%s.%d", __func__, __LINE__);
537 1.1 yamaguch errno = ENOENT;
538 1.1 yamaguch return -1;
539 1.1 yamaguch }
540 1.1 yamaguch
541 1.1 yamaguch if (v <= 0) {
542 1.1 yamaguch lrq_lacp->command = LAGGIOC_LACPCLRMAXPORTS;
543 1.1 yamaguch } else if (v > 0){
544 1.1 yamaguch lrq_lacp->command = LAGGIOC_LACPSETMAXPORTS;
545 1.1 yamaguch lrq_lacp->maxports = (size_t)v;
546 1.1 yamaguch }
547 1.1 yamaguch
548 1.1 yamaguch if (indirect_ioctl(env, SIOCSLAGG, &req) == -1) {
549 1.1 yamaguch err(EXIT_FAILURE, "SIOCSLAGGPROTO");
550 1.1 yamaguch }
551 1.1 yamaguch
552 1.1 yamaguch return 0;
553 1.1 yamaguch }
554 1.1 yamaguch
555 1.1 yamaguch static int
556 1.1 yamaguch setlaggfail(prop_dictionary_t env,
557 1.1 yamaguch prop_dictionary_t oenv __unused)
558 1.1 yamaguch {
559 1.1 yamaguch struct lagg_req req_add, req_del;
560 1.1 yamaguch struct laggreq_fail *add_fail, *del_fail;
561 1.1 yamaguch int64_t v;
562 1.1 yamaguch
563 1.1 yamaguch memset(&req_add, 0, sizeof(req_add));
564 1.1 yamaguch memset(&req_del, 0, sizeof(req_del));
565 1.1 yamaguch
566 1.1 yamaguch req_add.lrq_proto = req_del.lrq_proto = LAGG_PROTO_FAILOVER;
567 1.1 yamaguch req_add.lrq_ioctl = req_del.lrq_ioctl = LAGGIOC_SETPROTOOPT;
568 1.1 yamaguch add_fail = &req_add.lrq_reqproto.rp_fail;
569 1.1 yamaguch del_fail = &req_del.lrq_reqproto.rp_fail;
570 1.1 yamaguch
571 1.1 yamaguch add_fail->command = LAGGIOC_FAILSETFLAGS;
572 1.1 yamaguch del_fail->command = LAGGIOC_FAILCLRFLAGS;
573 1.1 yamaguch
574 1.1 yamaguch if (prop_dictionary_get_int64(env, "failrxall", &v)) {
575 1.1 yamaguch if (v == LAGGFAILOPT_RXALL) {
576 1.1 yamaguch add_fail->flags |= LAGGREQFAIL_RXALL;
577 1.1 yamaguch } else {
578 1.1 yamaguch del_fail->flags |= LAGGREQFAIL_RXALL;
579 1.1 yamaguch }
580 1.1 yamaguch }
581 1.1 yamaguch
582 1.1 yamaguch if (del_fail->flags != 0) {
583 1.1 yamaguch if (indirect_ioctl(env, SIOCSLAGG, &req_del) == -1) {
584 1.1 yamaguch if (lagg_debug) {
585 1.1 yamaguch warn("cmd=%d, pcmd=%d",
586 1.1 yamaguch req_del.lrq_ioctl,
587 1.1 yamaguch del_fail->command);
588 1.1 yamaguch }
589 1.1 yamaguch return -1;
590 1.1 yamaguch }
591 1.1 yamaguch }
592 1.1 yamaguch
593 1.1 yamaguch if (add_fail->flags != 0) {
594 1.1 yamaguch if (indirect_ioctl(env, SIOCSLAGG, &req_add) == -1) {
595 1.1 yamaguch if (lagg_debug) {
596 1.1 yamaguch warn("cmd=%d, pcmd=%d",
597 1.1 yamaguch req_add.lrq_ioctl,
598 1.1 yamaguch add_fail->command);
599 1.1 yamaguch }
600 1.1 yamaguch return -1;
601 1.1 yamaguch }
602 1.1 yamaguch }
603 1.1 yamaguch
604 1.1 yamaguch return 0;
605 1.1 yamaguch }
606 1.1 yamaguch
607 1.1 yamaguch static void
608 1.1 yamaguch lagg_usage(prop_dictionary_t env __unused)
609 1.1 yamaguch {
610 1.1 yamaguch
611 1.1 yamaguch fprintf(stderr, "\t[ laggproto p ]\n");
612 1.1 yamaguch fprintf(stderr, "\t[ laggport i [ pri n ] ] "
613 1.1 yamaguch "[ -laggport i ]\n");
614 1.1 yamaguch fprintf(stderr, "\t[ laggportpri i [ pri n]]\n");
615 1.1 yamaguch fprintf(stderr, "\t[ lagglacp [ dumpdu | -dumpdu ] "
616 1.1 yamaguch "[ stopdu | -stopdu ]\n"
617 1.1 yamaguch "\t\t[ maxports n | -maxports ] [ optimistic | -optimistic ] ]\n");
618 1.1 yamaguch fprintf(stderr, "\t[ laggfailover] [ rx-all | -rx-all ]\n");
619 1.1 yamaguch }
620 1.1 yamaguch static void
621 1.1 yamaguch lacp_format_id(char *buf, size_t len,
622 1.1 yamaguch uint16_t system_prio, uint8_t *system_mac, uint16_t system_key)
623 1.1 yamaguch {
624 1.1 yamaguch
625 1.1 yamaguch snprintf(buf, len, "[%04X,%02X-%02X-%02X-%02X-%02X-%02X,"
626 1.1 yamaguch "%04X]",
627 1.1 yamaguch system_prio,
628 1.1 yamaguch (unsigned int)system_mac[0],(unsigned int)system_mac[1],
629 1.1 yamaguch (unsigned int)system_mac[2],(unsigned int)system_mac[3],
630 1.1 yamaguch (unsigned int)system_mac[4],(unsigned int)system_mac[5],
631 1.1 yamaguch system_key);
632 1.1 yamaguch }
633 1.1 yamaguch
634 1.1 yamaguch static void
635 1.1 yamaguch lagg_status_proto(lagg_proto pr, struct laggreqproto *req)
636 1.1 yamaguch {
637 1.1 yamaguch struct laggreq_lacp *lacp;
638 1.1 yamaguch char str[256];
639 1.1 yamaguch
640 1.1 yamaguch switch (pr) {
641 1.1 yamaguch case LAGG_PROTO_LACP:
642 1.1 yamaguch lacp = &req->rp_lacp;
643 1.1 yamaguch
644 1.1 yamaguch printf("\n");
645 1.1 yamaguch snprintb(str, sizeof(str), LAGGREQLACP_BITS,
646 1.1 yamaguch lacp->flags);
647 1.1 yamaguch printf("\t\tmax ports=%zu, flags=%s\n",
648 1.1 yamaguch lacp->maxports, str);
649 1.1 yamaguch
650 1.1 yamaguch lacp_format_id(str, sizeof(str), lacp->actor_prio,
651 1.1 yamaguch lacp->actor_mac, lacp->actor_key);
652 1.1 yamaguch printf("\t\tactor=%s\n", str);
653 1.1 yamaguch
654 1.1 yamaguch lacp_format_id(str, sizeof(str), lacp->partner_prio,
655 1.1 yamaguch lacp->partner_mac, lacp->partner_key);
656 1.1 yamaguch printf("\t\tpartner=%s", str);
657 1.1 yamaguch break;
658 1.1 yamaguch default:
659 1.1 yamaguch break;
660 1.1 yamaguch }
661 1.1 yamaguch }
662 1.1 yamaguch
663 1.1 yamaguch static void
664 1.1 yamaguch lagg_status_port(lagg_proto pr, struct laggreqport *req)
665 1.1 yamaguch {
666 1.1 yamaguch struct laggreq_lacpport *lacp;
667 1.1 yamaguch char str[256];
668 1.1 yamaguch
669 1.1 yamaguch switch (pr) {
670 1.1 yamaguch case LAGG_PROTO_LACP:
671 1.1 yamaguch lacp = &req->rp_lacpport;
672 1.1 yamaguch
673 1.1 yamaguch putchar('\n');
674 1.1 yamaguch
675 1.1 yamaguch snprintb(str, sizeof(str), LACP_STATE_BITS, lacp->actor_state);
676 1.1 yamaguch printf("\t\t\tactor: state=%s\n",str);
677 1.1 yamaguch
678 1.1 yamaguch lacp_format_id(str, sizeof(str), lacp->partner_prio,
679 1.1 yamaguch lacp->partner_mac, lacp->partner_key);
680 1.1 yamaguch printf("\t\t\tpartner=%s\n", str);
681 1.1 yamaguch snprintb(str, sizeof(str), LACP_STATE_BITS,
682 1.1 yamaguch lacp->partner_state);
683 1.1 yamaguch printf("\t\t\tpartner: port=%04X prio=%04X state=%s",
684 1.1 yamaguch lacp->partner_portno, lacp->partner_portprio, str);
685 1.1 yamaguch break;
686 1.1 yamaguch default:
687 1.1 yamaguch break;
688 1.1 yamaguch }
689 1.1 yamaguch }
690