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