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 if (ioctl(s, SIOCSLAGGPORT, &rp)) 44 err(1, "SIOCSLAGGPORT"); 45 } 46 47 static void 48 unsetlaggport(const char *val, int d, int s, const struct afswtch *afp) 49 { 50 struct lagg_reqport rp; 51 52 bzero(&rp, sizeof(rp)); 53 strlcpy(rp.rp_ifname, name, sizeof(rp.rp_ifname)); 54 strlcpy(rp.rp_portname, val, sizeof(rp.rp_portname)); 55 56 if (ioctl(s, SIOCSLAGGDELPORT, &rp)) 57 err(1, "SIOCSLAGGDELPORT"); 58 } 59 60 static void 61 setlaggproto(const char *val, int d, int s, const struct afswtch *afp) 62 { 63 struct lagg_protos lpr[] = LAGG_PROTOS; 64 struct lagg_reqall ra; 65 int i; 66 67 bzero(&ra, sizeof(ra)); 68 ra.ra_proto = LAGG_PROTO_MAX; 69 70 for (i = 0; i < (sizeof(lpr) / sizeof(lpr[0])); i++) { 71 if (strcmp(val, lpr[i].lpr_name) == 0) { 72 ra.ra_proto = lpr[i].lpr_proto; 73 break; 74 } 75 } 76 if (ra.ra_proto == LAGG_PROTO_MAX) 77 errx(1, "Invalid aggregation protocol: %s", val); 78 79 strlcpy(ra.ra_ifname, name, sizeof(ra.ra_ifname)); 80 if (ioctl(s, SIOCSLAGG, &ra) != 0) 81 err(1, "SIOCSLAGG"); 82 } 83 84 static char * 85 lacp_format_mac(const uint8_t *mac, char *buf, size_t buflen) 86 { 87 snprintf(buf, buflen, "%02X-%02X-%02X-%02X-%02X-%02X", 88 (int)mac[0], (int)mac[1], (int)mac[2], (int)mac[3], 89 (int)mac[4], (int)mac[5]); 90 91 return (buf); 92 } 93 94 static char * 95 lacp_format_peer(struct lacp_opreq *req, const char *sep) 96 { 97 char macbuf1[20]; 98 char macbuf2[20]; 99 100 snprintf(lacpbuf, sizeof(lacpbuf), 101 "[(%04X,%s,%04X,%04X,%04X),%s(%04X,%s,%04X,%04X,%04X)]", 102 req->actor_prio, 103 lacp_format_mac(req->actor_mac, macbuf1, sizeof(macbuf1)), 104 req->actor_key, req->actor_portprio, req->actor_portno, sep, 105 req->partner_prio, 106 lacp_format_mac(req->partner_mac, macbuf2, sizeof(macbuf2)), 107 req->partner_key, req->partner_portprio, req->partner_portno); 108 109 return(lacpbuf); 110 } 111 112 static void 113 lagg_status(int s) 114 { 115 struct lagg_protos lpr[] = LAGG_PROTOS; 116 struct lagg_reqport rp, rpbuf[LAGG_MAX_PORTS]; 117 struct lagg_reqall ra; 118 struct lacp_opreq *lp; 119 const char *proto = "<unknown>"; 120 int i, isport = 0; 121 122 bzero(&rp, sizeof(rp)); 123 bzero(&ra, sizeof(ra)); 124 125 strlcpy(rp.rp_ifname, name, sizeof(rp.rp_ifname)); 126 strlcpy(rp.rp_portname, name, sizeof(rp.rp_portname)); 127 128 if (ioctl(s, SIOCGLAGGPORT, &rp) == 0) 129 isport = 1; 130 131 strlcpy(ra.ra_ifname, name, sizeof(ra.ra_ifname)); 132 ra.ra_size = sizeof(rpbuf); 133 ra.ra_port = rpbuf; 134 135 if (ioctl(s, SIOCGLAGG, &ra) == 0) { 136 lp = (struct lacp_opreq *)&ra.ra_lacpreq; 137 138 for (i = 0; i < (sizeof(lpr) / sizeof(lpr[0])); i++) { 139 if (ra.ra_proto == lpr[i].lpr_proto) { 140 proto = lpr[i].lpr_name; 141 break; 142 } 143 } 144 145 printf("\tlaggproto %s", proto); 146 if (isport) 147 printf(" laggdev %s", rp.rp_ifname); 148 putchar('\n'); 149 if (verbose && ra.ra_proto == LAGG_PROTO_LACP) 150 printf("\tlag id: %s\n", 151 lacp_format_peer(lp, "\n\t\t ")); 152 153 for (i = 0; i < ra.ra_ports; i++) { 154 lp = (struct lacp_opreq *)&rpbuf[i].rp_lacpreq; 155 printf("\tlaggport: %s ", rpbuf[i].rp_portname); 156 printb("flags", rpbuf[i].rp_flags, LAGG_PORT_BITS); 157 if (verbose && ra.ra_proto == LAGG_PROTO_LACP) 158 printf(" state=%X", lp->actor_state); 159 putchar('\n'); 160 if (verbose && ra.ra_proto == LAGG_PROTO_LACP) 161 printf("\t\t%s\n", 162 lacp_format_peer(lp, "\n\t\t ")); 163 } 164 165 if (0 /* XXX */) { 166 printf("\tsupported aggregation protocols:\n"); 167 for (i = 0; i < (sizeof(lpr) / sizeof(lpr[0])); i++) 168 printf("\t\tlaggproto %s\n", lpr[i].lpr_name); 169 } 170 } else if (isport) 171 printf("\tlagg: laggdev %s\n", rp.rp_ifname); 172 } 173 174 static struct cmd lagg_cmds[] = { 175 DEF_CMD_ARG("laggport", setlaggport), 176 DEF_CMD_ARG("-laggport", unsetlaggport), 177 DEF_CMD_ARG("laggproto", setlaggproto), 178 }; 179 static struct afswtch af_lagg = { 180 .af_name = "af_lagg", 181 .af_af = AF_UNSPEC, 182 .af_other_status = lagg_status, 183 }; 184 185 static __constructor void 186 lagg_ctor(void) 187 { 188 #define N(a) (sizeof(a) / sizeof(a[0])) 189 int i; 190 191 for (i = 0; i < N(lagg_cmds); i++) 192 cmd_register(&lagg_cmds[i]); 193 af_register(&af_lagg); 194 #undef N 195 } 196