1 /* $NetBSD: if_agrether.c,v 1.8 2009/06/09 22:26:49 yamt Exp $ */ 2 3 /*- 4 * Copyright (c)2005 YAMAMOTO Takashi, 5 * All rights reserved. 6 * 7 * Redistribution and use in source and binary forms, with or without 8 * modification, are permitted provided that the following conditions 9 * are met: 10 * 1. Redistributions of source code must retain the above copyright 11 * notice, this list of conditions and the following disclaimer. 12 * 2. Redistributions in binary form must reproduce the above copyright 13 * notice, this list of conditions and the following disclaimer in the 14 * documentation and/or other materials provided with the distribution. 15 * 16 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 17 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 18 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 19 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 20 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 21 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 22 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 23 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 24 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 25 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 26 * SUCH DAMAGE. 27 */ 28 29 #include <sys/cdefs.h> 30 __KERNEL_RCSID(0, "$NetBSD: if_agrether.c,v 1.8 2009/06/09 22:26:49 yamt Exp $"); 31 32 #include <sys/param.h> 33 #include <sys/callout.h> 34 #include <sys/mbuf.h> 35 #include <sys/sockio.h> 36 37 #include <net/if.h> 38 #include <net/if_dl.h> 39 #include <net/if_ether.h> 40 #include <net/if_media.h> 41 42 #include <net/agr/if_agrvar_impl.h> 43 #include <net/agr/if_agrethervar.h> 44 #include <net/agr/if_agrsubr.h> 45 46 #include <net/agr/ieee8023_slowprotocols.h> 47 #include <net/agr/ieee8023_tlv.h> 48 #include <net/agr/ieee8023ad.h> 49 #include <net/agr/ieee8023ad_lacp.h> 50 #include <net/agr/ieee8023ad_lacp_impl.h> 51 #include <net/agr/ieee8023ad_impl.h> 52 53 static int agrether_ctor(struct agr_softc *, struct ifnet *); 54 static void agrether_dtor(struct agr_softc *); 55 static int agrether_portinit(struct agr_softc *, struct agr_port *); 56 static int agrether_portfini(struct agr_softc *, struct agr_port *); 57 static struct agr_port *agrether_select_tx_port(struct agr_softc *, 58 struct mbuf *); 59 static int agrether_configmulti_port(struct agr_softc *, struct agr_port *, 60 bool); 61 static int agrether_configmulti_ifreq(struct agr_softc *, struct ifreq *, 62 bool); 63 64 const struct agr_iftype_ops agrether_ops = { 65 .iftop_tick = NULL, 66 .iftop_porttick = ieee8023ad_lacp_porttick, 67 .iftop_portstate = ieee8023ad_lacp_portstate, 68 .iftop_ctor = agrether_ctor, 69 .iftop_dtor = agrether_dtor, 70 .iftop_portinit = agrether_portinit, 71 .iftop_portfini = agrether_portfini, 72 .iftop_hashmbuf = agrether_hashmbuf, 73 .iftop_select_tx_port = agrether_select_tx_port, 74 .iftop_configmulti_port = agrether_configmulti_port, 75 .iftop_configmulti_ifreq = agrether_configmulti_ifreq 76 }; 77 78 struct agrether_private { 79 struct ieee8023ad_softc aep_ieee8023ad_softc; 80 struct agr_multiaddrs aep_multiaddrs; 81 }; 82 83 struct agrether_port_private { 84 struct ieee8023ad_port aepp_ieee8023ad_port; 85 }; 86 87 static int 88 agrether_ctor(struct agr_softc *sc, struct ifnet *ifp_port) 89 { 90 struct ifnet *ifp = &sc->sc_if; 91 struct ethercom *ec = (void *)ifp; 92 struct agrether_private *priv; 93 94 priv = malloc(sizeof(*priv), M_DEVBUF, M_NOWAIT | M_ZERO); 95 if (!priv) 96 return ENOMEM; 97 98 agr_mc_init(sc, &priv->aep_multiaddrs); 99 100 sc->sc_iftprivate = priv; 101 /* 102 * inherit ports capabilities 103 * XXX this really needs to be the intersection of all 104 * ports capabilities, not just the latest port. 105 * Okay if ports are the same. 106 */ 107 ifp->if_capabilities = ifp_port->if_capabilities & 108 (IFCAP_TSOv4 | IFCAP_TSOv6 | 109 IFCAP_CSUM_IPv4_Tx | IFCAP_CSUM_IPv4_Rx | 110 IFCAP_CSUM_TCPv4_Tx | IFCAP_CSUM_TCPv4_Rx | 111 IFCAP_CSUM_UDPv4_Tx | IFCAP_CSUM_UDPv4_Rx | 112 IFCAP_CSUM_TCPv6_Tx | IFCAP_CSUM_TCPv6_Rx | 113 IFCAP_CSUM_UDPv6_Tx | IFCAP_CSUM_UDPv6_Rx); 114 115 ether_ifattach(ifp, CLLADDR(ifp_port->if_sadl)); 116 ec->ec_capabilities = 117 ETHERCAP_VLAN_MTU | ETHERCAP_VLAN_HWTAGGING | ETHERCAP_JUMBO_MTU; 118 119 ieee8023ad_ctor(sc); 120 121 return 0; 122 } 123 124 static void 125 agrether_dtor(struct agr_softc *sc) 126 { 127 struct agrether_private *priv = sc->sc_iftprivate; 128 129 if (priv == NULL) { 130 return; 131 } 132 133 ieee8023ad_dtor(sc); 134 agr_mc_purgeall(sc, &priv->aep_multiaddrs); 135 free(priv, M_DEVBUF); 136 sc->sc_iftprivate = NULL; 137 } 138 139 static int 140 agrether_portinit(struct agr_softc *sc, struct agr_port *port) 141 { 142 struct ifreq ifr; 143 struct agrether_port_private *priv; 144 int error; 145 struct ethercom *ec = (void *)&sc->sc_if; 146 struct ethercom *ec_port = (void *)port->port_ifp; 147 148 port->port_media = IFM_ETHER | IFM_NONE; 149 150 /* 151 * XXX it's better to always advertise ETHERCAP_VLAN_HWTAGGING 152 * and do tag insertion by ourselves if necessary, 153 * so that we can mix devices with different capabilities. 154 * ditto about if_capabilities. 155 */ 156 157 if (ec->ec_capabilities & 158 ~ec_port->ec_capabilities & 159 (ETHERCAP_VLAN_MTU | ETHERCAP_VLAN_HWTAGGING)) { 160 if (ec->ec_nvlans > 0) { 161 return EINVAL; 162 } 163 ec->ec_capabilities &= 164 ec_port->ec_capabilities | 165 ~(ETHERCAP_VLAN_MTU | ETHERCAP_VLAN_HWTAGGING); 166 } 167 168 /* Enable vlan support */ 169 if ((ec->ec_nvlans > 0) && 170 ec_port->ec_nvlans++ == 0 && 171 (ec_port->ec_capabilities & ETHERCAP_VLAN_MTU) != 0) { 172 struct ifnet *p = port->port_ifp; 173 /* 174 * Enable Tx/Rx of VLAN-sized frames. 175 */ 176 ec_port->ec_capenable |= ETHERCAP_VLAN_MTU; 177 if (p->if_flags & IFF_UP) { 178 ifr.ifr_flags = p->if_flags; 179 error = (*p->if_ioctl)(p, SIOCSIFFLAGS, 180 (void *) &ifr); 181 if (error) { 182 if (ec_port->ec_nvlans-- == 1) 183 ec_port->ec_capenable &= 184 ~ETHERCAP_VLAN_MTU; 185 return (error); 186 } 187 } 188 } 189 /* XXX ETHERCAP_JUMBO_MTU */ 190 191 priv = malloc(sizeof(*priv), M_DEVBUF, M_WAITOK | M_ZERO); 192 if (priv == NULL) { 193 return ENOMEM; 194 } 195 196 port->port_iftprivate = priv; 197 198 memset(&ifr, 0, sizeof(ifr)); 199 ifr.ifr_addr.sa_len = sizeof(ifr.ifr_addr); 200 ifr.ifr_addr.sa_family = AF_UNSPEC; 201 KASSERT(sizeof(ifr.ifr_addr) >= 202 sizeof(ethermulticastaddr_slowprotocols)); 203 memcpy(&ifr.ifr_addr.sa_data, 204 ðermulticastaddr_slowprotocols, 205 sizeof(ethermulticastaddr_slowprotocols)); 206 error = agrport_ioctl(port, SIOCADDMULTI, (void *)&ifr); 207 if (error) { 208 free(port->port_iftprivate, M_DEVBUF); 209 port->port_iftprivate = NULL; 210 return error; 211 } 212 213 ieee8023ad_portinit(port); 214 215 return error; 216 } 217 218 static int 219 agrether_portfini(struct agr_softc *sc, struct agr_port *port) 220 { 221 struct ifreq ifr; 222 struct ethercom *ec_port = (void *)port->port_ifp; 223 int error; 224 225 if (port->port_iftprivate == NULL) { 226 return 0; 227 } 228 229 if (ec_port->ec_nvlans > 0) { 230 /* Disable vlan support */ 231 ec_port->ec_nvlans = 0; 232 /* 233 * Disable Tx/Rx of VLAN-sized frames. 234 */ 235 ec_port->ec_capenable &= ~ETHERCAP_VLAN_MTU; 236 if (port->port_ifp->if_flags & IFF_UP) { 237 ifr.ifr_flags = port->port_ifp->if_flags; 238 (void) (*port->port_ifp->if_ioctl)(port->port_ifp, 239 SIOCSIFFLAGS, (void *) &ifr); 240 } 241 } 242 243 memset(&ifr, 0, sizeof(ifr)); 244 ifr.ifr_addr.sa_len = sizeof(ifr.ifr_addr); 245 ifr.ifr_addr.sa_family = AF_UNSPEC; 246 KASSERT(sizeof(ifr.ifr_addr) >= 247 sizeof(ethermulticastaddr_slowprotocols)); 248 memcpy(&ifr.ifr_addr.sa_data, 249 ðermulticastaddr_slowprotocols, 250 sizeof(ethermulticastaddr_slowprotocols)); 251 error = agrport_ioctl(port, SIOCDELMULTI, (void *)&ifr); 252 if (error) { 253 return error; 254 } 255 256 ieee8023ad_portfini(port); 257 258 free(port->port_iftprivate, M_DEVBUF); 259 port->port_iftprivate = NULL; 260 261 return error; 262 } 263 264 static int 265 agrether_configmulti_port(struct agr_softc *sc, struct agr_port *port, 266 bool add) 267 { 268 struct agrether_private *priv = sc->sc_iftprivate; 269 270 return agr_configmulti_port(&priv->aep_multiaddrs, port, add); 271 } 272 273 static int 274 agrether_configmulti_ifreq(struct agr_softc *sc, struct ifreq *ifr, 275 bool add) 276 { 277 struct agrether_private *priv = sc->sc_iftprivate; 278 279 return agr_configmulti_ifreq(sc, &priv->aep_multiaddrs, ifr, add); 280 } 281 282 /* -------------------- */ 283 284 static struct agr_port * 285 agrether_select_tx_port(struct agr_softc *sc, struct mbuf *m) 286 { 287 288 return ieee8023ad_select_tx_port(sc, m); 289 } 290