sbin/ifconfig/iflagg.c

   1 /*-
   2  */
   3
   4 #ifndef lint
   5 static const char rcsid[] =
   6   "$FreeBSD$";
   7 #endif /* not lint */
   8
   9 #include <sys/param.h>
  10 #include <sys/ioctl.h>
  11 #include <sys/socket.h>
  12 #include <sys/sockio.h>
  13
  14 #include <stdlib.h>
  15 #include <unistd.h>
  16
  17 #include <net/ethernet.h>
  18 #include <net/if.h>
  19 #include <net/if_lagg.h>
  20 #include <net/route.h>
  21
  22 #include <ctype.h>
  23 #include <stdio.h>
  24 #include <string.h>
  25 #include <stdlib.h>
  26 #include <unistd.h>
  27 #include <err.h>
  28 #include <errno.h>
  29
  30 #include "ifconfig.h"
  31
  32 char lacpbuf[120];      /* LACP peer '[(a,a,a),(p,p,p)]' */
  33
  34 static void
  35 setlaggport(const char *val, int d, int s, const struct afswtch *afp)
  36 {
  37         struct lagg_reqport rp;
  38
  39         bzero(&rp, sizeof(rp));
  40         strlcpy(rp.rp_ifname, name, sizeof(rp.rp_ifname));
  41         strlcpy(rp.rp_portname, val, sizeof(rp.rp_portname));
  42
  43         /* Don't choke if the port is already in this lagg. */
  44         if (ioctl(s, SIOCSLAGGPORT, &rp) && errno != EEXIST)
  45                 err(1, "SIOCSLAGGPORT");
  46 }
  47
  48 static void
  49 unsetlaggport(const char *val, int d, int s, const struct afswtch *afp)
  50 {
  51         struct lagg_reqport rp;
  52
  53         bzero(&rp, sizeof(rp));
  54         strlcpy(rp.rp_ifname, name, sizeof(rp.rp_ifname));
  55         strlcpy(rp.rp_portname, val, sizeof(rp.rp_portname));
  56
  57         if (ioctl(s, SIOCSLAGGDELPORT, &rp))
  58                 err(1, "SIOCSLAGGDELPORT");
  59 }
  60
  61 static void
  62 setlaggproto(const char *val, int d, int s, const struct afswtch *afp)
  63 {
  64         struct lagg_protos lpr[] = LAGG_PROTOS;
  65         struct lagg_reqall ra;
  66         int i;
  67
  68         bzero(&ra, sizeof(ra));
  69         ra.ra_proto = LAGG_PROTO_MAX;
  70
  71         for (i = 0; i < nitems(lpr); i++) {
  72                 if (strcmp(val, lpr[i].lpr_name) == 0) {
  73                         ra.ra_proto = lpr[i].lpr_proto;
  74                         break;
  75                 }
  76         }
  77         if (ra.ra_proto == LAGG_PROTO_MAX)
  78                 errx(1, "Invalid aggregation protocol: %s", val);
  79
  80         strlcpy(ra.ra_ifname, name, sizeof(ra.ra_ifname));
  81         if (ioctl(s, SIOCSLAGG, &ra) != 0)
  82                 err(1, "SIOCSLAGG");
  83 }
  84
  85 static void
  86 setlaggflowidshift(const char *val, int d, int s, const struct afswtch *afp)
  87 {
  88         struct lagg_reqopts ro;
  89
  90         bzero(&ro, sizeof(ro));
  91         ro.ro_opts = LAGG_OPT_FLOWIDSHIFT;
  92         strlcpy(ro.ro_ifname, name, sizeof(ro.ro_ifname));
  93         ro.ro_flowid_shift = (int)strtol(val, NULL, 10);
  94         if (ro.ro_flowid_shift & ~LAGG_OPT_FLOWIDSHIFT_MASK)
  95                 errx(1, "Invalid flowid_shift option: %s", val);
  96
  97         if (ioctl(s, SIOCSLAGGOPTS, &ro) != 0)
  98                 err(1, "SIOCSLAGGOPTS");
  99 }
 100
 101 static void
 102 setlaggsetopt(const char *val, int d, int s, const struct afswtch *afp)
 103 {
 104         struct lagg_reqopts ro;
 105
 106         bzero(&ro, sizeof(ro));
 107         ro.ro_opts = d;
 108         switch (ro.ro_opts) {
 109         case LAGG_OPT_USE_FLOWID:
 110         case -LAGG_OPT_USE_FLOWID:
 111         case LAGG_OPT_LACP_STRICT:
 112         case -LAGG_OPT_LACP_STRICT:
 113         case LAGG_OPT_LACP_TXTEST:
 114         case -LAGG_OPT_LACP_TXTEST:
 115         case LAGG_OPT_LACP_RXTEST:
 116         case -LAGG_OPT_LACP_RXTEST:
 117                 break;
 118         default:
 119                 err(1, "Invalid lagg option");
 120         }
 121         strlcpy(ro.ro_ifname, name, sizeof(ro.ro_ifname));
 122
 123         if (ioctl(s, SIOCSLAGGOPTS, &ro) != 0)
 124                 err(1, "SIOCSLAGGOPTS");
 125 }
 126
 127 static void
 128 setlagghash(const char *val, int d, int s, const struct afswtch *afp)
 129 {
 130         struct lagg_reqflags rf;
 131         char *str, *tmp, *tok;
 132
 133
 134         rf.rf_flags = 0;
 135         str = tmp = strdup(val);
 136         while ((tok = strsep(&tmp, ",")) != NULL) {
 137                 if (strcmp(tok, "l2") == 0)
 138                         rf.rf_flags |= LAGG_F_HASHL2;
 139                 else if (strcmp(tok, "l3") == 0)
 140                         rf.rf_flags |= LAGG_F_HASHL3;
 141                 else if (strcmp(tok, "l4") == 0)
 142                         rf.rf_flags |= LAGG_F_HASHL4;
 143                 else
 144                         errx(1, "Invalid lagghash option: %s", tok);
 145         }
 146         free(str);
 147         if (rf.rf_flags == 0)
 148                 errx(1, "No lagghash options supplied");
 149
 150         strlcpy(rf.rf_ifname, name, sizeof(rf.rf_ifname));
 151         if (ioctl(s, SIOCSLAGGHASH, &rf))
 152                 err(1, "SIOCSLAGGHASH");
 153 }
 154
 155 static char *
 156 lacp_format_mac(const uint8_t *mac, char *buf, size_t buflen)
 157 {
 158         snprintf(buf, buflen, "%02X-%02X-%02X-%02X-%02X-%02X",
 159             (int)mac[0], (int)mac[1], (int)mac[2], (int)mac[3],
 160             (int)mac[4], (int)mac[5]);
 161
 162         return (buf);
 163 }
 164
 165 static char *
 166 lacp_format_peer(struct lacp_opreq *req, const char *sep)
 167 {
 168         char macbuf1[20];
 169         char macbuf2[20];
 170
 171         snprintf(lacpbuf, sizeof(lacpbuf),
 172             "[(%04X,%s,%04X,%04X,%04X),%s(%04X,%s,%04X,%04X,%04X)]",
 173             req->actor_prio,
 174             lacp_format_mac(req->actor_mac, macbuf1, sizeof(macbuf1)),
 175             req->actor_key, req->actor_portprio, req->actor_portno, sep,
 176             req->partner_prio,
 177             lacp_format_mac(req->partner_mac, macbuf2, sizeof(macbuf2)),
 178             req->partner_key, req->partner_portprio, req->partner_portno);
 179
 180         return(lacpbuf);
 181 }
 182
 183 static void
 184 lagg_status(int s)
 185 {
 186         struct lagg_protos lpr[] = LAGG_PROTOS;
 187         struct lagg_reqport rp, rpbuf[LAGG_MAX_PORTS];
 188         struct lagg_reqall ra;
 189         struct lagg_reqopts ro;
 190         struct lagg_reqflags rf;
 191         struct lacp_opreq *lp;
 192         const char *proto = "<unknown>";
 193         int i, isport = 0;
 194
 195         bzero(&rp, sizeof(rp));
 196         bzero(&ra, sizeof(ra));
 197         bzero(&ro, sizeof(ro));
 198
 199         strlcpy(rp.rp_ifname, name, sizeof(rp.rp_ifname));
 200         strlcpy(rp.rp_portname, name, sizeof(rp.rp_portname));
 201
 202         if (ioctl(s, SIOCGLAGGPORT, &rp) == 0)
 203                 isport = 1;
 204
 205         strlcpy(ra.ra_ifname, name, sizeof(ra.ra_ifname));
 206         ra.ra_size = sizeof(rpbuf);
 207         ra.ra_port = rpbuf;
 208
 209         strlcpy(ro.ro_ifname, name, sizeof(ro.ro_ifname));
 210         ioctl(s, SIOCGLAGGOPTS, &ro);
 211
 212         strlcpy(rf.rf_ifname, name, sizeof(rf.rf_ifname));
 213         if (ioctl(s, SIOCGLAGGFLAGS, &rf) != 0)
 214                 rf.rf_flags = 0;
 215
 216         if (ioctl(s, SIOCGLAGG, &ra) == 0) {
 217                 lp = (struct lacp_opreq *)&ra.ra_lacpreq;
 218
 219                 for (i = 0; i < nitems(lpr); i++) {
 220                         if (ra.ra_proto == lpr[i].lpr_proto) {
 221                                 proto = lpr[i].lpr_name;
 222                                 break;
 223                         }
 224                 }
 225
 226                 printf("\tlaggproto %s", proto);
 227                 if (rf.rf_flags & LAGG_F_HASHMASK) {
 228                         const char *sep = "";
 229
 230                         printf(" lagghash ");
 231                         if (rf.rf_flags & LAGG_F_HASHL2) {
 232                                 printf("%sl2", sep);
 233                                 sep = ",";
 234                         }
 235                         if (rf.rf_flags & LAGG_F_HASHL3) {
 236                                 printf("%sl3", sep);
 237                                 sep = ",";
 238                         }
 239                         if (rf.rf_flags & LAGG_F_HASHL4) {
 240                                 printf("%sl4", sep);
 241                                 sep = ",";
 242                         }
 243                 }
 244                 if (isport)
 245                         printf(" laggdev %s", rp.rp_ifname);
 246                 putchar('\n');
 247                 if (verbose) {
 248                         printf("\tlagg options:\n");
 249                         printf("\t\tuse_flowid: %d\n",
 250                             (ro.ro_opts & LAGG_OPT_USE_FLOWID) ? 1 : 0);
 251                         printf("\t\tflowid_shift: %d\n", ro.ro_flowid_shift);
 252                         switch (ra.ra_proto) {
 253                         case LAGG_PROTO_LACP:
 254                                 printf("\t\tlacp_strict: %d\n",
 255                                    (ro.ro_opts & LAGG_OPT_LACP_STRICT) ? 1 : 0);
 256                                 printf("\t\tlacp_rxtest: %d\n",
 257                                    (ro.ro_opts & LAGG_OPT_LACP_RXTEST) ? 1 : 0);
 258                                 printf("\t\tlacp_txtest: %d\n",
 259                                    (ro.ro_opts & LAGG_OPT_LACP_TXTEST) ? 1 : 0);
 260                         }
 261                         printf("\tlagg statistics:\n");
 262                         printf("\t\tactive ports: %d\n", ro.ro_active);
 263                         printf("\t\tflapping: %u\n", ro.ro_flapping);
 264                         if (ra.ra_proto == LAGG_PROTO_LACP) {
 265                                 printf("\tlag id: %s\n",
 266                                     lacp_format_peer(lp, "\n\t\t "));
 267                         }
 268                 }
 269
 270                 for (i = 0; i < ra.ra_ports; i++) {
 271                         lp = (struct lacp_opreq *)&rpbuf[i].rp_lacpreq;
 272                         printf("\tlaggport: %s ", rpbuf[i].rp_portname);
 273                         printb("flags", rpbuf[i].rp_flags, LAGG_PORT_BITS);
 274                         if (verbose && ra.ra_proto == LAGG_PROTO_LACP)
 275                                 printf(" state=%X", lp->actor_state);
 276                         putchar('\n');
 277                         if (verbose && ra.ra_proto == LAGG_PROTO_LACP)
 278                                 printf("\t\t%s\n",
 279                                     lacp_format_peer(lp, "\n\t\t "));
 280                 }
 281
 282                 if (0 /* XXX */) {
 283                         printf("\tsupported aggregation protocols:\n");
 284                         for (i = 0; i < (sizeof(lpr) / sizeof(lpr[0])); i++)
 285                                 printf("\t\tlaggproto %s\n", lpr[i].lpr_name);
 286                 }
 287         }
 288 }
 289
 290 static struct cmd lagg_cmds[] = {
 291         DEF_CMD_ARG("laggport",         setlaggport),
 292         DEF_CMD_ARG("-laggport",        unsetlaggport),
 293         DEF_CMD_ARG("laggproto",        setlaggproto),
 294         DEF_CMD_ARG("lagghash",         setlagghash),
 295         DEF_CMD("use_flowid",   LAGG_OPT_USE_FLOWID,    setlaggsetopt),
 296         DEF_CMD("-use_flowid",  -LAGG_OPT_USE_FLOWID,   setlaggsetopt),
 297         DEF_CMD("lacp_strict",  LAGG_OPT_LACP_STRICT,   setlaggsetopt),
 298         DEF_CMD("-lacp_strict", -LAGG_OPT_LACP_STRICT,  setlaggsetopt),
 299         DEF_CMD("lacp_txtest",  LAGG_OPT_LACP_TXTEST,   setlaggsetopt),
 300         DEF_CMD("-lacp_txtest", -LAGG_OPT_LACP_TXTEST,  setlaggsetopt),
 301         DEF_CMD("lacp_rxtest",  LAGG_OPT_LACP_RXTEST,   setlaggsetopt),
 302         DEF_CMD("-lacp_rxtest", -LAGG_OPT_LACP_RXTEST,  setlaggsetopt),
 303         DEF_CMD_ARG("flowid_shift",     setlaggflowidshift),
 304 };
 305 static struct afswtch af_lagg = {
 306         .af_name        = "af_lagg",
 307         .af_af          = AF_UNSPEC,
 308         .af_other_status = lagg_status,
 309 };
 310
 311 static __constructor void
 312 lagg_ctor(void)
 313 {
 314 #define N(a)    (sizeof(a) / sizeof(a[0]))
 315         int i;
 316
 317         for (i = 0; i < N(lagg_cmds);  i++)
 318                 cmd_register(&lagg_cmds[i]);
 319         af_register(&af_lagg);
 320 #undef N
 321 }