150b1e235SMarkus Pfeiffer /*-
2bde0ea86SSascha Wildner * $FreeBSD: head/sbin/ifconfig/iflagg.c 249897 2013-04-25 16:34:04Z glebius $
350b1e235SMarkus Pfeiffer */
450b1e235SMarkus Pfeiffer
550b1e235SMarkus Pfeiffer #include <sys/param.h>
650b1e235SMarkus Pfeiffer #include <sys/ioctl.h>
750b1e235SMarkus Pfeiffer #include <sys/socket.h>
850b1e235SMarkus Pfeiffer #include <sys/sockio.h>
950b1e235SMarkus Pfeiffer
1050b1e235SMarkus Pfeiffer #include <net/if.h>
1150b1e235SMarkus Pfeiffer #include <net/route.h>
1246158ff5SAaron LI #include <net/ethernet.h>
1346158ff5SAaron LI #include <net/lagg/if_lagg.h>
1450b1e235SMarkus Pfeiffer
1550b1e235SMarkus Pfeiffer #include <ctype.h>
1650b1e235SMarkus Pfeiffer #include <stdio.h>
1750b1e235SMarkus Pfeiffer #include <string.h>
1846158ff5SAaron LI #include <stdlib.h>
1946158ff5SAaron LI #include <stdbool.h>
2046158ff5SAaron LI #include <unistd.h>
2150b1e235SMarkus Pfeiffer #include <err.h>
2250b1e235SMarkus Pfeiffer #include <errno.h>
2350b1e235SMarkus Pfeiffer
2450b1e235SMarkus Pfeiffer #include "ifconfig.h"
2550b1e235SMarkus Pfeiffer
26e59a93fdSAaron LI static char lacpbuf[120]; /* LACP peer '[(a,a,a),(p,p,p)]' */
2750b1e235SMarkus Pfeiffer
2850b1e235SMarkus Pfeiffer static void
setlaggport(const char * val,int d __unused,int s,const struct afswtch * afp __unused)2963f85492SAaron LI setlaggport(const char *val, int d __unused, int s,
3063f85492SAaron LI const struct afswtch *afp __unused)
3150b1e235SMarkus Pfeiffer {
3250b1e235SMarkus Pfeiffer struct lagg_reqport rp;
3350b1e235SMarkus Pfeiffer
34*0989c651SAaron LI memset(&rp, 0, sizeof(rp));
357203d4e3SAaron LI strlcpy(rp.rp_ifname, IfName, sizeof(rp.rp_ifname));
3650b1e235SMarkus Pfeiffer strlcpy(rp.rp_portname, val, sizeof(rp.rp_portname));
3750b1e235SMarkus Pfeiffer
38598a666bSAaron LI /*
39598a666bSAaron LI * Do not exit with an error here. Doing so permits a failed NIC
40598a666bSAaron LI * to take down an entire lagg.
41598a666bSAaron LI *
42598a666bSAaron LI * Don't error at all if the port is already in the lagg.
43598a666bSAaron LI */
44598a666bSAaron LI if (ioctl(s, SIOCSLAGGPORT, &rp) && errno != EEXIST) {
45598a666bSAaron LI warnx("%s %s: SIOCSLAGGPORT: %s",
467203d4e3SAaron LI IfName, val, strerror(errno));
47598a666bSAaron LI exit_code = 1;
48598a666bSAaron LI }
4950b1e235SMarkus Pfeiffer }
5050b1e235SMarkus Pfeiffer
5150b1e235SMarkus Pfeiffer static void
unsetlaggport(const char * val,int d __unused,int s,const struct afswtch * afp __unused)5263f85492SAaron LI unsetlaggport(const char *val, int d __unused, int s,
5363f85492SAaron LI const struct afswtch *afp __unused)
5450b1e235SMarkus Pfeiffer {
5550b1e235SMarkus Pfeiffer struct lagg_reqport rp;
5650b1e235SMarkus Pfeiffer
57*0989c651SAaron LI memset(&rp, 0, sizeof(rp));
587203d4e3SAaron LI strlcpy(rp.rp_ifname, IfName, sizeof(rp.rp_ifname));
5950b1e235SMarkus Pfeiffer strlcpy(rp.rp_portname, val, sizeof(rp.rp_portname));
6050b1e235SMarkus Pfeiffer
6150b1e235SMarkus Pfeiffer if (ioctl(s, SIOCSLAGGDELPORT, &rp))
6250b1e235SMarkus Pfeiffer err(1, "SIOCSLAGGDELPORT");
6350b1e235SMarkus Pfeiffer }
6450b1e235SMarkus Pfeiffer
6550b1e235SMarkus Pfeiffer static void
setlaggproto(const char * val,int d __unused,int s,const struct afswtch * afp __unused)6663f85492SAaron LI setlaggproto(const char *val, int d __unused, int s,
6763f85492SAaron LI const struct afswtch *afp __unused)
6850b1e235SMarkus Pfeiffer {
6950b1e235SMarkus Pfeiffer struct lagg_protos lpr[] = LAGG_PROTOS;
7050b1e235SMarkus Pfeiffer struct lagg_reqall ra;
7146158ff5SAaron LI size_t i;
7250b1e235SMarkus Pfeiffer
73*0989c651SAaron LI memset(&ra, 0, sizeof(ra));
7450b1e235SMarkus Pfeiffer ra.ra_proto = LAGG_PROTO_MAX;
7550b1e235SMarkus Pfeiffer
76b6b91ec7SAaron LI for (i = 0; i < nitems(lpr); i++) {
7750b1e235SMarkus Pfeiffer if (strcmp(val, lpr[i].lpr_name) == 0) {
7850b1e235SMarkus Pfeiffer ra.ra_proto = lpr[i].lpr_proto;
7950b1e235SMarkus Pfeiffer break;
8050b1e235SMarkus Pfeiffer }
8150b1e235SMarkus Pfeiffer }
8250b1e235SMarkus Pfeiffer if (ra.ra_proto == LAGG_PROTO_MAX)
8350b1e235SMarkus Pfeiffer errx(1, "Invalid aggregation protocol: %s", val);
8450b1e235SMarkus Pfeiffer
857203d4e3SAaron LI strlcpy(ra.ra_ifname, IfName, sizeof(ra.ra_ifname));
8650b1e235SMarkus Pfeiffer if (ioctl(s, SIOCSLAGG, &ra) != 0)
8750b1e235SMarkus Pfeiffer err(1, "SIOCSLAGG");
8850b1e235SMarkus Pfeiffer }
8950b1e235SMarkus Pfeiffer
9050b1e235SMarkus Pfeiffer static void
setlagghash(const char * val,int d __unused,int s,const struct afswtch * afp __unused)9163f85492SAaron LI setlagghash(const char *val, int d __unused, int s,
9263f85492SAaron LI const struct afswtch *afp __unused)
9350b1e235SMarkus Pfeiffer {
9450b1e235SMarkus Pfeiffer struct lagg_reqflags rf;
9550b1e235SMarkus Pfeiffer char *str, *tmp, *tok;
9650b1e235SMarkus Pfeiffer
9750b1e235SMarkus Pfeiffer rf.rf_flags = 0;
9850b1e235SMarkus Pfeiffer str = tmp = strdup(val);
9950b1e235SMarkus Pfeiffer while ((tok = strsep(&tmp, ",")) != NULL) {
10050b1e235SMarkus Pfeiffer if (strcmp(tok, "l2") == 0)
10150b1e235SMarkus Pfeiffer rf.rf_flags |= LAGG_F_HASHL2;
10250b1e235SMarkus Pfeiffer else if (strcmp(tok, "l3") == 0)
10350b1e235SMarkus Pfeiffer rf.rf_flags |= LAGG_F_HASHL3;
10450b1e235SMarkus Pfeiffer else if (strcmp(tok, "l4") == 0)
10550b1e235SMarkus Pfeiffer rf.rf_flags |= LAGG_F_HASHL4;
10650b1e235SMarkus Pfeiffer else
10750b1e235SMarkus Pfeiffer errx(1, "Invalid lagghash option: %s", tok);
10850b1e235SMarkus Pfeiffer }
10950b1e235SMarkus Pfeiffer free(str);
11050b1e235SMarkus Pfeiffer if (rf.rf_flags == 0)
11150b1e235SMarkus Pfeiffer errx(1, "No lagghash options supplied");
11250b1e235SMarkus Pfeiffer
1137203d4e3SAaron LI strlcpy(rf.rf_ifname, IfName, sizeof(rf.rf_ifname));
11450b1e235SMarkus Pfeiffer if (ioctl(s, SIOCSLAGGHASH, &rf))
11550b1e235SMarkus Pfeiffer err(1, "SIOCSLAGGHASH");
11650b1e235SMarkus Pfeiffer }
11750b1e235SMarkus Pfeiffer
11850b1e235SMarkus Pfeiffer static char *
lacp_format_mac(const uint8_t * mac,char * buf,size_t buflen)11950b1e235SMarkus Pfeiffer lacp_format_mac(const uint8_t *mac, char *buf, size_t buflen)
12050b1e235SMarkus Pfeiffer {
12150b1e235SMarkus Pfeiffer snprintf(buf, buflen, "%02X-%02X-%02X-%02X-%02X-%02X",
12250b1e235SMarkus Pfeiffer (int)mac[0], (int)mac[1], (int)mac[2], (int)mac[3],
12350b1e235SMarkus Pfeiffer (int)mac[4], (int)mac[5]);
12450b1e235SMarkus Pfeiffer
12550b1e235SMarkus Pfeiffer return (buf);
12650b1e235SMarkus Pfeiffer }
12750b1e235SMarkus Pfeiffer
12850b1e235SMarkus Pfeiffer static char *
lacp_format_peer(struct lacp_opreq * req,const char * sep)12950b1e235SMarkus Pfeiffer lacp_format_peer(struct lacp_opreq *req, const char *sep)
13050b1e235SMarkus Pfeiffer {
13150b1e235SMarkus Pfeiffer char macbuf1[20];
13250b1e235SMarkus Pfeiffer char macbuf2[20];
13350b1e235SMarkus Pfeiffer
13450b1e235SMarkus Pfeiffer snprintf(lacpbuf, sizeof(lacpbuf),
13550b1e235SMarkus Pfeiffer "[(%04X,%s,%04X,%04X,%04X),%s(%04X,%s,%04X,%04X,%04X)]",
13650b1e235SMarkus Pfeiffer req->actor_prio,
13750b1e235SMarkus Pfeiffer lacp_format_mac(req->actor_mac, macbuf1, sizeof(macbuf1)),
13850b1e235SMarkus Pfeiffer req->actor_key, req->actor_portprio, req->actor_portno, sep,
13950b1e235SMarkus Pfeiffer req->partner_prio,
14050b1e235SMarkus Pfeiffer lacp_format_mac(req->partner_mac, macbuf2, sizeof(macbuf2)),
14150b1e235SMarkus Pfeiffer req->partner_key, req->partner_portprio, req->partner_portno);
14250b1e235SMarkus Pfeiffer
14350b1e235SMarkus Pfeiffer return(lacpbuf);
14450b1e235SMarkus Pfeiffer }
14550b1e235SMarkus Pfeiffer
14650b1e235SMarkus Pfeiffer static void
lagg_status(int s)14750b1e235SMarkus Pfeiffer lagg_status(int s)
14850b1e235SMarkus Pfeiffer {
14950b1e235SMarkus Pfeiffer struct lagg_protos lpr[] = LAGG_PROTOS;
15050b1e235SMarkus Pfeiffer struct lagg_reqport rp, rpbuf[LAGG_MAX_PORTS];
15150b1e235SMarkus Pfeiffer struct lagg_reqall ra;
15250b1e235SMarkus Pfeiffer struct lagg_reqflags rf;
15350b1e235SMarkus Pfeiffer struct lacp_opreq *lp;
15450b1e235SMarkus Pfeiffer const char *proto = "<unknown>";
15546158ff5SAaron LI bool isport = false;
15646158ff5SAaron LI size_t i;
15750b1e235SMarkus Pfeiffer
158*0989c651SAaron LI memset(&rp, 0, sizeof(rp));
159*0989c651SAaron LI memset(&ra, 0, sizeof(ra));
16050b1e235SMarkus Pfeiffer
1617203d4e3SAaron LI strlcpy(rp.rp_ifname, IfName, sizeof(rp.rp_ifname));
1627203d4e3SAaron LI strlcpy(rp.rp_portname, IfName, sizeof(rp.rp_portname));
16350b1e235SMarkus Pfeiffer
16450b1e235SMarkus Pfeiffer if (ioctl(s, SIOCGLAGGPORT, &rp) == 0)
16546158ff5SAaron LI isport = true;
16650b1e235SMarkus Pfeiffer
1677203d4e3SAaron LI strlcpy(ra.ra_ifname, IfName, sizeof(ra.ra_ifname));
16850b1e235SMarkus Pfeiffer ra.ra_size = sizeof(rpbuf);
16950b1e235SMarkus Pfeiffer ra.ra_port = rpbuf;
17050b1e235SMarkus Pfeiffer
1717203d4e3SAaron LI strlcpy(rf.rf_ifname, IfName, sizeof(rf.rf_ifname));
17250b1e235SMarkus Pfeiffer if (ioctl(s, SIOCGLAGGFLAGS, &rf) != 0)
17350b1e235SMarkus Pfeiffer rf.rf_flags = 0;
17450b1e235SMarkus Pfeiffer
17550b1e235SMarkus Pfeiffer if (ioctl(s, SIOCGLAGG, &ra) == 0) {
17650b1e235SMarkus Pfeiffer lp = (struct lacp_opreq *)&ra.ra_lacpreq;
17750b1e235SMarkus Pfeiffer
178b6b91ec7SAaron LI for (i = 0; i < nitems(lpr); i++) {
17946158ff5SAaron LI if ((int)ra.ra_proto == lpr[i].lpr_proto) {
18050b1e235SMarkus Pfeiffer proto = lpr[i].lpr_name;
18150b1e235SMarkus Pfeiffer break;
18250b1e235SMarkus Pfeiffer }
18350b1e235SMarkus Pfeiffer }
18450b1e235SMarkus Pfeiffer
18550b1e235SMarkus Pfeiffer printf("\tlaggproto %s", proto);
18650b1e235SMarkus Pfeiffer if (rf.rf_flags & LAGG_F_HASHMASK) {
18750b1e235SMarkus Pfeiffer const char *sep = "";
18850b1e235SMarkus Pfeiffer
18950b1e235SMarkus Pfeiffer printf(" lagghash ");
19050b1e235SMarkus Pfeiffer if (rf.rf_flags & LAGG_F_HASHL2) {
19150b1e235SMarkus Pfeiffer printf("%sl2", sep);
19250b1e235SMarkus Pfeiffer sep = ",";
19350b1e235SMarkus Pfeiffer }
19450b1e235SMarkus Pfeiffer if (rf.rf_flags & LAGG_F_HASHL3) {
19550b1e235SMarkus Pfeiffer printf("%sl3", sep);
19650b1e235SMarkus Pfeiffer sep = ",";
19750b1e235SMarkus Pfeiffer }
19850b1e235SMarkus Pfeiffer if (rf.rf_flags & LAGG_F_HASHL4) {
19950b1e235SMarkus Pfeiffer printf("%sl4", sep);
20050b1e235SMarkus Pfeiffer sep = ",";
20150b1e235SMarkus Pfeiffer }
20250b1e235SMarkus Pfeiffer }
20350b1e235SMarkus Pfeiffer if (isport)
20450b1e235SMarkus Pfeiffer printf(" laggdev %s", rp.rp_ifname);
20550b1e235SMarkus Pfeiffer putchar('\n');
20650b1e235SMarkus Pfeiffer if (verbose && ra.ra_proto == LAGG_PROTO_LACP)
20750b1e235SMarkus Pfeiffer printf("\tlag id: %s\n",
20850b1e235SMarkus Pfeiffer lacp_format_peer(lp, "\n\t\t "));
20950b1e235SMarkus Pfeiffer
21046158ff5SAaron LI for (i = 0; i < (size_t)ra.ra_ports; i++) {
21150b1e235SMarkus Pfeiffer lp = (struct lacp_opreq *)&rpbuf[i].rp_lacpreq;
21250b1e235SMarkus Pfeiffer printf("\tlaggport: %s ", rpbuf[i].rp_portname);
21350b1e235SMarkus Pfeiffer printb("flags", rpbuf[i].rp_flags, LAGG_PORT_BITS);
21450b1e235SMarkus Pfeiffer if (verbose && ra.ra_proto == LAGG_PROTO_LACP)
21550b1e235SMarkus Pfeiffer printf(" state=%X", lp->actor_state);
21650b1e235SMarkus Pfeiffer putchar('\n');
21750b1e235SMarkus Pfeiffer if (verbose && ra.ra_proto == LAGG_PROTO_LACP)
21850b1e235SMarkus Pfeiffer printf("\t\t%s\n",
21950b1e235SMarkus Pfeiffer lacp_format_peer(lp, "\n\t\t "));
22050b1e235SMarkus Pfeiffer }
22150b1e235SMarkus Pfeiffer
22250b1e235SMarkus Pfeiffer if (0 /* XXX */) {
22350b1e235SMarkus Pfeiffer printf("\tsupported aggregation protocols:\n");
224b6b91ec7SAaron LI for (i = 0; i < nitems(lpr); i++)
22550b1e235SMarkus Pfeiffer printf("\t\tlaggproto %s\n", lpr[i].lpr_name);
22650b1e235SMarkus Pfeiffer }
22750b1e235SMarkus Pfeiffer }
22850b1e235SMarkus Pfeiffer }
22950b1e235SMarkus Pfeiffer
23050b1e235SMarkus Pfeiffer static struct cmd lagg_cmds[] = {
23150b1e235SMarkus Pfeiffer DEF_CMD_ARG("laggport", setlaggport),
23250b1e235SMarkus Pfeiffer DEF_CMD_ARG("-laggport", unsetlaggport),
23350b1e235SMarkus Pfeiffer DEF_CMD_ARG("laggproto", setlaggproto),
23450b1e235SMarkus Pfeiffer DEF_CMD_ARG("lagghash", setlagghash),
23550b1e235SMarkus Pfeiffer };
23650b1e235SMarkus Pfeiffer static struct afswtch af_lagg = {
23750b1e235SMarkus Pfeiffer .af_name = "af_lagg",
23850b1e235SMarkus Pfeiffer .af_af = AF_UNSPEC,
23950b1e235SMarkus Pfeiffer .af_other_status = lagg_status,
24050b1e235SMarkus Pfeiffer };
24150b1e235SMarkus Pfeiffer
242ec7e0eebSAaron LI __constructor(142)
243ec7e0eebSAaron LI static void
lagg_ctor(void)24450b1e235SMarkus Pfeiffer lagg_ctor(void)
24550b1e235SMarkus Pfeiffer {
24646158ff5SAaron LI size_t i;
24750b1e235SMarkus Pfeiffer
248b6b91ec7SAaron LI for (i = 0; i < nitems(lagg_cmds); i++)
24950b1e235SMarkus Pfeiffer cmd_register(&lagg_cmds[i]);
25093b0f758SAaron LI
25150b1e235SMarkus Pfeiffer af_register(&af_lagg);
25250b1e235SMarkus Pfeiffer }
253