if_agr.c revision 1.20.10.3 1 1.20.10.3 yamt /* $NetBSD: if_agr.c,v 1.20.10.3 2010/03/11 15:04:27 yamt Exp $ */
2 1.1 yamt
3 1.1 yamt /*-
4 1.1 yamt * Copyright (c)2005 YAMAMOTO Takashi,
5 1.1 yamt * All rights reserved.
6 1.1 yamt *
7 1.1 yamt * Redistribution and use in source and binary forms, with or without
8 1.1 yamt * modification, are permitted provided that the following conditions
9 1.1 yamt * are met:
10 1.1 yamt * 1. Redistributions of source code must retain the above copyright
11 1.1 yamt * notice, this list of conditions and the following disclaimer.
12 1.1 yamt * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 yamt * notice, this list of conditions and the following disclaimer in the
14 1.1 yamt * documentation and/or other materials provided with the distribution.
15 1.1 yamt *
16 1.1 yamt * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
17 1.1 yamt * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18 1.1 yamt * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19 1.1 yamt * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
20 1.1 yamt * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21 1.1 yamt * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22 1.1 yamt * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23 1.1 yamt * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24 1.1 yamt * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 1.1 yamt * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 1.1 yamt * SUCH DAMAGE.
27 1.1 yamt */
28 1.1 yamt
29 1.1 yamt #include <sys/cdefs.h>
30 1.20.10.3 yamt __KERNEL_RCSID(0, "$NetBSD: if_agr.c,v 1.20.10.3 2010/03/11 15:04:27 yamt Exp $");
31 1.1 yamt
32 1.1 yamt #include "opt_inet.h"
33 1.1 yamt
34 1.1 yamt #include <sys/param.h>
35 1.2 yamt #include <sys/callout.h>
36 1.1 yamt #include <sys/malloc.h>
37 1.1 yamt #include <sys/mbuf.h>
38 1.1 yamt #include <sys/systm.h>
39 1.1 yamt #include <sys/types.h>
40 1.1 yamt #include <sys/queue.h>
41 1.1 yamt #include <sys/sockio.h>
42 1.1 yamt #include <sys/proc.h> /* XXX for curproc */
43 1.5 yamt #include <sys/kauth.h>
44 1.20.10.3 yamt #include <sys/xcall.h>
45 1.1 yamt
46 1.1 yamt #include <net/bpf.h>
47 1.1 yamt #include <net/if.h>
48 1.1 yamt #include <net/if_dl.h>
49 1.1 yamt #include <net/if_types.h>
50 1.20.10.2 yamt #include <net/if_ether.h>
51 1.1 yamt
52 1.1 yamt #if defined(INET)
53 1.1 yamt #include <netinet/in.h>
54 1.1 yamt #include <netinet/if_inarp.h>
55 1.1 yamt #endif
56 1.1 yamt
57 1.1 yamt #include <net/agr/if_agrvar.h>
58 1.1 yamt #include <net/agr/if_agrvar_impl.h>
59 1.1 yamt #include <net/agr/if_agrioctl.h>
60 1.1 yamt #include <net/agr/if_agrsubr.h>
61 1.1 yamt #include <net/agr/if_agrethervar.h>
62 1.1 yamt
63 1.1 yamt void agrattach(int);
64 1.1 yamt
65 1.1 yamt static int agr_clone_create(struct if_clone *, int);
66 1.1 yamt static int agr_clone_destroy(struct ifnet *);
67 1.1 yamt static void agr_start(struct ifnet *);
68 1.20.10.3 yamt static int agr_setconfig(struct agr_softc *, const struct agrreq *);
69 1.20.10.3 yamt static int agr_getconfig(struct agr_softc *, struct agrreq *);
70 1.20.10.3 yamt static int agr_getportlist(struct agr_softc *, struct agrreq *);
71 1.1 yamt static int agr_addport(struct ifnet *, struct ifnet *);
72 1.1 yamt static int agr_remport(struct ifnet *, struct ifnet *);
73 1.1 yamt static int agrreq_copyin(const void *, struct agrreq *);
74 1.1 yamt static int agrreq_copyout(void *, struct agrreq *);
75 1.11 christos static int agr_ioctl(struct ifnet *, u_long, void *);
76 1.1 yamt static struct agr_port *agr_select_tx_port(struct agr_softc *, struct mbuf *);
77 1.11 christos static int agr_ioctl_filter(struct ifnet *, u_long, void *);
78 1.1 yamt static void agr_reset_iftype(struct ifnet *);
79 1.1 yamt static int agr_config_promisc(struct agr_softc *);
80 1.1 yamt static int agrport_config_promisc_callback(struct agr_port *, void *);
81 1.9 thorpej static int agrport_config_promisc(struct agr_port *, bool);
82 1.1 yamt static int agrport_cleanup(struct agr_softc *, struct agr_port *);
83 1.1 yamt
84 1.20.10.3 yamt static int agr_enter(struct agr_softc *);
85 1.20.10.3 yamt static void agr_exit(struct agr_softc *);
86 1.20.10.3 yamt static int agr_pause(struct agr_softc *);
87 1.20.10.3 yamt static void agr_evacuate(struct agr_softc *);
88 1.20.10.3 yamt static void agr_sync(void);
89 1.20.10.3 yamt static void agr_ports_lock(struct agr_softc *);
90 1.20.10.3 yamt static void agr_ports_unlock(struct agr_softc *);
91 1.20.10.3 yamt static bool agr_ports_enter(struct agr_softc *);
92 1.20.10.3 yamt static void agr_ports_exit(struct agr_softc *);
93 1.20.10.3 yamt
94 1.1 yamt static struct if_clone agr_cloner =
95 1.1 yamt IF_CLONE_INITIALIZER("agr", agr_clone_create, agr_clone_destroy);
96 1.1 yamt
97 1.1 yamt /*
98 1.1 yamt * EXPORTED FUNCTIONS
99 1.1 yamt */
100 1.1 yamt
101 1.1 yamt /*
102 1.1 yamt * agrattch: device attach routine.
103 1.1 yamt */
104 1.1 yamt
105 1.1 yamt void
106 1.1 yamt agrattach(int count)
107 1.1 yamt {
108 1.1 yamt
109 1.1 yamt if_clone_attach(&agr_cloner);
110 1.1 yamt }
111 1.1 yamt
112 1.1 yamt /*
113 1.1 yamt * agr_input: frame collector.
114 1.1 yamt */
115 1.1 yamt
116 1.1 yamt void
117 1.1 yamt agr_input(struct ifnet *ifp_port, struct mbuf *m)
118 1.1 yamt {
119 1.1 yamt struct agr_port *port;
120 1.1 yamt struct ifnet *ifp;
121 1.20.10.2 yamt #if NVLAN > 0
122 1.20.10.2 yamt struct m_tag *mtag;
123 1.20.10.2 yamt #endif
124 1.1 yamt
125 1.1 yamt port = ifp_port->if_agrprivate;
126 1.1 yamt KASSERT(port);
127 1.1 yamt ifp = port->port_agrifp;
128 1.1 yamt if ((port->port_flags & AGRPORT_COLLECTING) == 0) {
129 1.1 yamt m_freem(m);
130 1.1 yamt ifp->if_ierrors++;
131 1.1 yamt return;
132 1.1 yamt }
133 1.1 yamt
134 1.1 yamt ifp->if_ipackets++;
135 1.1 yamt m->m_pkthdr.rcvif = ifp;
136 1.1 yamt
137 1.20.10.2 yamt #define DNH_DEBUG
138 1.20.10.2 yamt #if NVLAN > 0
139 1.20.10.2 yamt /* got a vlan packet? */
140 1.20.10.2 yamt if ((mtag = m_tag_find(m, PACKET_TAG_VLAN, NULL)) != NULL) {
141 1.20.10.2 yamt #ifdef DNH_DEBUG
142 1.20.10.2 yamt printf("%s: vlan tag %d attached\n",
143 1.20.10.2 yamt ifp->if_xname,
144 1.20.10.2 yamt htole16((*(u_int *)(mtag + 1)) & 0xffff));
145 1.20.10.2 yamt printf("%s: vlan input\n", ifp->if_xname);
146 1.20.10.2 yamt #endif
147 1.20.10.2 yamt vlan_input(ifp, m);
148 1.20.10.2 yamt return;
149 1.20.10.2 yamt #ifdef DNH_DEBUG
150 1.20.10.2 yamt } else {
151 1.20.10.2 yamt struct ethercom *ec = (void *)ifp;
152 1.20.10.2 yamt printf("%s: no vlan tag attached, ec_nvlans=%d\n",
153 1.20.10.2 yamt ifp->if_xname, ec->ec_nvlans);
154 1.20.10.2 yamt #endif
155 1.20.10.2 yamt }
156 1.20.10.2 yamt #endif
157 1.20.10.2 yamt
158 1.1 yamt if (ifp->if_bpf) {
159 1.20.10.3 yamt bpf_ops->bpf_mtap(ifp->if_bpf, m);
160 1.1 yamt }
161 1.1 yamt
162 1.1 yamt (*ifp->if_input)(ifp, m);
163 1.1 yamt }
164 1.1 yamt
165 1.1 yamt /*
166 1.1 yamt * EXPORTED AGR-INTERNAL FUNCTIONS
167 1.1 yamt */
168 1.1 yamt
169 1.12 yamt void
170 1.1 yamt agr_lock(struct agr_softc *sc)
171 1.1 yamt {
172 1.1 yamt
173 1.12 yamt mutex_enter(&sc->sc_lock);
174 1.1 yamt }
175 1.1 yamt
176 1.1 yamt void
177 1.12 yamt agr_unlock(struct agr_softc *sc)
178 1.1 yamt {
179 1.1 yamt
180 1.12 yamt mutex_exit(&sc->sc_lock);
181 1.1 yamt }
182 1.1 yamt
183 1.1 yamt /*
184 1.1 yamt * agr_xmit_frame: transmit a pre-built frame.
185 1.1 yamt */
186 1.1 yamt
187 1.1 yamt int
188 1.1 yamt agr_xmit_frame(struct ifnet *ifp_port, struct mbuf *m)
189 1.1 yamt {
190 1.1 yamt int error;
191 1.1 yamt
192 1.1 yamt struct sockaddr_storage dst0;
193 1.1 yamt struct sockaddr *dst;
194 1.1 yamt int hdrlen;
195 1.1 yamt
196 1.1 yamt /*
197 1.1 yamt * trim off link level header and let if_output re-add it.
198 1.1 yamt * XXX better to introduce an API to transmit pre-built frames.
199 1.1 yamt */
200 1.1 yamt
201 1.1 yamt hdrlen = ifp_port->if_hdrlen;
202 1.1 yamt if (m->m_pkthdr.len < hdrlen) {
203 1.1 yamt m_freem(m);
204 1.1 yamt return EINVAL;
205 1.1 yamt }
206 1.1 yamt memset(&dst0, 0, sizeof(dst0));
207 1.1 yamt dst = (struct sockaddr *)&dst0;
208 1.1 yamt dst->sa_family = pseudo_AF_HDRCMPLT;
209 1.1 yamt dst->sa_len = hdrlen;
210 1.1 yamt m_copydata(m, 0, hdrlen, &dst->sa_data);
211 1.1 yamt m_adj(m, hdrlen);
212 1.1 yamt
213 1.1 yamt error = (*ifp_port->if_output)(ifp_port, m, dst, NULL);
214 1.1 yamt
215 1.1 yamt return error;
216 1.1 yamt }
217 1.1 yamt
218 1.1 yamt int
219 1.11 christos agrport_ioctl(struct agr_port *port, u_long cmd, void *arg)
220 1.1 yamt {
221 1.1 yamt struct ifnet *ifp = port->port_ifp;
222 1.1 yamt
223 1.1 yamt KASSERT(ifp->if_agrprivate == (void *)port);
224 1.1 yamt KASSERT(ifp->if_ioctl == agr_ioctl_filter);
225 1.1 yamt
226 1.1 yamt return (*port->port_ioctl)(ifp, cmd, arg);
227 1.1 yamt }
228 1.1 yamt
229 1.1 yamt /*
230 1.1 yamt * INTERNAL FUNCTIONS
231 1.1 yamt */
232 1.1 yamt
233 1.20.10.2 yamt /*
234 1.20.10.2 yamt * Enable vlan hardware assist for the specified port.
235 1.20.10.2 yamt */
236 1.20.10.2 yamt static int
237 1.20.10.2 yamt agr_vlan_add(struct agr_port *port, void *arg)
238 1.20.10.2 yamt {
239 1.20.10.2 yamt struct ifnet *ifp = port->port_ifp;
240 1.20.10.2 yamt struct ethercom *ec_port = (void *)ifp;
241 1.20.10.2 yamt struct ifreq ifr;
242 1.20.10.2 yamt int error=0;
243 1.20.10.2 yamt
244 1.20.10.2 yamt if (ec_port->ec_nvlans++ == 0 &&
245 1.20.10.2 yamt (ec_port->ec_capabilities & ETHERCAP_VLAN_MTU) != 0) {
246 1.20.10.2 yamt struct ifnet *p = port->port_ifp;
247 1.20.10.2 yamt /*
248 1.20.10.2 yamt * Enable Tx/Rx of VLAN-sized frames.
249 1.20.10.2 yamt */
250 1.20.10.2 yamt ec_port->ec_capenable |= ETHERCAP_VLAN_MTU;
251 1.20.10.2 yamt if (p->if_flags & IFF_UP) {
252 1.20.10.2 yamt ifr.ifr_flags = p->if_flags;
253 1.20.10.2 yamt error = (*p->if_ioctl)(p, SIOCSIFFLAGS,
254 1.20.10.2 yamt (void *) &ifr);
255 1.20.10.2 yamt if (error) {
256 1.20.10.2 yamt if (ec_port->ec_nvlans-- == 1)
257 1.20.10.2 yamt ec_port->ec_capenable &=
258 1.20.10.2 yamt ~ETHERCAP_VLAN_MTU;
259 1.20.10.2 yamt return (error);
260 1.20.10.2 yamt }
261 1.20.10.2 yamt }
262 1.20.10.2 yamt }
263 1.20.10.2 yamt
264 1.20.10.2 yamt return error;
265 1.20.10.2 yamt }
266 1.20.10.2 yamt
267 1.20.10.2 yamt /*
268 1.20.10.2 yamt * Disable vlan hardware assist for the specified port.
269 1.20.10.2 yamt */
270 1.20.10.2 yamt static int
271 1.20.10.2 yamt agr_vlan_del(struct agr_port *port, void *arg)
272 1.20.10.2 yamt {
273 1.20.10.2 yamt struct ethercom *ec_port = (void *)port->port_ifp;
274 1.20.10.2 yamt struct ifreq ifr;
275 1.20.10.2 yamt
276 1.20.10.2 yamt /* Disable vlan support */
277 1.20.10.2 yamt if (ec_port->ec_nvlans-- == 1) {
278 1.20.10.2 yamt /*
279 1.20.10.2 yamt * Disable Tx/Rx of VLAN-sized frames.
280 1.20.10.2 yamt */
281 1.20.10.2 yamt ec_port->ec_capenable &= ~ETHERCAP_VLAN_MTU;
282 1.20.10.2 yamt if (port->port_ifp->if_flags & IFF_UP) {
283 1.20.10.2 yamt ifr.ifr_flags = port->port_ifp->if_flags;
284 1.20.10.2 yamt (void) (*port->port_ifp->if_ioctl)(port->port_ifp,
285 1.20.10.2 yamt SIOCSIFFLAGS, (void *) &ifr);
286 1.20.10.2 yamt }
287 1.20.10.2 yamt }
288 1.20.10.2 yamt
289 1.20.10.2 yamt return 0;
290 1.20.10.2 yamt }
291 1.20.10.2 yamt
292 1.20.10.2 yamt
293 1.20.10.2 yamt /*
294 1.20.10.2 yamt * Check for vlan attach/detach.
295 1.20.10.2 yamt * ec->ec_nvlans is directly modified by the vlan driver.
296 1.20.10.2 yamt * We keep a local count in sc (sc->sc_nvlans) to detect
297 1.20.10.2 yamt * when the vlan driver attaches or detaches.
298 1.20.10.2 yamt * Note the agr interface must be up for this to work.
299 1.20.10.2 yamt */
300 1.20.10.2 yamt static void
301 1.20.10.2 yamt agr_vlan_check(struct ifnet *ifp, struct agr_softc *sc)
302 1.20.10.2 yamt {
303 1.20.10.2 yamt struct ethercom *ec = (void *)ifp;
304 1.20.10.2 yamt int error;
305 1.20.10.2 yamt
306 1.20.10.2 yamt /* vlans in sync? */
307 1.20.10.2 yamt if (sc->sc_nvlans == ec->ec_nvlans) {
308 1.20.10.2 yamt return;
309 1.20.10.2 yamt }
310 1.20.10.2 yamt
311 1.20.10.2 yamt if (sc->sc_nvlans == 0) {
312 1.20.10.2 yamt /* vlan added */
313 1.20.10.2 yamt error = agr_port_foreach(sc, agr_vlan_add, NULL);
314 1.20.10.2 yamt sc->sc_nvlans = ec->ec_nvlans;
315 1.20.10.2 yamt } else if (ec->ec_nvlans == 0) {
316 1.20.10.2 yamt /* vlan removed */
317 1.20.10.2 yamt error = agr_port_foreach(sc, agr_vlan_del, NULL);
318 1.20.10.2 yamt sc->sc_nvlans = 0;
319 1.20.10.2 yamt }
320 1.20.10.2 yamt }
321 1.20.10.2 yamt
322 1.1 yamt static int
323 1.1 yamt agr_clone_create(struct if_clone *ifc, int unit)
324 1.1 yamt {
325 1.1 yamt struct agr_softc *sc;
326 1.1 yamt struct ifnet *ifp;
327 1.1 yamt
328 1.1 yamt sc = agr_alloc_softc();
329 1.1 yamt TAILQ_INIT(&sc->sc_ports);
330 1.20.10.3 yamt mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_NET);
331 1.20.10.3 yamt mutex_init(&sc->sc_entry_mtx, MUTEX_DEFAULT, IPL_NONE);
332 1.20.10.3 yamt cv_init(&sc->sc_insc_cv, "agr_softc");
333 1.20.10.3 yamt cv_init(&sc->sc_ports_cv, "agrports");
334 1.1 yamt agrtimer_init(sc);
335 1.1 yamt ifp = &sc->sc_if;
336 1.1 yamt snprintf(ifp->if_xname, sizeof(ifp->if_xname), "%s%d",
337 1.1 yamt ifc->ifc_name, unit);
338 1.1 yamt
339 1.1 yamt ifp->if_softc = sc;
340 1.1 yamt ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
341 1.1 yamt ifp->if_start = agr_start;
342 1.1 yamt ifp->if_ioctl = agr_ioctl;
343 1.1 yamt IFQ_SET_READY(&ifp->if_snd);
344 1.1 yamt
345 1.1 yamt if_attach(ifp);
346 1.1 yamt
347 1.1 yamt agr_reset_iftype(ifp);
348 1.1 yamt
349 1.1 yamt return 0;
350 1.1 yamt }
351 1.1 yamt
352 1.1 yamt static void
353 1.1 yamt agr_reset_iftype(struct ifnet *ifp)
354 1.1 yamt {
355 1.1 yamt
356 1.1 yamt ifp->if_type = IFT_OTHER;
357 1.1 yamt ifp->if_dlt = DLT_NULL;
358 1.1 yamt ifp->if_addrlen = 0;
359 1.1 yamt if_alloc_sadl(ifp);
360 1.1 yamt }
361 1.1 yamt
362 1.1 yamt static int
363 1.1 yamt agr_clone_destroy(struct ifnet *ifp)
364 1.1 yamt {
365 1.1 yamt struct agr_softc *sc = ifp->if_softc;
366 1.1 yamt int error;
367 1.1 yamt
368 1.20.10.3 yamt if ((error = agr_pause(sc)) != 0)
369 1.20.10.3 yamt return error;
370 1.1 yamt
371 1.20.10.3 yamt if_detach(ifp);
372 1.20.10.3 yamt agrtimer_destroy(sc);
373 1.20.10.3 yamt /* Now that the ifnet has been detached, and our
374 1.20.10.3 yamt * component ifnets are disconnected, there can be
375 1.20.10.3 yamt * no new threads in the softc. Wait for every
376 1.20.10.3 yamt * thread to get out of the softc.
377 1.20.10.3 yamt */
378 1.20.10.3 yamt agr_evacuate(sc);
379 1.20.10.3 yamt mutex_destroy(&sc->sc_lock);
380 1.20.10.3 yamt mutex_destroy(&sc->sc_entry_mtx);
381 1.20.10.3 yamt cv_destroy(&sc->sc_insc_cv);
382 1.20.10.3 yamt cv_destroy(&sc->sc_ports_cv);
383 1.20.10.3 yamt agr_free_softc(sc);
384 1.1 yamt
385 1.20.10.3 yamt return 0;
386 1.1 yamt }
387 1.1 yamt
388 1.1 yamt static struct agr_port *
389 1.1 yamt agr_select_tx_port(struct agr_softc *sc, struct mbuf *m)
390 1.1 yamt {
391 1.1 yamt
392 1.1 yamt return (*sc->sc_iftop->iftop_select_tx_port)(sc, m);
393 1.1 yamt }
394 1.1 yamt
395 1.1 yamt #if 0 /* "generic" version */
396 1.1 yamt static struct agr_port *
397 1.1 yamt agr_select_tx_port(struct agr_softc *sc, struct mbuf *m)
398 1.1 yamt {
399 1.1 yamt struct agr_port *port;
400 1.1 yamt uint32_t hash;
401 1.1 yamt
402 1.1 yamt hash = (*sc->sc_iftop->iftop_hashmbuf)(sc, m);
403 1.1 yamt if (sc->sc_nports == 0)
404 1.1 yamt return NULL;
405 1.1 yamt hash %= sc->sc_nports;
406 1.1 yamt port = TAILQ_FIRST(&sc->sc_ports);
407 1.1 yamt KASSERT(port != NULL);
408 1.1 yamt while (hash--) {
409 1.1 yamt port = TAILQ_NEXT(port, port_q);
410 1.1 yamt KASSERT(port != NULL);
411 1.1 yamt }
412 1.1 yamt
413 1.1 yamt return port;
414 1.1 yamt }
415 1.1 yamt #endif /* 0 */
416 1.1 yamt
417 1.1 yamt static void
418 1.1 yamt agr_start(struct ifnet *ifp)
419 1.1 yamt {
420 1.1 yamt struct agr_softc *sc = ifp->if_softc;
421 1.1 yamt struct mbuf *m;
422 1.1 yamt
423 1.12 yamt AGR_LOCK(sc);
424 1.1 yamt
425 1.1 yamt while (/* CONSTCOND */ 1) {
426 1.1 yamt struct agr_port *port;
427 1.1 yamt
428 1.1 yamt IFQ_DEQUEUE(&ifp->if_snd, m);
429 1.1 yamt if (m == NULL) {
430 1.1 yamt break;
431 1.1 yamt }
432 1.1 yamt if (ifp->if_bpf) {
433 1.20.10.3 yamt bpf_ops->bpf_mtap(ifp->if_bpf, m);
434 1.1 yamt }
435 1.1 yamt port = agr_select_tx_port(sc, m);
436 1.1 yamt if (port) {
437 1.1 yamt int error;
438 1.1 yamt
439 1.1 yamt error = agr_xmit_frame(port->port_ifp, m);
440 1.1 yamt if (error) {
441 1.1 yamt ifp->if_oerrors++;
442 1.1 yamt } else {
443 1.1 yamt ifp->if_opackets++;
444 1.1 yamt }
445 1.1 yamt } else {
446 1.1 yamt m_freem(m);
447 1.1 yamt ifp->if_oerrors++;
448 1.1 yamt }
449 1.1 yamt }
450 1.1 yamt
451 1.12 yamt AGR_UNLOCK(sc);
452 1.1 yamt
453 1.1 yamt ifp->if_flags &= ~IFF_OACTIVE;
454 1.1 yamt }
455 1.1 yamt
456 1.1 yamt static int
457 1.20.10.3 yamt agr_setconfig(struct agr_softc *sc, const struct agrreq *ar)
458 1.1 yamt {
459 1.20.10.3 yamt struct ifnet *ifp = &sc->sc_if;
460 1.1 yamt int cmd = ar->ar_cmd;
461 1.1 yamt struct ifnet *ifp_port;
462 1.1 yamt int error = 0;
463 1.1 yamt char ifname[IFNAMSIZ];
464 1.1 yamt
465 1.8 yamt memset(ifname, 0, sizeof(ifname));
466 1.8 yamt error = copyin(ar->ar_buf, ifname,
467 1.8 yamt MIN(ar->ar_buflen, sizeof(ifname) - 1));
468 1.1 yamt if (error) {
469 1.1 yamt return error;
470 1.1 yamt }
471 1.1 yamt ifp_port = ifunit(ifname);
472 1.1 yamt if (ifp_port == NULL) {
473 1.1 yamt return ENOENT;
474 1.1 yamt }
475 1.1 yamt
476 1.20.10.3 yamt agr_ports_lock(sc);
477 1.1 yamt switch (cmd) {
478 1.1 yamt case AGRCMD_ADDPORT:
479 1.1 yamt error = agr_addport(ifp, ifp_port);
480 1.1 yamt break;
481 1.1 yamt
482 1.1 yamt case AGRCMD_REMPORT:
483 1.1 yamt error = agr_remport(ifp, ifp_port);
484 1.1 yamt break;
485 1.1 yamt
486 1.1 yamt default:
487 1.1 yamt error = EINVAL;
488 1.1 yamt break;
489 1.1 yamt }
490 1.20.10.3 yamt agr_ports_unlock(sc);
491 1.1 yamt
492 1.1 yamt return error;
493 1.1 yamt }
494 1.1 yamt
495 1.1 yamt static int
496 1.20.10.3 yamt agr_getportlist(struct agr_softc *sc, struct agrreq *ar)
497 1.1 yamt {
498 1.1 yamt struct agr_port *port;
499 1.1 yamt struct agrportlist apl;
500 1.1 yamt struct agrportinfo api;
501 1.1 yamt char *cp = ar->ar_buf;
502 1.1 yamt size_t bufleft = (cp == NULL) ? 0 : ar->ar_buflen;
503 1.1 yamt int error;
504 1.1 yamt
505 1.1 yamt if (cp != NULL) {
506 1.1 yamt memset(&apl, 0, sizeof(apl));
507 1.1 yamt memset(&api, 0, sizeof(api));
508 1.1 yamt
509 1.1 yamt if (bufleft < sizeof(apl)) {
510 1.1 yamt return E2BIG;
511 1.1 yamt }
512 1.1 yamt apl.apl_nports = sc->sc_nports;
513 1.1 yamt error = copyout(&apl, cp, sizeof(apl));
514 1.1 yamt if (error) {
515 1.1 yamt return error;
516 1.1 yamt }
517 1.1 yamt cp += sizeof(apl);
518 1.1 yamt }
519 1.1 yamt bufleft -= sizeof(apl);
520 1.1 yamt
521 1.1 yamt TAILQ_FOREACH(port, &sc->sc_ports, port_q) {
522 1.1 yamt if (cp != NULL) {
523 1.1 yamt if (bufleft < sizeof(api)) {
524 1.1 yamt return E2BIG;
525 1.1 yamt }
526 1.1 yamt memcpy(api.api_ifname, port->port_ifp->if_xname,
527 1.1 yamt sizeof(api.api_ifname));
528 1.1 yamt api.api_flags = 0;
529 1.1 yamt if (port->port_flags & AGRPORT_COLLECTING) {
530 1.1 yamt api.api_flags |= AGRPORTINFO_COLLECTING;
531 1.1 yamt }
532 1.1 yamt if (port->port_flags & AGRPORT_DISTRIBUTING) {
533 1.1 yamt api.api_flags |= AGRPORTINFO_DISTRIBUTING;
534 1.1 yamt }
535 1.1 yamt error = copyout(&api, cp, sizeof(api));
536 1.1 yamt if (error) {
537 1.1 yamt return error;
538 1.1 yamt }
539 1.1 yamt cp += sizeof(api);
540 1.1 yamt }
541 1.1 yamt bufleft -= sizeof(api);
542 1.1 yamt }
543 1.1 yamt
544 1.1 yamt if (cp == NULL) {
545 1.1 yamt ar->ar_buflen = -bufleft; /* necessary buffer size */
546 1.1 yamt }
547 1.1 yamt
548 1.1 yamt return 0;
549 1.1 yamt }
550 1.1 yamt
551 1.1 yamt static int
552 1.20.10.3 yamt agr_getconfig(struct agr_softc *sc, struct agrreq *ar)
553 1.1 yamt {
554 1.1 yamt int cmd = ar->ar_cmd;
555 1.1 yamt int error;
556 1.1 yamt
557 1.20.10.3 yamt (void)agr_ports_enter(sc);
558 1.1 yamt switch (cmd) {
559 1.1 yamt case AGRCMD_PORTLIST:
560 1.20.10.3 yamt error = agr_getportlist(sc, ar);
561 1.1 yamt break;
562 1.1 yamt
563 1.1 yamt default:
564 1.1 yamt error = EINVAL;
565 1.1 yamt break;
566 1.1 yamt }
567 1.20.10.3 yamt agr_ports_exit(sc);
568 1.1 yamt
569 1.1 yamt return error;
570 1.1 yamt }
571 1.1 yamt
572 1.1 yamt static int
573 1.1 yamt agr_addport(struct ifnet *ifp, struct ifnet *ifp_port)
574 1.1 yamt {
575 1.20 dyoung const struct ifaddr *ifa;
576 1.1 yamt struct agr_softc *sc = ifp->if_softc;
577 1.1 yamt struct agr_port *port = NULL;
578 1.1 yamt int error = 0;
579 1.1 yamt
580 1.1 yamt if (ifp_port->if_ioctl == NULL) {
581 1.1 yamt error = EOPNOTSUPP;
582 1.1 yamt goto out;
583 1.1 yamt }
584 1.1 yamt
585 1.1 yamt if (ifp_port->if_agrprivate) {
586 1.1 yamt error = EBUSY;
587 1.1 yamt goto out;
588 1.1 yamt }
589 1.1 yamt
590 1.1 yamt if (ifp_port->if_start == agr_start) {
591 1.1 yamt error = EINVAL;
592 1.1 yamt goto out;
593 1.1 yamt }
594 1.1 yamt
595 1.1 yamt port = malloc(sizeof(*port) + ifp_port->if_addrlen, M_DEVBUF,
596 1.1 yamt M_WAITOK | M_ZERO);
597 1.1 yamt if (port == NULL) {
598 1.1 yamt error = ENOMEM;
599 1.1 yamt goto out;
600 1.1 yamt }
601 1.1 yamt port->port_flags = AGRPORT_LARVAL;
602 1.1 yamt
603 1.20 dyoung IFADDR_FOREACH(ifa, ifp_port) {
604 1.20 dyoung if (ifa->ifa_addr->sa_family != AF_LINK) {
605 1.20 dyoung error = EBUSY;
606 1.20 dyoung goto out;
607 1.20 dyoung }
608 1.1 yamt }
609 1.1 yamt
610 1.1 yamt if (sc->sc_nports == 0) {
611 1.1 yamt switch (ifp_port->if_type) {
612 1.1 yamt case IFT_ETHER:
613 1.1 yamt sc->sc_iftop = &agrether_ops;
614 1.1 yamt break;
615 1.1 yamt
616 1.1 yamt default:
617 1.1 yamt error = EPROTONOSUPPORT; /* XXX */
618 1.1 yamt goto out;
619 1.1 yamt }
620 1.1 yamt
621 1.1 yamt error = (*sc->sc_iftop->iftop_ctor)(sc, ifp_port);
622 1.1 yamt if (error)
623 1.1 yamt goto out;
624 1.1 yamt agrtimer_start(sc);
625 1.1 yamt } else {
626 1.1 yamt if (ifp->if_type != ifp_port->if_type) {
627 1.1 yamt error = EINVAL;
628 1.1 yamt goto out;
629 1.1 yamt }
630 1.1 yamt if (ifp->if_addrlen != ifp_port->if_addrlen) {
631 1.1 yamt error = EINVAL;
632 1.1 yamt goto out;
633 1.1 yamt }
634 1.1 yamt }
635 1.1 yamt
636 1.14 dyoung memcpy(port->port_origlladdr, CLLADDR(ifp_port->if_sadl),
637 1.1 yamt ifp_port->if_addrlen);
638 1.1 yamt
639 1.1 yamt /*
640 1.1 yamt * start to modify ifp_port.
641 1.1 yamt */
642 1.1 yamt
643 1.20.10.2 yamt /*
644 1.20.10.2 yamt * XXX this should probably be SIOCALIFADDR but that doesn't
645 1.20.10.2 yamt * appear to work (ENOTTY). We want to change the mac address
646 1.20.10.2 yamt * of each port to that of the first port. No need for arps
647 1.20.10.2 yamt * since there are no inet addresses assigned to the ports.
648 1.20.10.2 yamt */
649 1.20.10.1 yamt error = (*ifp_port->if_ioctl)(ifp_port, SIOCINITIFADDR, ifp->if_dl);
650 1.1 yamt
651 1.1 yamt if (error) {
652 1.20.10.1 yamt printf("%s: SIOCINITIFADDR error %d\n", __func__, error);
653 1.1 yamt goto cleanup;
654 1.1 yamt }
655 1.1 yamt port->port_flags |= AGRPORT_LADDRCHANGED;
656 1.1 yamt
657 1.1 yamt ifp->if_type = ifp_port->if_type;
658 1.12 yamt AGR_LOCK(sc);
659 1.1 yamt
660 1.1 yamt port->port_ifp = ifp_port;
661 1.1 yamt ifp_port->if_agrprivate = port;
662 1.1 yamt port->port_agrifp = ifp;
663 1.1 yamt TAILQ_INSERT_TAIL(&sc->sc_ports, port, port_q);
664 1.1 yamt sc->sc_nports++;
665 1.1 yamt
666 1.1 yamt port->port_ioctl = ifp_port->if_ioctl;
667 1.1 yamt ifp_port->if_ioctl = agr_ioctl_filter;
668 1.1 yamt
669 1.1 yamt port->port_flags |= AGRPORT_ATTACHED;
670 1.1 yamt
671 1.12 yamt AGR_UNLOCK(sc);
672 1.1 yamt
673 1.1 yamt error = (*sc->sc_iftop->iftop_portinit)(sc, port);
674 1.1 yamt if (error) {
675 1.1 yamt printf("%s: portinit error %d\n", __func__, error);
676 1.1 yamt goto cleanup;
677 1.1 yamt }
678 1.1 yamt
679 1.1 yamt ifp->if_flags |= IFF_RUNNING;
680 1.1 yamt
681 1.1 yamt agrport_config_promisc(port, (ifp->if_flags & IFF_PROMISC) != 0);
682 1.10 thorpej error = (*sc->sc_iftop->iftop_configmulti_port)(sc, port, true);
683 1.1 yamt if (error) {
684 1.1 yamt printf("%s: configmulti error %d\n", __func__, error);
685 1.1 yamt goto cleanup;
686 1.1 yamt }
687 1.1 yamt
688 1.12 yamt AGR_LOCK(sc);
689 1.1 yamt port->port_flags &= ~AGRPORT_LARVAL;
690 1.12 yamt AGR_UNLOCK(sc);
691 1.1 yamt out:
692 1.1 yamt if (error && port) {
693 1.1 yamt free(port, M_DEVBUF);
694 1.1 yamt }
695 1.1 yamt return error;
696 1.1 yamt
697 1.1 yamt cleanup:
698 1.1 yamt if (agrport_cleanup(sc, port)) {
699 1.1 yamt printf("%s: error on cleanup\n", __func__);
700 1.1 yamt
701 1.1 yamt port = NULL; /* XXX */
702 1.1 yamt }
703 1.1 yamt
704 1.1 yamt if (sc->sc_nports == 0) {
705 1.1 yamt KASSERT(TAILQ_EMPTY(&sc->sc_ports));
706 1.1 yamt agrtimer_stop(sc);
707 1.1 yamt (*sc->sc_iftop->iftop_dtor)(sc);
708 1.1 yamt sc->sc_iftop = NULL;
709 1.1 yamt agr_reset_iftype(ifp);
710 1.1 yamt } else {
711 1.1 yamt KASSERT(!TAILQ_EMPTY(&sc->sc_ports));
712 1.1 yamt }
713 1.1 yamt
714 1.1 yamt goto out;
715 1.1 yamt }
716 1.1 yamt
717 1.1 yamt static int
718 1.1 yamt agr_remport(struct ifnet *ifp, struct ifnet *ifp_port)
719 1.1 yamt {
720 1.1 yamt struct agr_softc *sc = ifp->if_softc;
721 1.1 yamt struct agr_port *port;
722 1.1 yamt int error = 0;
723 1.1 yamt
724 1.1 yamt if (ifp_port->if_agrprivate == NULL) {
725 1.1 yamt error = ENOENT;
726 1.1 yamt return error;
727 1.1 yamt }
728 1.1 yamt
729 1.1 yamt port = ifp_port->if_agrprivate;
730 1.1 yamt if (port->port_agrifp != ifp) {
731 1.1 yamt error = EINVAL;
732 1.1 yamt return error;
733 1.1 yamt }
734 1.1 yamt
735 1.1 yamt KASSERT(sc->sc_nports > 0);
736 1.1 yamt
737 1.12 yamt AGR_LOCK(sc);
738 1.1 yamt port->port_flags |= AGRPORT_DETACHING;
739 1.12 yamt AGR_UNLOCK(sc);
740 1.1 yamt
741 1.1 yamt error = (*sc->sc_iftop->iftop_portfini)(sc, port);
742 1.1 yamt if (error) {
743 1.1 yamt /* XXX XXX */
744 1.1 yamt printf("%s: portfini error %d\n", __func__, error);
745 1.1 yamt goto out;
746 1.1 yamt }
747 1.1 yamt
748 1.10 thorpej error = (*sc->sc_iftop->iftop_configmulti_port)(sc, port, false);
749 1.1 yamt if (error) {
750 1.1 yamt /* XXX XXX */
751 1.1 yamt printf("%s: configmulti_port error %d\n", __func__, error);
752 1.1 yamt goto out;
753 1.1 yamt }
754 1.1 yamt
755 1.1 yamt error = agrport_cleanup(sc, port);
756 1.1 yamt if (error) {
757 1.1 yamt /* XXX XXX */
758 1.1 yamt printf("%s: agrport_cleanup error %d\n", __func__, error);
759 1.1 yamt goto out;
760 1.1 yamt }
761 1.1 yamt
762 1.1 yamt free(port, M_DEVBUF);
763 1.1 yamt
764 1.1 yamt out:
765 1.1 yamt if (sc->sc_nports == 0) {
766 1.1 yamt KASSERT(TAILQ_EMPTY(&sc->sc_ports));
767 1.1 yamt agrtimer_stop(sc);
768 1.1 yamt (*sc->sc_iftop->iftop_dtor)(sc);
769 1.1 yamt sc->sc_iftop = NULL;
770 1.1 yamt /* XXX should purge all addresses? */
771 1.1 yamt agr_reset_iftype(ifp);
772 1.1 yamt } else {
773 1.1 yamt KASSERT(!TAILQ_EMPTY(&sc->sc_ports));
774 1.1 yamt }
775 1.1 yamt
776 1.1 yamt return error;
777 1.1 yamt }
778 1.1 yamt
779 1.1 yamt static int
780 1.1 yamt agrport_cleanup(struct agr_softc *sc, struct agr_port *port)
781 1.1 yamt {
782 1.1 yamt struct ifnet *ifp_port = port->port_ifp;
783 1.1 yamt int error;
784 1.1 yamt int result = 0;
785 1.1 yamt
786 1.10 thorpej error = agrport_config_promisc(port, false);
787 1.1 yamt if (error) {
788 1.1 yamt printf("%s: config_promisc error %d\n", __func__, error);
789 1.1 yamt result = error;
790 1.1 yamt }
791 1.1 yamt
792 1.1 yamt if ((port->port_flags & AGRPORT_LADDRCHANGED)) {
793 1.1 yamt #if 0
794 1.1 yamt memcpy(LLADDR(ifp_port->if_sadl), port->port_origlladdr,
795 1.1 yamt ifp_port->if_addrlen);
796 1.1 yamt if (ifp_port->if_init != NULL) {
797 1.1 yamt error = (*ifp_port->if_init)(ifp_port);
798 1.1 yamt }
799 1.1 yamt #else
800 1.16 dyoung union {
801 1.16 dyoung struct sockaddr sa;
802 1.16 dyoung struct sockaddr_dl sdl;
803 1.16 dyoung struct sockaddr_storage ss;
804 1.16 dyoung } u;
805 1.1 yamt struct ifaddr ifa;
806 1.1 yamt
807 1.16 dyoung sockaddr_dl_init(&u.sdl, sizeof(u.ss),
808 1.16 dyoung 0, ifp_port->if_type, NULL, 0,
809 1.16 dyoung port->port_origlladdr, ifp_port->if_addrlen);
810 1.16 dyoung memset(&ifa, 0, sizeof(ifa));
811 1.16 dyoung ifa.ifa_addr = &u.sa;
812 1.20.10.1 yamt error = agrport_ioctl(port, SIOCINITIFADDR, &ifa);
813 1.1 yamt #endif
814 1.1 yamt if (error) {
815 1.1 yamt printf("%s: if_init error %d\n", __func__, error);
816 1.1 yamt result = error;
817 1.1 yamt } else {
818 1.1 yamt port->port_flags &= ~AGRPORT_LADDRCHANGED;
819 1.1 yamt }
820 1.1 yamt }
821 1.1 yamt
822 1.12 yamt AGR_LOCK(sc);
823 1.1 yamt if ((port->port_flags & AGRPORT_ATTACHED)) {
824 1.1 yamt ifp_port->if_agrprivate = NULL;
825 1.1 yamt
826 1.1 yamt TAILQ_REMOVE(&sc->sc_ports, port, port_q);
827 1.1 yamt sc->sc_nports--;
828 1.1 yamt
829 1.1 yamt KASSERT(ifp_port->if_ioctl == agr_ioctl_filter);
830 1.1 yamt ifp_port->if_ioctl = port->port_ioctl;
831 1.1 yamt
832 1.1 yamt port->port_flags &= ~AGRPORT_ATTACHED;
833 1.1 yamt }
834 1.12 yamt AGR_UNLOCK(sc);
835 1.1 yamt
836 1.1 yamt return result;
837 1.1 yamt }
838 1.1 yamt
839 1.1 yamt static int
840 1.1 yamt agr_ioctl_multi(struct ifnet *ifp, u_long cmd, struct ifreq *ifr)
841 1.1 yamt {
842 1.1 yamt struct agr_softc *sc = ifp->if_softc;
843 1.1 yamt int error;
844 1.1 yamt
845 1.1 yamt error = (*sc->sc_iftop->iftop_configmulti_ifreq)(sc, ifr,
846 1.1 yamt (cmd == SIOCADDMULTI));
847 1.1 yamt
848 1.1 yamt return error;
849 1.1 yamt }
850 1.1 yamt
851 1.20.10.1 yamt /*
852 1.20.10.1 yamt * XXX an incomplete hack; can't filter ioctls handled ifioctl().
853 1.20.10.1 yamt *
854 1.20.10.1 yamt * the intention here is to prevent operations on underlying interfaces
855 1.20.10.1 yamt * so that their states are not changed in the way that agr(4) doesn't
856 1.20.10.1 yamt * expect. cf. the BUGS section in the agr(4) manual page.
857 1.20.10.1 yamt */
858 1.1 yamt static int
859 1.11 christos agr_ioctl_filter(struct ifnet *ifp, u_long cmd, void *arg)
860 1.1 yamt {
861 1.1 yamt struct agr_port *port = ifp->if_agrprivate;
862 1.1 yamt int error;
863 1.1 yamt
864 1.1 yamt KASSERT(port);
865 1.1 yamt
866 1.1 yamt switch (cmd) {
867 1.20.10.1 yamt case SIOCADDMULTI: /* add m'cast addr */
868 1.20.10.1 yamt case SIOCAIFADDR: /* add/chg IF alias */
869 1.20.10.1 yamt case SIOCALIFADDR: /* add IF addr */
870 1.20.10.1 yamt case SIOCDELMULTI: /* del m'cast addr */
871 1.20.10.1 yamt case SIOCDIFADDR: /* delete IF addr */
872 1.20.10.1 yamt case SIOCDIFPHYADDR: /* delete gif addrs */
873 1.20.10.1 yamt case SIOCDLIFADDR: /* delete IF addr */
874 1.20.10.1 yamt case SIOCINITIFADDR:
875 1.20.10.1 yamt case SIOCSDRVSPEC: /* set driver-specific parameters */
876 1.20.10.1 yamt case SIOCSIFADDR: /* set ifnet address */
877 1.20.10.1 yamt case SIOCSIFBRDADDR: /* set broadcast addr */
878 1.20.10.1 yamt case SIOCSIFDSTADDR: /* set p-p address */
879 1.20.10.1 yamt case SIOCSIFGENERIC: /* generic IF set op */
880 1.20.10.1 yamt case SIOCSIFMEDIA: /* set net media */
881 1.20.10.1 yamt case SIOCSIFMETRIC: /* set IF metric */
882 1.20.10.1 yamt case SIOCSIFMTU: /* set ifnet mtu */
883 1.20.10.1 yamt case SIOCSIFNETMASK: /* set net addr mask */
884 1.20.10.1 yamt case SIOCSIFPHYADDR: /* set gif addres */
885 1.20.10.1 yamt case SIOCSLIFPHYADDR: /* set gif addrs */
886 1.20.10.1 yamt case SIOCSVH: /* set carp param */
887 1.20.10.1 yamt error = EBUSY;
888 1.1 yamt break;
889 1.20.10.1 yamt case SIOCSIFCAP: /* XXX */
890 1.20.10.1 yamt case SIOCSIFFLAGS: /* XXX */
891 1.1 yamt default:
892 1.20.10.1 yamt error = agrport_ioctl(port, cmd, arg);
893 1.1 yamt break;
894 1.1 yamt }
895 1.1 yamt return error;
896 1.1 yamt }
897 1.1 yamt
898 1.1 yamt static int
899 1.1 yamt agrreq_copyin(const void *ubuf, struct agrreq *ar)
900 1.1 yamt {
901 1.1 yamt int error;
902 1.1 yamt
903 1.1 yamt error = copyin(ubuf, ar, sizeof(*ar));
904 1.1 yamt if (error) {
905 1.1 yamt return error;
906 1.1 yamt }
907 1.1 yamt
908 1.1 yamt if (ar->ar_version != AGRREQ_VERSION) {
909 1.1 yamt return EINVAL;
910 1.1 yamt }
911 1.1 yamt
912 1.1 yamt return 0;
913 1.1 yamt }
914 1.1 yamt
915 1.1 yamt static int
916 1.1 yamt agrreq_copyout(void *ubuf, struct agrreq *ar)
917 1.1 yamt {
918 1.1 yamt int error;
919 1.1 yamt
920 1.1 yamt KASSERT(ar->ar_version == AGRREQ_VERSION);
921 1.1 yamt
922 1.1 yamt error = copyout(ar, ubuf, sizeof(*ar));
923 1.1 yamt if (error) {
924 1.1 yamt return error;
925 1.1 yamt }
926 1.1 yamt
927 1.1 yamt return 0;
928 1.1 yamt }
929 1.1 yamt
930 1.20.10.3 yamt /* Make sure that if any interrupt handlers are out of the softc. */
931 1.20.10.3 yamt static void
932 1.20.10.3 yamt agr_sync(void)
933 1.20.10.3 yamt {
934 1.20.10.3 yamt uint64_t h;
935 1.20.10.3 yamt
936 1.20.10.3 yamt if (!mp_online)
937 1.20.10.3 yamt return;
938 1.20.10.3 yamt
939 1.20.10.3 yamt h = xc_broadcast(0, (xcfunc_t)nullop, NULL, NULL);
940 1.20.10.3 yamt xc_wait(h);
941 1.20.10.3 yamt }
942 1.20.10.3 yamt
943 1.1 yamt static int
944 1.20.10.3 yamt agr_pause(struct agr_softc *sc)
945 1.20.10.3 yamt {
946 1.20.10.3 yamt int error;
947 1.20.10.3 yamt
948 1.20.10.3 yamt mutex_enter(&sc->sc_entry_mtx);
949 1.20.10.3 yamt if ((error = sc->sc_noentry) != 0)
950 1.20.10.3 yamt goto out;
951 1.20.10.3 yamt
952 1.20.10.3 yamt sc->sc_noentry = EBUSY;
953 1.20.10.3 yamt
954 1.20.10.3 yamt while (sc->sc_insc != 0)
955 1.20.10.3 yamt cv_wait(&sc->sc_insc_cv, &sc->sc_entry_mtx);
956 1.20.10.3 yamt
957 1.20.10.3 yamt if (sc->sc_nports == 0) {
958 1.20.10.3 yamt sc->sc_noentry = ENXIO;
959 1.20.10.3 yamt } else {
960 1.20.10.3 yamt sc->sc_noentry = 0;
961 1.20.10.3 yamt error = EBUSY;
962 1.20.10.3 yamt }
963 1.20.10.3 yamt cv_broadcast(&sc->sc_insc_cv);
964 1.20.10.3 yamt out:
965 1.20.10.3 yamt mutex_exit(&sc->sc_entry_mtx);
966 1.20.10.3 yamt return error;
967 1.20.10.3 yamt }
968 1.20.10.3 yamt
969 1.20.10.3 yamt static void
970 1.20.10.3 yamt agr_evacuate(struct agr_softc *sc)
971 1.20.10.3 yamt {
972 1.20.10.3 yamt mutex_enter(&sc->sc_entry_mtx);
973 1.20.10.3 yamt cv_broadcast(&sc->sc_insc_cv);
974 1.20.10.3 yamt while (sc->sc_insc != 0 || sc->sc_paused != 0)
975 1.20.10.3 yamt cv_wait(&sc->sc_insc_cv, &sc->sc_entry_mtx);
976 1.20.10.3 yamt mutex_exit(&sc->sc_entry_mtx);
977 1.20.10.3 yamt
978 1.20.10.3 yamt agr_sync();
979 1.20.10.3 yamt }
980 1.20.10.3 yamt
981 1.20.10.3 yamt static int
982 1.20.10.3 yamt agr_enter(struct agr_softc *sc)
983 1.20.10.3 yamt {
984 1.20.10.3 yamt int error;
985 1.20.10.3 yamt
986 1.20.10.3 yamt mutex_enter(&sc->sc_entry_mtx);
987 1.20.10.3 yamt sc->sc_paused++;
988 1.20.10.3 yamt while ((error = sc->sc_noentry) == EBUSY)
989 1.20.10.3 yamt cv_wait(&sc->sc_insc_cv, &sc->sc_entry_mtx);
990 1.20.10.3 yamt sc->sc_paused--;
991 1.20.10.3 yamt if (error == 0)
992 1.20.10.3 yamt sc->sc_insc++;
993 1.20.10.3 yamt mutex_exit(&sc->sc_entry_mtx);
994 1.20.10.3 yamt
995 1.20.10.3 yamt return error;
996 1.20.10.3 yamt }
997 1.20.10.3 yamt
998 1.20.10.3 yamt static void
999 1.20.10.3 yamt agr_exit(struct agr_softc *sc)
1000 1.20.10.3 yamt {
1001 1.20.10.3 yamt mutex_enter(&sc->sc_entry_mtx);
1002 1.20.10.3 yamt if (--sc->sc_insc == 0)
1003 1.20.10.3 yamt cv_signal(&sc->sc_insc_cv);
1004 1.20.10.3 yamt mutex_exit(&sc->sc_entry_mtx);
1005 1.20.10.3 yamt }
1006 1.20.10.3 yamt
1007 1.20.10.3 yamt static bool
1008 1.20.10.3 yamt agr_ports_enter(struct agr_softc *sc)
1009 1.20.10.3 yamt {
1010 1.20.10.3 yamt mutex_enter(&sc->sc_entry_mtx);
1011 1.20.10.3 yamt while (sc->sc_wrports != 0)
1012 1.20.10.3 yamt cv_wait(&sc->sc_ports_cv, &sc->sc_entry_mtx);
1013 1.20.10.3 yamt sc->sc_rdports++;
1014 1.20.10.3 yamt mutex_exit(&sc->sc_entry_mtx);
1015 1.20.10.3 yamt
1016 1.20.10.3 yamt return true;
1017 1.20.10.3 yamt }
1018 1.20.10.3 yamt
1019 1.20.10.3 yamt static void
1020 1.20.10.3 yamt agr_ports_exit(struct agr_softc *sc)
1021 1.20.10.3 yamt {
1022 1.20.10.3 yamt mutex_enter(&sc->sc_entry_mtx);
1023 1.20.10.3 yamt if (--sc->sc_rdports == 0)
1024 1.20.10.3 yamt cv_signal(&sc->sc_ports_cv);
1025 1.20.10.3 yamt mutex_exit(&sc->sc_entry_mtx);
1026 1.20.10.3 yamt }
1027 1.20.10.3 yamt
1028 1.20.10.3 yamt static void
1029 1.20.10.3 yamt agr_ports_lock(struct agr_softc *sc)
1030 1.20.10.3 yamt {
1031 1.20.10.3 yamt mutex_enter(&sc->sc_entry_mtx);
1032 1.20.10.3 yamt while (sc->sc_rdports != 0)
1033 1.20.10.3 yamt cv_wait(&sc->sc_ports_cv, &sc->sc_entry_mtx);
1034 1.20.10.3 yamt sc->sc_wrports = true;
1035 1.20.10.3 yamt mutex_exit(&sc->sc_entry_mtx);
1036 1.20.10.3 yamt }
1037 1.20.10.3 yamt
1038 1.20.10.3 yamt static void
1039 1.20.10.3 yamt agr_ports_unlock(struct agr_softc *sc)
1040 1.20.10.3 yamt {
1041 1.20.10.3 yamt mutex_enter(&sc->sc_entry_mtx);
1042 1.20.10.3 yamt sc->sc_wrports = false;
1043 1.20.10.3 yamt cv_signal(&sc->sc_ports_cv);
1044 1.20.10.3 yamt mutex_exit(&sc->sc_entry_mtx);
1045 1.20.10.3 yamt }
1046 1.20.10.3 yamt
1047 1.20.10.3 yamt static int
1048 1.20.10.3 yamt agr_ioctl(struct ifnet *ifp, const u_long cmd, void *data)
1049 1.1 yamt {
1050 1.1 yamt struct agr_softc *sc = ifp->if_softc;
1051 1.1 yamt struct ifreq *ifr = (struct ifreq *)data;
1052 1.1 yamt struct ifaddr *ifa = (struct ifaddr *)data;
1053 1.1 yamt struct agrreq ar;
1054 1.20.10.3 yamt int error;
1055 1.20.10.3 yamt bool in_ports = false;
1056 1.1 yamt int s;
1057 1.1 yamt
1058 1.20.10.3 yamt if ((error = agr_enter(sc)) != 0)
1059 1.20.10.3 yamt return error;
1060 1.1 yamt
1061 1.1 yamt s = splnet();
1062 1.1 yamt
1063 1.1 yamt switch (cmd) {
1064 1.20.10.1 yamt case SIOCINITIFADDR:
1065 1.20.10.3 yamt in_ports = agr_ports_enter(sc);
1066 1.1 yamt if (sc->sc_nports == 0) {
1067 1.1 yamt error = EINVAL;
1068 1.1 yamt break;
1069 1.1 yamt }
1070 1.1 yamt ifp->if_flags |= IFF_UP;
1071 1.1 yamt switch (ifa->ifa_addr->sa_family) {
1072 1.1 yamt #if defined(INET)
1073 1.1 yamt case AF_INET:
1074 1.1 yamt arp_ifinit(ifp, ifa);
1075 1.1 yamt break;
1076 1.1 yamt #endif
1077 1.1 yamt default:
1078 1.1 yamt break;
1079 1.1 yamt }
1080 1.1 yamt break;
1081 1.1 yamt
1082 1.1 yamt #if 0 /* notyet */
1083 1.1 yamt case SIOCSIFMTU:
1084 1.1 yamt #endif
1085 1.1 yamt
1086 1.1 yamt case SIOCSIFFLAGS:
1087 1.20.10.2 yamt /*
1088 1.20.10.2 yamt * Check for a change in vlan status. This ioctl is the
1089 1.20.10.2 yamt * only way we can tell that a vlan has attached or detached.
1090 1.20.10.2 yamt * Note the agr interface must be up.
1091 1.20.10.2 yamt */
1092 1.20.10.2 yamt agr_vlan_check(ifp, sc);
1093 1.20.10.2 yamt
1094 1.20.10.1 yamt if ((error = ifioctl_common(ifp, cmd, data)) != 0)
1095 1.20.10.1 yamt break;
1096 1.1 yamt agr_config_promisc(sc);
1097 1.1 yamt break;
1098 1.1 yamt
1099 1.1 yamt case SIOCSETAGR:
1100 1.1 yamt splx(s);
1101 1.18 elad error = kauth_authorize_network(kauth_cred_get(),
1102 1.7 elad KAUTH_NETWORK_INTERFACE,
1103 1.7 elad KAUTH_REQ_NETWORK_INTERFACE_SETPRIV, ifp, (void *)cmd,
1104 1.7 elad NULL);
1105 1.1 yamt if (!error) {
1106 1.1 yamt error = agrreq_copyin(ifr->ifr_data, &ar);
1107 1.1 yamt }
1108 1.1 yamt if (!error) {
1109 1.20.10.3 yamt error = agr_setconfig(sc, &ar);
1110 1.1 yamt }
1111 1.1 yamt s = splnet();
1112 1.1 yamt break;
1113 1.1 yamt
1114 1.1 yamt case SIOCGETAGR:
1115 1.1 yamt splx(s);
1116 1.1 yamt error = agrreq_copyin(ifr->ifr_data, &ar);
1117 1.1 yamt if (!error) {
1118 1.20.10.3 yamt error = agr_getconfig(sc, &ar);
1119 1.1 yamt }
1120 1.1 yamt if (!error) {
1121 1.1 yamt error = agrreq_copyout(ifr->ifr_data, &ar);
1122 1.1 yamt }
1123 1.1 yamt s = splnet();
1124 1.1 yamt break;
1125 1.1 yamt
1126 1.1 yamt case SIOCADDMULTI:
1127 1.1 yamt case SIOCDELMULTI:
1128 1.20.10.3 yamt in_ports = agr_ports_enter(sc);
1129 1.20.10.3 yamt if (sc->sc_nports == 0)
1130 1.1 yamt error = EINVAL;
1131 1.20.10.3 yamt else
1132 1.20.10.3 yamt error = agr_ioctl_multi(ifp, cmd, ifr);
1133 1.1 yamt break;
1134 1.1 yamt
1135 1.1 yamt default:
1136 1.20.10.1 yamt error = ifioctl_common(ifp, cmd, data);
1137 1.1 yamt break;
1138 1.1 yamt }
1139 1.1 yamt
1140 1.20.10.3 yamt if (in_ports)
1141 1.20.10.3 yamt agr_ports_exit(sc);
1142 1.20.10.3 yamt
1143 1.1 yamt splx(s);
1144 1.1 yamt
1145 1.20.10.3 yamt agr_exit(sc);
1146 1.1 yamt
1147 1.1 yamt return error;
1148 1.1 yamt }
1149 1.1 yamt
1150 1.1 yamt static int
1151 1.1 yamt agr_config_promisc(struct agr_softc *sc)
1152 1.1 yamt {
1153 1.1 yamt int error;
1154 1.1 yamt
1155 1.1 yamt agr_port_foreach(sc, agrport_config_promisc_callback, &error);
1156 1.1 yamt
1157 1.1 yamt return error;
1158 1.1 yamt }
1159 1.1 yamt
1160 1.1 yamt static int
1161 1.1 yamt agrport_config_promisc_callback(struct agr_port *port, void *arg)
1162 1.1 yamt {
1163 1.1 yamt struct agr_softc *sc = AGR_SC_FROM_PORT(port);
1164 1.1 yamt int *errorp = arg;
1165 1.1 yamt int error;
1166 1.9 thorpej bool promisc;
1167 1.1 yamt
1168 1.1 yamt promisc = (sc->sc_if.if_flags & IFF_PROMISC) != 0;
1169 1.1 yamt
1170 1.1 yamt error = agrport_config_promisc(port, promisc);
1171 1.1 yamt if (error) {
1172 1.1 yamt *errorp = error;
1173 1.1 yamt }
1174 1.1 yamt
1175 1.1 yamt return 0;
1176 1.1 yamt }
1177 1.1 yamt
1178 1.1 yamt static int
1179 1.9 thorpej agrport_config_promisc(struct agr_port *port, bool promisc)
1180 1.1 yamt {
1181 1.1 yamt int error;
1182 1.1 yamt
1183 1.1 yamt if (( promisc && (port->port_flags & AGRPORT_PROMISC) != 0) ||
1184 1.1 yamt (!promisc && (port->port_flags & AGRPORT_PROMISC) == 0)) {
1185 1.1 yamt return 0;
1186 1.1 yamt }
1187 1.1 yamt
1188 1.1 yamt error = ifpromisc(port->port_ifp, promisc);
1189 1.1 yamt if (error == 0) {
1190 1.1 yamt if (promisc) {
1191 1.1 yamt port->port_flags |= AGRPORT_PROMISC;
1192 1.1 yamt } else {
1193 1.1 yamt port->port_flags &= ~AGRPORT_PROMISC;
1194 1.1 yamt }
1195 1.1 yamt }
1196 1.1 yamt
1197 1.1 yamt return error;
1198 1.1 yamt }
1199