1 /* $NetBSD: if_agrether.c,v 1.12 2021/11/30 01:17:02 yamaguchi 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.12 2021/11/30 01:17:02 yamaguchi 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 #include <net/ether_slowprotocols.h>
42
43 #include <net/agr/if_agrvar_impl.h>
44 #include <net/agr/if_agrethervar.h>
45 #include <net/agr/if_agrsubr.h>
46
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
agrether_ctor(struct agr_softc * sc,struct ifnet * ifp_port)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_WAITOK | M_ZERO);
95 agr_mc_init(sc, &priv->aep_multiaddrs);
96
97 sc->sc_iftprivate = priv;
98 /*
99 * inherit ports capabilities
100 * XXX this really needs to be the intersection of all
101 * ports capabilities, not just the latest port.
102 * Okay if ports are the same.
103 */
104 ifp->if_capabilities = ifp_port->if_capabilities &
105 (IFCAP_TSOv4 | IFCAP_TSOv6 |
106 IFCAP_CSUM_IPv4_Tx | IFCAP_CSUM_IPv4_Rx |
107 IFCAP_CSUM_TCPv4_Tx | IFCAP_CSUM_TCPv4_Rx |
108 IFCAP_CSUM_UDPv4_Tx | IFCAP_CSUM_UDPv4_Rx |
109 IFCAP_CSUM_TCPv6_Tx | IFCAP_CSUM_TCPv6_Rx |
110 IFCAP_CSUM_UDPv6_Tx | IFCAP_CSUM_UDPv6_Rx);
111
112 ether_ifattach(ifp, CLLADDR(ifp_port->if_sadl));
113 ec->ec_capabilities =
114 ETHERCAP_VLAN_MTU | ETHERCAP_VLAN_HWTAGGING | ETHERCAP_JUMBO_MTU;
115
116 ieee8023ad_ctor(sc);
117
118 return 0;
119 }
120
121 static void
agrether_dtor(struct agr_softc * sc)122 agrether_dtor(struct agr_softc *sc)
123 {
124 struct agrether_private *priv = sc->sc_iftprivate;
125
126 if (priv == NULL) {
127 return;
128 }
129
130 ieee8023ad_dtor(sc);
131 agr_mc_purgeall(sc, &priv->aep_multiaddrs);
132 free(priv, M_DEVBUF);
133 sc->sc_iftprivate = NULL;
134 }
135
136 static int
agrether_portinit(struct agr_softc * sc,struct agr_port * port)137 agrether_portinit(struct agr_softc *sc, struct agr_port *port)
138 {
139 struct ifreq ifr;
140 struct agrether_port_private *priv;
141 int error;
142 struct ethercom *ec = (void *)&sc->sc_if;
143 struct ethercom *ec_port = (void *)port->port_ifp;
144
145 port->port_media = IFM_ETHER | IFM_NONE;
146
147 /*
148 * XXX it's better to always advertise ETHERCAP_VLAN_HWTAGGING
149 * and do tag insertion by ourselves if necessary,
150 * so that we can mix devices with different capabilities.
151 * ditto about if_capabilities.
152 */
153
154 if (ec->ec_capabilities &
155 ~ec_port->ec_capabilities &
156 (ETHERCAP_VLAN_MTU | ETHERCAP_VLAN_HWTAGGING)) {
157 if (ec->ec_nvlans > 0) {
158 return EINVAL;
159 }
160 ec->ec_capabilities &=
161 ec_port->ec_capabilities |
162 ~(ETHERCAP_VLAN_MTU | ETHERCAP_VLAN_HWTAGGING);
163 }
164
165 /* Enable vlan support */
166 if (ec->ec_nvlans > 0) {
167 error = agr_vlan_add(port, NULL);
168 if (error != 0)
169 return error;
170 }
171 /* XXX ETHERCAP_JUMBO_MTU */
172
173 priv = malloc(sizeof(*priv), M_DEVBUF, M_WAITOK | M_ZERO);
174 if (priv == NULL) {
175 return ENOMEM;
176 }
177
178 port->port_iftprivate = priv;
179
180 memset(&ifr, 0, sizeof(ifr));
181 ifr.ifr_addr.sa_len = sizeof(ifr.ifr_addr);
182 ifr.ifr_addr.sa_family = AF_UNSPEC;
183 KASSERT(sizeof(ifr.ifr_addr) >=
184 sizeof(ethermulticastaddr_slowprotocols));
185 memcpy(&ifr.ifr_addr.sa_data,
186 ðermulticastaddr_slowprotocols,
187 sizeof(ethermulticastaddr_slowprotocols));
188 error = agrport_ioctl(port, SIOCADDMULTI, (void *)&ifr);
189 if (error) {
190 free(port->port_iftprivate, M_DEVBUF);
191 port->port_iftprivate = NULL;
192 return error;
193 }
194
195 ieee8023ad_portinit(port);
196
197 return error;
198 }
199
200 static int
agrether_portfini(struct agr_softc * sc,struct agr_port * port)201 agrether_portfini(struct agr_softc *sc, struct agr_port *port)
202 {
203 struct ifreq ifr;
204 struct ethercom *ec_port = (void *)port->port_ifp;
205 int error;
206
207 if (port->port_iftprivate == NULL) {
208 return 0;
209 }
210
211 if (ec_port->ec_nvlans > 0) {
212 bool force = true;
213 /* Disable vlan support */
214 agr_vlan_del(port, &force);
215 }
216
217 memset(&ifr, 0, sizeof(ifr));
218 ifr.ifr_addr.sa_len = sizeof(ifr.ifr_addr);
219 ifr.ifr_addr.sa_family = AF_UNSPEC;
220 KASSERT(sizeof(ifr.ifr_addr) >=
221 sizeof(ethermulticastaddr_slowprotocols));
222 memcpy(&ifr.ifr_addr.sa_data,
223 ðermulticastaddr_slowprotocols,
224 sizeof(ethermulticastaddr_slowprotocols));
225 error = agrport_ioctl(port, SIOCDELMULTI, (void *)&ifr);
226 if (error) {
227 return error;
228 }
229
230 ieee8023ad_portfini(port);
231
232 free(port->port_iftprivate, M_DEVBUF);
233 port->port_iftprivate = NULL;
234
235 return error;
236 }
237
238 static int
agrether_configmulti_port(struct agr_softc * sc,struct agr_port * port,bool add)239 agrether_configmulti_port(struct agr_softc *sc, struct agr_port *port,
240 bool add)
241 {
242 struct agrether_private *priv = sc->sc_iftprivate;
243
244 return agr_configmulti_port(&priv->aep_multiaddrs, port, add);
245 }
246
247 static int
agrether_configmulti_ifreq(struct agr_softc * sc,struct ifreq * ifr,bool add)248 agrether_configmulti_ifreq(struct agr_softc *sc, struct ifreq *ifr,
249 bool add)
250 {
251 struct agrether_private *priv = sc->sc_iftprivate;
252
253 return agr_configmulti_ifreq(sc, &priv->aep_multiaddrs, ifr, add);
254 }
255
256 /* -------------------- */
257
258 static struct agr_port *
agrether_select_tx_port(struct agr_softc * sc,struct mbuf * m)259 agrether_select_tx_port(struct agr_softc *sc, struct mbuf *m)
260 {
261
262 return ieee8023ad_select_tx_port(sc, m);
263 }
264