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