if_pppoe.c revision 1.175 1 1.175 yamaguch /* $NetBSD: if_pppoe.c,v 1.175 2021/05/19 03:35:27 yamaguchi Exp $ */
2 1.1 martin
3 1.145 maxv /*
4 1.89 martin * Copyright (c) 2002, 2008 The NetBSD Foundation, Inc.
5 1.24 martin * All rights reserved.
6 1.24 martin *
7 1.24 martin * This code is derived from software contributed to The NetBSD Foundation
8 1.51 keihan * by Martin Husemann <martin (at) NetBSD.org>.
9 1.1 martin *
10 1.1 martin * Redistribution and use in source and binary forms, with or without
11 1.1 martin * modification, are permitted provided that the following conditions
12 1.1 martin * are met:
13 1.1 martin * 1. Redistributions of source code must retain the above copyright
14 1.1 martin * notice, this list of conditions and the following disclaimer.
15 1.1 martin * 2. Redistributions in binary form must reproduce the above copyright
16 1.1 martin * notice, this list of conditions and the following disclaimer in the
17 1.1 martin * documentation and/or other materials provided with the distribution.
18 1.1 martin *
19 1.24 martin * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20 1.24 martin * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21 1.24 martin * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 1.24 martin * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23 1.24 martin * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24 1.24 martin * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25 1.24 martin * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26 1.24 martin * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27 1.24 martin * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28 1.24 martin * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 1.24 martin * POSSIBILITY OF SUCH DAMAGE.
30 1.1 martin */
31 1.7 lukem
32 1.7 lukem #include <sys/cdefs.h>
33 1.175 yamaguch __KERNEL_RCSID(0, "$NetBSD: if_pppoe.c,v 1.175 2021/05/19 03:35:27 yamaguchi Exp $");
34 1.1 martin
35 1.112 pgoyette #ifdef _KERNEL_OPT
36 1.1 martin #include "pppoe.h"
37 1.71 pavel #include "opt_pppoe.h"
38 1.120 knakahar #include "opt_net_mpsafe.h"
39 1.104 pooka #endif
40 1.1 martin
41 1.1 martin #include <sys/param.h>
42 1.1 martin #include <sys/systm.h>
43 1.1 martin #include <sys/kernel.h>
44 1.151 yamaguch #include <sys/atomic.h>
45 1.1 martin #include <sys/callout.h>
46 1.1 martin #include <sys/malloc.h>
47 1.1 martin #include <sys/mbuf.h>
48 1.1 martin #include <sys/socket.h>
49 1.1 martin #include <sys/proc.h>
50 1.1 martin #include <sys/ioctl.h>
51 1.68 elad #include <sys/kauth.h>
52 1.81 ad #include <sys/intr.h>
53 1.85 ad #include <sys/socketvar.h>
54 1.112 pgoyette #include <sys/device.h>
55 1.112 pgoyette #include <sys/module.h>
56 1.113 pgoyette #include <sys/sysctl.h>
57 1.120 knakahar #include <sys/rwlock.h>
58 1.120 knakahar #include <sys/mutex.h>
59 1.125 ozaki #include <sys/psref.h>
60 1.143 maxv #include <sys/cprng.h>
61 1.151 yamaguch #include <sys/workqueue.h>
62 1.81 ad
63 1.1 martin #include <net/if.h>
64 1.1 martin #include <net/if_types.h>
65 1.1 martin #include <net/if_ether.h>
66 1.1 martin #include <net/if_sppp.h>
67 1.15 martin #include <net/if_spppvar.h>
68 1.1 martin #include <net/if_pppoe.h>
69 1.136 knakahar #include <net/if_dl.h>
70 1.1 martin
71 1.1 martin #include <net/bpf.h>
72 1.16 aymeric
73 1.103 christos #include "ioconf.h"
74 1.1 martin
75 1.120 knakahar #ifdef NET_MPSAFE
76 1.120 knakahar #define PPPOE_MPSAFE 1
77 1.120 knakahar #endif
78 1.120 knakahar
79 1.29 itojun struct pppoehdr {
80 1.84 matt uint8_t vertype;
81 1.84 matt uint8_t code;
82 1.84 matt uint16_t session;
83 1.84 matt uint16_t plen;
84 1.82 perry } __packed;
85 1.29 itojun
86 1.29 itojun struct pppoetag {
87 1.84 matt uint16_t tag;
88 1.84 matt uint16_t len;
89 1.82 perry } __packed;
90 1.29 itojun
91 1.91 simonb #define PPPOE_HEADERLEN sizeof(struct pppoehdr)
92 1.67 tron #define PPPOE_OVERHEAD (PPPOE_HEADERLEN + 2)
93 1.1 martin #define PPPOE_VERTYPE 0x11 /* VER=1, TYPE = 1 */
94 1.1 martin
95 1.1 martin #define PPPOE_TAG_EOL 0x0000 /* end of list */
96 1.1 martin #define PPPOE_TAG_SNAME 0x0101 /* service name */
97 1.1 martin #define PPPOE_TAG_ACNAME 0x0102 /* access concentrator name */
98 1.1 martin #define PPPOE_TAG_HUNIQUE 0x0103 /* host unique */
99 1.1 martin #define PPPOE_TAG_ACCOOKIE 0x0104 /* AC cookie */
100 1.1 martin #define PPPOE_TAG_VENDOR 0x0105 /* vendor specific */
101 1.1 martin #define PPPOE_TAG_RELAYSID 0x0110 /* relay session id */
102 1.98 rjs #define PPPOE_TAG_MAX_PAYLOAD 0x0120 /* max payload */
103 1.1 martin #define PPPOE_TAG_SNAME_ERR 0x0201 /* service name error */
104 1.1 martin #define PPPOE_TAG_ACSYS_ERR 0x0202 /* AC system error */
105 1.97 rjs #define PPPOE_TAG_GENERIC_ERR 0x0203 /* generic error */
106 1.1 martin
107 1.91 simonb #define PPPOE_CODE_PADI 0x09 /* Active Discovery Initiation */
108 1.1 martin #define PPPOE_CODE_PADO 0x07 /* Active Discovery Offer */
109 1.1 martin #define PPPOE_CODE_PADR 0x19 /* Active Discovery Request */
110 1.1 martin #define PPPOE_CODE_PADS 0x65 /* Active Discovery Session confirmation */
111 1.1 martin #define PPPOE_CODE_PADT 0xA7 /* Active Discovery Terminate */
112 1.1 martin
113 1.19 martin /* two byte PPP protocol discriminator, then IP data */
114 1.67 tron #define PPPOE_MAXMTU (ETHERMTU - PPPOE_OVERHEAD)
115 1.19 martin
116 1.1 martin /* Add a 16 bit unsigned value to a buffer pointed to by PTR */
117 1.1 martin #define PPPOE_ADD_16(PTR, VAL) \
118 1.1 martin *(PTR)++ = (VAL) / 256; \
119 1.1 martin *(PTR)++ = (VAL) % 256
120 1.1 martin
121 1.1 martin /* Add a complete PPPoE header to the buffer pointed to by PTR */
122 1.91 simonb #define PPPOE_ADD_HEADER(PTR, CODE, SESS, LEN) \
123 1.1 martin *(PTR)++ = PPPOE_VERTYPE; \
124 1.1 martin *(PTR)++ = (CODE); \
125 1.1 martin PPPOE_ADD_16(PTR, SESS); \
126 1.1 martin PPPOE_ADD_16(PTR, LEN)
127 1.1 martin
128 1.13 martin #define PPPOE_DISC_TIMEOUT (hz*5) /* base for quick timeout calculation */
129 1.19 martin #define PPPOE_SLOW_RETRY (hz*60) /* persistent retry interval */
130 1.90 martin #define PPPOE_RECON_FAST (hz*15) /* first retry after auth failure */
131 1.92 martin #define PPPOE_RECON_IMMEDIATE (hz/10) /* "no delay" reconnect */
132 1.172 yamaguch #define PPPOE_RECON_PADTRCVD (hz*5) /* reconnect delay after PADT received */
133 1.91 simonb #define PPPOE_DISC_MAXPADI 4 /* retry PADI four times (quickly) */
134 1.12 martin #define PPPOE_DISC_MAXPADR 2 /* retry PADR twice */
135 1.12 martin
136 1.43 oki #ifdef PPPOE_SERVER
137 1.43 oki /* from if_spppsubr.c */
138 1.91 simonb #define IFF_PASSIVE IFF_LINK0 /* wait passively for connection */
139 1.43 oki #endif
140 1.43 oki
141 1.127 knakahar #define PPPOE_LOCK(_sc, _op) rw_enter(&(_sc)->sc_lock, (_op))
142 1.127 knakahar #define PPPOE_UNLOCK(_sc) rw_exit(&(_sc)->sc_lock)
143 1.127 knakahar #define PPPOE_WLOCKED(_sc) rw_write_held(&(_sc)->sc_lock)
144 1.127 knakahar
145 1.120 knakahar #ifdef PPPOE_MPSAFE
146 1.120 knakahar #define DECLARE_SPLNET_VARIABLE
147 1.120 knakahar #define ACQUIRE_SPLNET() do { } while (0)
148 1.120 knakahar #define RELEASE_SPLNET() do { } while (0)
149 1.120 knakahar #else
150 1.120 knakahar #define DECLARE_SPLNET_VARIABLE int __s
151 1.120 knakahar #define ACQUIRE_SPLNET() do { \
152 1.120 knakahar __s = splnet(); \
153 1.120 knakahar } while (0)
154 1.120 knakahar #define RELEASE_SPLNET() do { \
155 1.120 knakahar splx(__s); \
156 1.120 knakahar } while (0)
157 1.120 knakahar #endif
158 1.120 knakahar
159 1.157 yamaguch #ifdef PPPOE_DEBUG
160 1.157 yamaguch #define DPRINTF(_sc, _fmt, _arg...) pppoe_printf((_sc), (_fmt), ##_arg)
161 1.157 yamaguch #else
162 1.157 yamaguch #define DPRINTF(_sc, _fmt, _arg...) __nothing
163 1.157 yamaguch #endif
164 1.157 yamaguch
165 1.1 martin struct pppoe_softc {
166 1.1 martin struct sppp sc_sppp; /* contains a struct ifnet as first element */
167 1.5 martin LIST_ENTRY(pppoe_softc) sc_list;
168 1.1 martin struct ifnet *sc_eth_if; /* ethernet interface we are using */
169 1.26 itojun
170 1.143 maxv uint64_t sc_id; /* id of this softc, our hunique */
171 1.1 martin int sc_state; /* discovery phase or session connected */
172 1.1 martin struct ether_addr sc_dest; /* hardware address of concentrator */
173 1.84 matt uint16_t sc_session; /* PPPoE session id */
174 1.1 martin
175 1.1 martin char *sc_service_name; /* if != NULL: requested name of service */
176 1.1 martin char *sc_concentrator_name; /* if != NULL: requested concentrator id */
177 1.84 matt uint8_t *sc_ac_cookie; /* content of AC cookie we must echo back */
178 1.1 martin size_t sc_ac_cookie_len; /* length of cookie data */
179 1.94 christos uint8_t *sc_relay_sid; /* content of relay SID we must echo back */
180 1.94 christos size_t sc_relay_sid_len; /* length of relay SID data */
181 1.43 oki #ifdef PPPOE_SERVER
182 1.84 matt uint8_t *sc_hunique; /* content of host unique we must echo back */
183 1.43 oki size_t sc_hunique_len; /* length of host unique */
184 1.43 oki #endif
185 1.151 yamaguch callout_t sc_timeout; /* timeout while not in session state */
186 1.151 yamaguch struct workqueue *sc_timeout_wq; /* workqueue for timeout */
187 1.151 yamaguch struct work sc_timeout_wk;
188 1.151 yamaguch u_int sc_timeout_scheduled;
189 1.1 martin int sc_padi_retried; /* number of PADI retries already done */
190 1.1 martin int sc_padr_retried; /* number of PADR retries already done */
191 1.127 knakahar krwlock_t sc_lock; /* lock of sc_state, sc_session, and sc_eth_if */
192 1.167 yamaguch bool sc_detaching;
193 1.1 martin };
194 1.1 martin
195 1.1 martin /* incoming traffic will be queued here */
196 1.72 christos struct ifqueue ppoediscinq = { .ifq_maxlen = IFQ_MAXLEN };
197 1.72 christos struct ifqueue ppoeinq = { .ifq_maxlen = IFQ_MAXLEN };
198 1.1 martin
199 1.77 christos void *pppoe_softintr = NULL;
200 1.1 martin static void pppoe_softintr_handler(void *);
201 1.1 martin
202 1.25 itojun extern int sppp_ioctl(struct ifnet *, unsigned long, void *);
203 1.1 martin
204 1.1 martin /* input routines */
205 1.105 ozaki static void pppoeintr(void);
206 1.25 itojun static void pppoe_disc_input(struct mbuf *);
207 1.29 itojun static void pppoe_dispatch_disc_pkt(struct mbuf *, int);
208 1.29 itojun static void pppoe_data_input(struct mbuf *);
209 1.105 ozaki static void pppoe_enqueue(struct ifqueue *, struct mbuf *);
210 1.1 martin
211 1.1 martin /* management routines */
212 1.25 itojun static int pppoe_connect(struct pppoe_softc *);
213 1.25 itojun static int pppoe_disconnect(struct pppoe_softc *);
214 1.25 itojun static void pppoe_abort_connect(struct pppoe_softc *);
215 1.77 christos static int pppoe_ioctl(struct ifnet *, unsigned long, void *);
216 1.25 itojun static void pppoe_tls(struct sppp *);
217 1.25 itojun static void pppoe_tlf(struct sppp *);
218 1.25 itojun static void pppoe_start(struct ifnet *);
219 1.120 knakahar #ifdef PPPOE_MPSAFE
220 1.120 knakahar static int pppoe_transmit(struct ifnet *, struct mbuf *);
221 1.120 knakahar #endif
222 1.57 martin static void pppoe_clear_softc(struct pppoe_softc *, const char *);
223 1.157 yamaguch static void pppoe_printf(struct pppoe_softc *, const char *, ...);
224 1.1 martin
225 1.1 martin /* internal timeout handling */
226 1.151 yamaguch static void pppoe_timeout_co(void *);
227 1.151 yamaguch static void pppoe_timeout_co_halt(void *);
228 1.151 yamaguch static void pppoe_timeout_wk(struct work *, void *);
229 1.151 yamaguch static void pppoe_timeout(struct pppoe_softc *);
230 1.1 martin
231 1.1 martin /* sending actual protocol controll packets */
232 1.25 itojun static int pppoe_send_padi(struct pppoe_softc *);
233 1.25 itojun static int pppoe_send_padr(struct pppoe_softc *);
234 1.43 oki #ifdef PPPOE_SERVER
235 1.43 oki static int pppoe_send_pado(struct pppoe_softc *);
236 1.43 oki static int pppoe_send_pads(struct pppoe_softc *);
237 1.43 oki #endif
238 1.84 matt static int pppoe_send_padt(struct ifnet *, u_int, const uint8_t *);
239 1.1 martin
240 1.1 martin /* raw output */
241 1.26 itojun static int pppoe_output(struct pppoe_softc *, struct mbuf *);
242 1.1 martin
243 1.1 martin /* internal helper functions */
244 1.129 msaitoh static struct pppoe_softc * pppoe_find_softc_by_session(u_int, struct ifnet *,
245 1.129 msaitoh krw_t);
246 1.120 knakahar static struct pppoe_softc * pppoe_find_softc_by_hunique(uint8_t *, size_t,
247 1.120 knakahar struct ifnet *, krw_t);
248 1.34 martin static struct mbuf *pppoe_get_mbuf(size_t len);
249 1.1 martin
250 1.123 christos static void pppoe_ifattach_hook(void *, unsigned long, void *);
251 1.54 martin
252 1.63 thorpej static LIST_HEAD(pppoe_softc_head, pppoe_softc) pppoe_softc_list;
253 1.120 knakahar static krwlock_t pppoe_softc_list_lock;
254 1.1 martin
255 1.63 thorpej static int pppoe_clone_create(struct if_clone *, int);
256 1.63 thorpej static int pppoe_clone_destroy(struct ifnet *);
257 1.5 martin
258 1.113 pgoyette static bool pppoe_term_unknown = false;
259 1.136 knakahar static int pppoe_term_unknown_pps = 1;
260 1.113 pgoyette
261 1.113 pgoyette static struct sysctllog *pppoe_sysctl_clog;
262 1.117 christos static void sysctl_net_pppoe_setup(struct sysctllog **);
263 1.113 pgoyette
264 1.63 thorpej static struct if_clone pppoe_cloner =
265 1.5 martin IF_CLONE_INITIALIZER("pppoe", pppoe_clone_create, pppoe_clone_destroy);
266 1.5 martin
267 1.5 martin /* ARGSUSED */
268 1.1 martin void
269 1.76 christos pppoeattach(int count)
270 1.5 martin {
271 1.112 pgoyette
272 1.112 pgoyette /*
273 1.114 christos * Nothing to do here, initialization is handled by the
274 1.114 christos * module initialization code in pppoeinit() below).
275 1.112 pgoyette */
276 1.112 pgoyette }
277 1.112 pgoyette
278 1.112 pgoyette static void
279 1.112 pgoyette pppoeinit(void)
280 1.112 pgoyette {
281 1.112 pgoyette
282 1.5 martin LIST_INIT(&pppoe_softc_list);
283 1.120 knakahar rw_init(&pppoe_softc_list_lock);
284 1.5 martin if_clone_attach(&pppoe_cloner);
285 1.5 martin
286 1.120 knakahar pppoe_softintr = softint_establish(SOFTINT_MPSAFE|SOFTINT_NET,
287 1.120 knakahar pppoe_softintr_handler, NULL);
288 1.114 christos sysctl_net_pppoe_setup(&pppoe_sysctl_clog);
289 1.118 ozaki
290 1.118 ozaki IFQ_LOCK_INIT(&ppoediscinq);
291 1.118 ozaki IFQ_LOCK_INIT(&ppoeinq);
292 1.5 martin }
293 1.5 martin
294 1.63 thorpej static int
295 1.112 pgoyette pppoedetach(void)
296 1.112 pgoyette {
297 1.114 christos int error = 0;
298 1.114 christos
299 1.140 yamaguch rw_enter(&pppoe_softc_list_lock, RW_READER);
300 1.140 yamaguch if (!LIST_EMPTY(&pppoe_softc_list)) {
301 1.140 yamaguch rw_exit(&pppoe_softc_list_lock);
302 1.114 christos error = EBUSY;
303 1.140 yamaguch }
304 1.112 pgoyette
305 1.114 christos if (error == 0) {
306 1.114 christos if_clone_detach(&pppoe_cloner);
307 1.114 christos softint_disestablish(pppoe_softintr);
308 1.114 christos /* Remove our sysctl sub-tree */
309 1.114 christos sysctl_teardown(&pppoe_sysctl_clog);
310 1.114 christos }
311 1.112 pgoyette
312 1.114 christos return error;
313 1.112 pgoyette }
314 1.112 pgoyette
315 1.143 maxv static void
316 1.143 maxv pppoe_softc_genid(uint64_t *id)
317 1.143 maxv {
318 1.143 maxv struct pppoe_softc *sc;
319 1.143 maxv uint64_t rndid;
320 1.143 maxv
321 1.143 maxv rw_enter(&pppoe_softc_list_lock, RW_READER);
322 1.143 maxv
323 1.143 maxv while (1) {
324 1.143 maxv rndid = cprng_strong64();
325 1.143 maxv
326 1.143 maxv sc = NULL;
327 1.143 maxv LIST_FOREACH(sc, &pppoe_softc_list, sc_list) {
328 1.143 maxv if (sc->sc_id == rndid)
329 1.143 maxv break;
330 1.143 maxv }
331 1.143 maxv if (sc == NULL) {
332 1.143 maxv break;
333 1.143 maxv }
334 1.143 maxv }
335 1.143 maxv
336 1.143 maxv rw_exit(&pppoe_softc_list_lock);
337 1.143 maxv *id = rndid;
338 1.143 maxv }
339 1.143 maxv
340 1.112 pgoyette static int
341 1.76 christos pppoe_clone_create(struct if_clone *ifc, int unit)
342 1.1 martin {
343 1.1 martin struct pppoe_softc *sc;
344 1.166 yamaguch struct ifnet *ifp;
345 1.129 msaitoh int rv;
346 1.1 martin
347 1.165 yamaguch sc = kmem_zalloc(sizeof(*sc), KM_SLEEP);
348 1.166 yamaguch ifp = &sc->sc_sppp.pp_if;
349 1.5 martin
350 1.164 yamaguch rw_init(&sc->sc_lock);
351 1.143 maxv pppoe_softc_genid(&sc->sc_id);
352 1.166 yamaguch /* changed to real address later */
353 1.166 yamaguch memcpy(&sc->sc_dest, etherbroadcastaddr, sizeof(sc->sc_dest));
354 1.143 maxv
355 1.166 yamaguch if_initname(ifp, "pppoe", unit);
356 1.166 yamaguch ifp->if_softc = sc;
357 1.166 yamaguch ifp->if_mtu = PPPOE_MAXMTU;
358 1.166 yamaguch ifp->if_flags = IFF_SIMPLEX|IFF_POINTOPOINT|IFF_MULTICAST;
359 1.166 yamaguch #ifdef PPPOE_MPSAFE
360 1.166 yamaguch ifp->if_extflags = IFEF_MPSAFE;
361 1.166 yamaguch #endif
362 1.166 yamaguch ifp->if_type = IFT_PPP;
363 1.166 yamaguch ifp->if_hdrlen = sizeof(struct ether_header) + PPPOE_HEADERLEN;
364 1.166 yamaguch ifp->if_dlt = DLT_PPP_ETHER;
365 1.166 yamaguch ifp->if_ioctl = pppoe_ioctl;
366 1.166 yamaguch ifp->if_start = pppoe_start;
367 1.120 knakahar #ifdef PPPOE_MPSAFE
368 1.166 yamaguch ifp->if_transmit = pppoe_transmit;
369 1.120 knakahar #endif
370 1.166 yamaguch IFQ_SET_MAXLEN(&ifp->if_snd, IFQ_MAXLEN);
371 1.166 yamaguch IFQ_SET_READY(&ifp->if_snd);
372 1.166 yamaguch
373 1.166 yamaguch sc->sc_sppp.pp_tls = pppoe_tls;
374 1.166 yamaguch sc->sc_sppp.pp_tlf = pppoe_tlf;
375 1.28 itojun sc->sc_sppp.pp_flags |= PP_KEEPALIVE | /* use LCP keepalive */
376 1.11 martin PP_NOFRAMING; /* no serial encapsulation */
377 1.166 yamaguch sc->sc_sppp.pp_framebytes = PPPOE_HEADERLEN; /* framing added to ppp packets */
378 1.5 martin
379 1.151 yamaguch rv = workqueue_create(&sc->sc_timeout_wq,
380 1.166 yamaguch ifp->if_xname, pppoe_timeout_wk, sc,
381 1.151 yamaguch PRI_SOFTNET, IPL_SOFTNET, 0);
382 1.163 yamaguch if (rv != 0)
383 1.164 yamaguch goto destroy_sclock;
384 1.151 yamaguch
385 1.130 knakahar callout_init(&sc->sc_timeout, CALLOUT_MPSAFE);
386 1.151 yamaguch callout_setfunc(&sc->sc_timeout, pppoe_timeout_co, sc);
387 1.5 martin
388 1.166 yamaguch rv = if_initialize(ifp);
389 1.163 yamaguch if (rv != 0)
390 1.163 yamaguch goto destroy_timeout;
391 1.163 yamaguch
392 1.166 yamaguch ifp->if_percpuq = if_percpuq_create(ifp);
393 1.1 martin
394 1.140 yamaguch rw_enter(&pppoe_softc_list_lock, RW_READER);
395 1.99 rmind if (LIST_EMPTY(&pppoe_softc_list)) {
396 1.122 christos pfil_add_ihook(pppoe_ifattach_hook, NULL, PFIL_IFNET, if_pfil);
397 1.99 rmind }
398 1.166 yamaguch LIST_INSERT_HEAD(&pppoe_softc_list, sc, sc_list);
399 1.140 yamaguch rw_exit(&pppoe_softc_list_lock);
400 1.140 yamaguch
401 1.166 yamaguch sppp_attach(ifp);
402 1.166 yamaguch bpf_attach(ifp, DLT_PPP_ETHER, 0);
403 1.166 yamaguch if_register(ifp);
404 1.120 knakahar
405 1.5 martin return 0;
406 1.163 yamaguch
407 1.163 yamaguch destroy_timeout:
408 1.163 yamaguch callout_destroy(&sc->sc_timeout);
409 1.163 yamaguch workqueue_destroy(sc->sc_timeout_wq);
410 1.164 yamaguch destroy_sclock:
411 1.164 yamaguch rw_destroy(&sc->sc_lock);
412 1.165 yamaguch kmem_free(sc, sizeof(*sc));
413 1.164 yamaguch
414 1.163 yamaguch return rv;
415 1.5 martin }
416 1.1 martin
417 1.63 thorpej static int
418 1.63 thorpej pppoe_clone_destroy(struct ifnet *ifp)
419 1.5 martin {
420 1.5 martin struct pppoe_softc * sc = ifp->if_softc;
421 1.1 martin
422 1.167 yamaguch PPPOE_LOCK(sc, RW_WRITER);
423 1.167 yamaguch /* stop ioctls */
424 1.167 yamaguch sc->sc_detaching = true;
425 1.120 knakahar
426 1.167 yamaguch if (ifp->if_flags & IFF_RUNNING) {
427 1.167 yamaguch pppoe_clear_softc(sc, "destroy interface");
428 1.167 yamaguch sc->sc_eth_if = NULL;
429 1.167 yamaguch }
430 1.167 yamaguch PPPOE_UNLOCK(sc);
431 1.120 knakahar
432 1.167 yamaguch rw_enter(&pppoe_softc_list_lock, RW_WRITER);
433 1.5 martin LIST_REMOVE(sc, sc_list);
434 1.120 knakahar
435 1.99 rmind if (LIST_EMPTY(&pppoe_softc_list)) {
436 1.122 christos pfil_remove_ihook(pppoe_ifattach_hook, NULL, PFIL_IFNET, if_pfil);
437 1.99 rmind }
438 1.120 knakahar rw_exit(&pppoe_softc_list_lock);
439 1.120 knakahar
440 1.169 yamaguch bpf_detach(ifp);
441 1.169 yamaguch sppp_detach(&sc->sc_sppp.pp_if);
442 1.169 yamaguch if_detach(ifp);
443 1.169 yamaguch
444 1.167 yamaguch callout_setfunc(&sc->sc_timeout, pppoe_timeout_co_halt, sc);
445 1.169 yamaguch
446 1.167 yamaguch workqueue_wait(sc->sc_timeout_wq, &sc->sc_timeout_wk);
447 1.169 yamaguch workqueue_destroy(sc->sc_timeout_wq);
448 1.169 yamaguch
449 1.167 yamaguch callout_halt(&sc->sc_timeout, NULL);
450 1.169 yamaguch callout_destroy(&sc->sc_timeout);
451 1.167 yamaguch
452 1.170 yamaguch #ifdef PPPOE_SERVER
453 1.170 yamaguch if (sc->sc_hunique) {
454 1.170 yamaguch free(sc->sc_hunique, M_DEVBUF);
455 1.170 yamaguch sc->sc_hunique = NULL;
456 1.170 yamaguch sc->sc_hunique_len = 0;
457 1.170 yamaguch }
458 1.170 yamaguch #endif
459 1.32 yamt if (sc->sc_concentrator_name)
460 1.32 yamt free(sc->sc_concentrator_name, M_DEVBUF);
461 1.32 yamt if (sc->sc_service_name)
462 1.32 yamt free(sc->sc_service_name, M_DEVBUF);
463 1.32 yamt if (sc->sc_ac_cookie)
464 1.32 yamt free(sc->sc_ac_cookie, M_DEVBUF);
465 1.94 christos if (sc->sc_relay_sid)
466 1.94 christos free(sc->sc_relay_sid, M_DEVBUF);
467 1.120 knakahar
468 1.127 knakahar rw_destroy(&sc->sc_lock);
469 1.120 knakahar
470 1.165 yamaguch kmem_free(sc, sizeof(*sc));
471 1.56 peter
472 1.129 msaitoh return 0;
473 1.1 martin }
474 1.1 martin
475 1.157 yamaguch static void
476 1.157 yamaguch pppoe_printf(struct pppoe_softc *sc, const char *fmt, ...)
477 1.157 yamaguch {
478 1.157 yamaguch va_list ap;
479 1.157 yamaguch bool pppoe_debug;
480 1.157 yamaguch
481 1.157 yamaguch #ifdef PPPOE_DEBUG
482 1.157 yamaguch pppoe_debug = true;
483 1.157 yamaguch #else
484 1.157 yamaguch pppoe_debug = false;
485 1.157 yamaguch #endif
486 1.157 yamaguch
487 1.157 yamaguch if (sc == NULL) {
488 1.157 yamaguch if (!pppoe_debug)
489 1.157 yamaguch return;
490 1.157 yamaguch
491 1.157 yamaguch printf("pppoe: ");
492 1.157 yamaguch } else {
493 1.157 yamaguch if (!ISSET(sc->sc_sppp.pp_if.if_flags, IFF_DEBUG))
494 1.157 yamaguch return;
495 1.157 yamaguch
496 1.157 yamaguch printf("%s: ", sc->sc_sppp.pp_if.if_xname);
497 1.157 yamaguch }
498 1.157 yamaguch
499 1.157 yamaguch va_start(ap, fmt);
500 1.157 yamaguch vprintf(fmt, ap);
501 1.157 yamaguch va_end(ap);
502 1.157 yamaguch }
503 1.157 yamaguch
504 1.1 martin /*
505 1.1 martin * Find the interface handling the specified session.
506 1.1 martin * Note: O(number of sessions open), this is a client-side only, mean
507 1.1 martin * and lean implementation, so number of open sessions typically should
508 1.1 martin * be 1.
509 1.1 martin */
510 1.1 martin static struct pppoe_softc *
511 1.120 knakahar pppoe_find_softc_by_session(u_int session, struct ifnet *rcvif, krw_t lock)
512 1.1 martin {
513 1.120 knakahar struct pppoe_softc *sc = NULL;
514 1.1 martin
515 1.26 itojun if (session == 0)
516 1.26 itojun return NULL;
517 1.120 knakahar rw_enter(&pppoe_softc_list_lock, RW_READER);
518 1.5 martin LIST_FOREACH(sc, &pppoe_softc_list, sc_list) {
519 1.127 knakahar PPPOE_LOCK(sc, lock);
520 1.127 knakahar if ( sc->sc_state == PPPOE_STATE_SESSION
521 1.93 scw && sc->sc_session == session
522 1.93 scw && sc->sc_eth_if == rcvif)
523 1.120 knakahar break;
524 1.120 knakahar
525 1.127 knakahar PPPOE_UNLOCK(sc);
526 1.1 martin }
527 1.120 knakahar rw_exit(&pppoe_softc_list_lock);
528 1.120 knakahar return sc;
529 1.1 martin }
530 1.1 martin
531 1.1 martin /* Check host unique token passed and return appropriate softc pointer,
532 1.1 martin * or NULL if token is bogus. */
533 1.1 martin static struct pppoe_softc *
534 1.120 knakahar pppoe_find_softc_by_hunique(uint8_t *token, size_t len,
535 1.120 knakahar struct ifnet *rcvif, krw_t lock)
536 1.1 martin {
537 1.143 maxv struct pppoe_softc *sc;
538 1.143 maxv uint64_t t;
539 1.143 maxv
540 1.143 maxv CTASSERT(sizeof(t) == sizeof(sc->sc_id));
541 1.9 martin
542 1.140 yamaguch rw_enter(&pppoe_softc_list_lock, RW_READER);
543 1.140 yamaguch if (LIST_EMPTY(&pppoe_softc_list)) {
544 1.140 yamaguch rw_exit(&pppoe_softc_list_lock);
545 1.26 itojun return NULL;
546 1.140 yamaguch }
547 1.9 martin
548 1.143 maxv if (len != sizeof(sc->sc_id)) {
549 1.140 yamaguch rw_exit(&pppoe_softc_list_lock);
550 1.26 itojun return NULL;
551 1.140 yamaguch }
552 1.5 martin memcpy(&t, token, len);
553 1.5 martin
554 1.120 knakahar LIST_FOREACH(sc, &pppoe_softc_list, sc_list) {
555 1.159 yamaguch PPPOE_LOCK(sc, lock);
556 1.160 yamaguch if (sc->sc_id == t && sc->sc_eth_if != NULL) {
557 1.120 knakahar break;
558 1.120 knakahar }
559 1.159 yamaguch PPPOE_UNLOCK(sc);
560 1.120 knakahar }
561 1.120 knakahar rw_exit(&pppoe_softc_list_lock);
562 1.5 martin
563 1.40 aymeric if (sc == NULL) {
564 1.157 yamaguch pppoe_printf(NULL, "alien host unique tag"
565 1.157 yamaguch ", no session found\n");
566 1.1 martin return NULL;
567 1.1 martin }
568 1.5 martin
569 1.1 martin /* should be safe to access *sc now */
570 1.1 martin if (sc->sc_state < PPPOE_STATE_PADI_SENT || sc->sc_state >= PPPOE_STATE_SESSION) {
571 1.157 yamaguch pppoe_printf(sc, "host unique tag found"
572 1.157 yamaguch ", but it belongs to a connection in state %d\n",
573 1.157 yamaguch sc->sc_state);
574 1.127 knakahar PPPOE_UNLOCK(sc);
575 1.1 martin return NULL;
576 1.1 martin }
577 1.1 martin if (sc->sc_eth_if != rcvif) {
578 1.157 yamaguch pppoe_printf(sc, "wrong interface, not accepting host unique\n");
579 1.127 knakahar PPPOE_UNLOCK(sc);
580 1.1 martin return NULL;
581 1.1 martin }
582 1.1 martin return sc;
583 1.1 martin }
584 1.1 martin
585 1.63 thorpej static void
586 1.76 christos pppoe_softintr_handler(void *dummy)
587 1.1 martin {
588 1.1 martin /* called at splsoftnet() */
589 1.105 ozaki pppoeintr();
590 1.1 martin }
591 1.1 martin
592 1.1 martin /* called at appropriate protection level */
593 1.1 martin static void
594 1.105 ozaki pppoeintr(void)
595 1.1 martin {
596 1.1 martin struct mbuf *m;
597 1.175 yamaguch int i;
598 1.1 martin
599 1.132 ozaki SOFTNET_LOCK_UNLESS_NET_MPSAFE();
600 1.120 knakahar
601 1.175 yamaguch for (i = 0; i < IFQ_MAXLEN; i++) {
602 1.175 yamaguch IFQ_LOCK(&ppoediscinq);
603 1.175 yamaguch IF_DEQUEUE(&ppoediscinq, m);
604 1.175 yamaguch IFQ_UNLOCK(&ppoediscinq);
605 1.175 yamaguch if (m == NULL)
606 1.175 yamaguch break;
607 1.175 yamaguch pppoe_disc_input(m);
608 1.175 yamaguch }
609 1.3 martin
610 1.175 yamaguch for (i = 0; i < IFQ_MAXLEN; i++) {
611 1.175 yamaguch IFQ_LOCK(&ppoeinq);
612 1.175 yamaguch IF_DEQUEUE(&ppoeinq, m);
613 1.175 yamaguch IFQ_UNLOCK(&ppoeinq);
614 1.175 yamaguch if (m == NULL)
615 1.175 yamaguch break;
616 1.175 yamaguch pppoe_data_input(m);
617 1.175 yamaguch }
618 1.162 yamaguch
619 1.132 ozaki SOFTNET_UNLOCK_UNLESS_NET_MPSAFE();
620 1.1 martin }
621 1.1 martin
622 1.1 martin /* analyze and handle a single received packet while not in session state */
623 1.63 thorpej static void
624 1.63 thorpej pppoe_dispatch_disc_pkt(struct mbuf *m, int off)
625 1.1 martin {
626 1.84 matt uint16_t tag, len;
627 1.84 matt uint16_t session, plen;
628 1.1 martin struct pppoe_softc *sc;
629 1.120 knakahar const char *err_msg;
630 1.64 martin char *error;
631 1.149 mlelstv size_t dlen;
632 1.84 matt uint8_t *ac_cookie;
633 1.1 martin size_t ac_cookie_len;
634 1.94 christos uint8_t *relay_sid;
635 1.94 christos size_t relay_sid_len;
636 1.84 matt uint8_t *hunique;
637 1.43 oki size_t hunique_len;
638 1.29 itojun struct pppoehdr *ph;
639 1.29 itojun struct pppoetag *pt;
640 1.29 itojun struct mbuf *n;
641 1.46 martin int noff, err, errortag;
642 1.29 itojun struct ether_header *eh;
643 1.139 yamaguch struct ifnet *rcvif;
644 1.139 yamaguch struct psref psref;
645 1.29 itojun
646 1.29 itojun if (m->m_len < sizeof(*eh)) {
647 1.29 itojun m = m_pullup(m, sizeof(*eh));
648 1.145 maxv if (m == NULL)
649 1.29 itojun goto done;
650 1.29 itojun }
651 1.29 itojun eh = mtod(m, struct ether_header *);
652 1.29 itojun off += sizeof(*eh);
653 1.1 martin
654 1.171 yamaguch if (m->m_pkthdr.len - off < PPPOE_HEADERLEN) {
655 1.29 itojun goto done;
656 1.29 itojun }
657 1.29 itojun
658 1.146 maxv M_REGION_GET(ph, struct pppoehdr *, m, off, sizeof(*ph));
659 1.146 maxv if (ph == NULL) {
660 1.29 itojun goto done;
661 1.29 itojun }
662 1.29 itojun if (ph->vertype != PPPOE_VERTYPE) {
663 1.29 itojun goto done;
664 1.29 itojun }
665 1.146 maxv
666 1.146 maxv ac_cookie = NULL;
667 1.146 maxv ac_cookie_len = 0;
668 1.146 maxv relay_sid = NULL;
669 1.146 maxv relay_sid_len = 0;
670 1.146 maxv hunique = NULL;
671 1.146 maxv hunique_len = 0;
672 1.146 maxv
673 1.29 itojun session = ntohs(ph->session);
674 1.29 itojun plen = ntohs(ph->plen);
675 1.29 itojun off += sizeof(*ph);
676 1.29 itojun
677 1.29 itojun if (plen + off > m->m_pkthdr.len) {
678 1.29 itojun goto done;
679 1.1 martin }
680 1.29 itojun m_adj(m, off + plen - m->m_pkthdr.len); /* ignore trailing garbage */
681 1.145 maxv
682 1.1 martin tag = 0;
683 1.1 martin len = 0;
684 1.1 martin sc = NULL;
685 1.146 maxv err_msg = NULL;
686 1.146 maxv errortag = 0;
687 1.31 yamt while (off + sizeof(*pt) <= m->m_pkthdr.len) {
688 1.146 maxv M_REGION_GET(pt, struct pppoetag *, m, off, sizeof(*pt));
689 1.146 maxv if (pt == NULL) {
690 1.29 itojun goto done;
691 1.29 itojun }
692 1.146 maxv
693 1.29 itojun tag = ntohs(pt->tag);
694 1.29 itojun len = ntohs(pt->len);
695 1.88 martin if (off + len + sizeof(*pt) > m->m_pkthdr.len) {
696 1.29 itojun goto done;
697 1.1 martin }
698 1.1 martin switch (tag) {
699 1.1 martin case PPPOE_TAG_EOL:
700 1.29 itojun goto breakbreak;
701 1.1 martin case PPPOE_TAG_SNAME:
702 1.1 martin break; /* ignored */
703 1.1 martin case PPPOE_TAG_ACNAME:
704 1.139 yamaguch if (len > 0) {
705 1.149 mlelstv dlen = 4 * len + 1;
706 1.149 mlelstv error = malloc(dlen, M_TEMP, M_NOWAIT);
707 1.124 maxv if (error == NULL)
708 1.124 maxv break;
709 1.124 maxv
710 1.124 maxv n = m_pulldown(m, off + sizeof(*pt), len,
711 1.124 maxv &noff);
712 1.124 maxv if (!n) {
713 1.124 maxv m = NULL;
714 1.80 martin free(error, M_TEMP);
715 1.124 maxv goto done;
716 1.80 martin }
717 1.124 maxv
718 1.149 mlelstv strnvisx(error, dlen,
719 1.149 mlelstv mtod(n, char*) + noff, len,
720 1.149 mlelstv VIS_SAFE | VIS_OCTAL);
721 1.157 yamaguch pppoe_printf(NULL, "connected to %s\n", error);
722 1.124 maxv free(error, M_TEMP);
723 1.80 martin }
724 1.1 martin break; /* ignored */
725 1.139 yamaguch case PPPOE_TAG_HUNIQUE:
726 1.139 yamaguch if (hunique == NULL) {
727 1.139 yamaguch n = m_pulldown(m, off + sizeof(*pt), len,
728 1.139 yamaguch &noff);
729 1.139 yamaguch if (!n) {
730 1.139 yamaguch m = NULL;
731 1.139 yamaguch err_msg = "TAG HUNIQUE ERROR";
732 1.139 yamaguch break;
733 1.139 yamaguch }
734 1.125 ozaki
735 1.139 yamaguch hunique = mtod(n, uint8_t *) + noff;
736 1.139 yamaguch hunique_len = len;
737 1.120 knakahar }
738 1.1 martin break;
739 1.1 martin case PPPOE_TAG_ACCOOKIE:
740 1.1 martin if (ac_cookie == NULL) {
741 1.29 itojun n = m_pulldown(m, off + sizeof(*pt), len,
742 1.29 itojun &noff);
743 1.29 itojun if (!n) {
744 1.29 itojun err_msg = "TAG ACCOOKIE ERROR";
745 1.29 itojun m = NULL;
746 1.29 itojun break;
747 1.29 itojun }
748 1.77 christos ac_cookie = mtod(n, char *) + noff;
749 1.1 martin ac_cookie_len = len;
750 1.1 martin }
751 1.1 martin break;
752 1.94 christos case PPPOE_TAG_RELAYSID:
753 1.94 christos if (relay_sid == NULL) {
754 1.94 christos n = m_pulldown(m, off + sizeof(*pt), len,
755 1.94 christos &noff);
756 1.94 christos if (!n) {
757 1.94 christos err_msg = "TAG RELAYSID ERROR";
758 1.94 christos m = NULL;
759 1.94 christos break;
760 1.94 christos }
761 1.94 christos relay_sid = mtod(n, char *) + noff;
762 1.94 christos relay_sid_len = len;
763 1.94 christos }
764 1.94 christos break;
765 1.1 martin case PPPOE_TAG_SNAME_ERR:
766 1.1 martin err_msg = "SERVICE NAME ERROR";
767 1.46 martin errortag = 1;
768 1.1 martin break;
769 1.1 martin case PPPOE_TAG_ACSYS_ERR:
770 1.1 martin err_msg = "AC SYSTEM ERROR";
771 1.46 martin errortag = 1;
772 1.1 martin break;
773 1.1 martin case PPPOE_TAG_GENERIC_ERR:
774 1.1 martin err_msg = "GENERIC ERROR";
775 1.46 martin errortag = 1;
776 1.1 martin break;
777 1.1 martin }
778 1.1 martin if (err_msg) {
779 1.64 martin error = NULL;
780 1.46 martin if (errortag && len) {
781 1.149 mlelstv dlen = 4 * len + 1;
782 1.149 mlelstv error = malloc(dlen, M_TEMP,
783 1.124 maxv M_NOWAIT|M_ZERO);
784 1.46 martin n = m_pulldown(m, off + sizeof(*pt), len,
785 1.46 martin &noff);
786 1.124 maxv if (!n) {
787 1.124 maxv m = NULL;
788 1.124 maxv } else if (error) {
789 1.149 mlelstv strnvisx(error, dlen,
790 1.149 mlelstv mtod(n, char*) + noff, len,
791 1.149 mlelstv VIS_SAFE | VIS_OCTAL);
792 1.64 martin }
793 1.46 martin }
794 1.64 martin if (error) {
795 1.157 yamaguch pppoe_printf(NULL, "%s: %s\n", err_msg, error);
796 1.64 martin free(error, M_TEMP);
797 1.64 martin } else
798 1.157 yamaguch pppoe_printf(NULL, "%s\n", err_msg);
799 1.88 martin if (errortag || m == NULL)
800 1.46 martin goto done;
801 1.1 martin }
802 1.29 itojun off += sizeof(*pt) + len;
803 1.1 martin }
804 1.29 itojun breakbreak:;
805 1.145 maxv
806 1.29 itojun switch (ph->code) {
807 1.1 martin case PPPOE_CODE_PADI:
808 1.43 oki #ifdef PPPOE_SERVER
809 1.43 oki /*
810 1.43 oki * got service name, concentrator name, and/or host unique.
811 1.43 oki * ignore if we have no interfaces with IFF_PASSIVE|IFF_UP.
812 1.43 oki */
813 1.140 yamaguch rw_enter(&pppoe_softc_list_lock, RW_READER);
814 1.140 yamaguch if (LIST_EMPTY(&pppoe_softc_list)) {
815 1.140 yamaguch rw_exit(&pppoe_softc_list_lock);
816 1.43 oki goto done;
817 1.140 yamaguch }
818 1.140 yamaguch
819 1.43 oki LIST_FOREACH(sc, &pppoe_softc_list, sc_list) {
820 1.127 knakahar PPPOE_LOCK(sc, RW_WRITER);
821 1.120 knakahar if (!(sc->sc_sppp.pp_if.if_flags & IFF_UP)) {
822 1.127 knakahar PPPOE_UNLOCK(sc);
823 1.43 oki continue;
824 1.120 knakahar }
825 1.120 knakahar if (!(sc->sc_sppp.pp_if.if_flags & IFF_PASSIVE)) {
826 1.127 knakahar PPPOE_UNLOCK(sc);
827 1.43 oki continue;
828 1.120 knakahar }
829 1.120 knakahar
830 1.127 knakahar if (sc->sc_state == PPPOE_STATE_INITIAL)
831 1.43 oki break;
832 1.120 knakahar
833 1.127 knakahar PPPOE_UNLOCK(sc);
834 1.43 oki }
835 1.120 knakahar rw_exit(&pppoe_softc_list_lock);
836 1.120 knakahar
837 1.43 oki if (sc == NULL) {
838 1.43 oki goto done;
839 1.43 oki }
840 1.120 knakahar
841 1.43 oki if (hunique) {
842 1.43 oki if (sc->sc_hunique)
843 1.43 oki free(sc->sc_hunique, M_DEVBUF);
844 1.43 oki sc->sc_hunique = malloc(hunique_len, M_DEVBUF,
845 1.43 oki M_DONTWAIT);
846 1.120 knakahar if (sc->sc_hunique == NULL) {
847 1.127 knakahar PPPOE_UNLOCK(sc);
848 1.43 oki goto done;
849 1.120 knakahar }
850 1.43 oki sc->sc_hunique_len = hunique_len;
851 1.43 oki memcpy(sc->sc_hunique, hunique, hunique_len);
852 1.43 oki }
853 1.44 oki memcpy(&sc->sc_dest, eh->ether_shost, sizeof sc->sc_dest);
854 1.43 oki sc->sc_state = PPPOE_STATE_PADO_SENT;
855 1.43 oki pppoe_send_pado(sc);
856 1.127 knakahar PPPOE_UNLOCK(sc);
857 1.43 oki break;
858 1.43 oki #endif /* PPPOE_SERVER */
859 1.145 maxv
860 1.1 martin case PPPOE_CODE_PADR:
861 1.43 oki #ifdef PPPOE_SERVER
862 1.43 oki /*
863 1.43 oki * get sc from ac_cookie if IFF_PASSIVE
864 1.43 oki */
865 1.43 oki if (ac_cookie == NULL) {
866 1.43 oki goto done;
867 1.43 oki }
868 1.125 ozaki
869 1.125 ozaki rcvif = m_get_rcvif_psref(m, &psref);
870 1.125 ozaki if (__predict_true(rcvif != NULL)) {
871 1.125 ozaki sc = pppoe_find_softc_by_hunique(ac_cookie,
872 1.145 maxv ac_cookie_len, rcvif, RW_WRITER);
873 1.125 ozaki }
874 1.125 ozaki m_put_rcvif_psref(rcvif, &psref);
875 1.43 oki if (sc == NULL) {
876 1.43 oki /* be quiet if there is not a single pppoe instance */
877 1.140 yamaguch rw_enter(&pppoe_softc_list_lock, RW_READER);
878 1.140 yamaguch if (!LIST_EMPTY(&pppoe_softc_list)) {
879 1.157 yamaguch pppoe_printf(NULL, "received PADR"
880 1.140 yamaguch " but could not find request for it\n");
881 1.140 yamaguch }
882 1.140 yamaguch rw_exit(&pppoe_softc_list_lock);
883 1.43 oki goto done;
884 1.43 oki }
885 1.120 knakahar
886 1.127 knakahar if (sc->sc_state != PPPOE_STATE_PADO_SENT) {
887 1.157 yamaguch pppoe_printf(sc, "received unexpected PADR\n");
888 1.127 knakahar PPPOE_UNLOCK(sc);
889 1.43 oki goto done;
890 1.43 oki }
891 1.127 knakahar
892 1.43 oki if (hunique) {
893 1.43 oki if (sc->sc_hunique)
894 1.43 oki free(sc->sc_hunique, M_DEVBUF);
895 1.43 oki sc->sc_hunique = malloc(hunique_len, M_DEVBUF,
896 1.43 oki M_DONTWAIT);
897 1.120 knakahar if (sc->sc_hunique == NULL) {
898 1.127 knakahar PPPOE_UNLOCK(sc);
899 1.43 oki goto done;
900 1.120 knakahar }
901 1.43 oki sc->sc_hunique_len = hunique_len;
902 1.43 oki memcpy(sc->sc_hunique, hunique, hunique_len);
903 1.43 oki }
904 1.43 oki pppoe_send_pads(sc);
905 1.43 oki sc->sc_state = PPPOE_STATE_SESSION;
906 1.127 knakahar PPPOE_UNLOCK(sc);
907 1.120 knakahar
908 1.43 oki sc->sc_sppp.pp_up(&sc->sc_sppp);
909 1.43 oki break;
910 1.43 oki #else
911 1.1 martin /* ignore, we are no access concentrator */
912 1.29 itojun goto done;
913 1.43 oki #endif /* PPPOE_SERVER */
914 1.145 maxv
915 1.1 martin case PPPOE_CODE_PADO:
916 1.139 yamaguch rcvif = m_get_rcvif_psref(m, &psref);
917 1.139 yamaguch if (__predict_false(rcvif == NULL))
918 1.139 yamaguch goto done;
919 1.139 yamaguch
920 1.139 yamaguch if (hunique != NULL) {
921 1.139 yamaguch sc = pppoe_find_softc_by_hunique(hunique,
922 1.145 maxv hunique_len, rcvif, RW_WRITER);
923 1.139 yamaguch }
924 1.139 yamaguch
925 1.139 yamaguch m_put_rcvif_psref(rcvif, &psref);
926 1.139 yamaguch
927 1.1 martin if (sc == NULL) {
928 1.33 tron /* be quiet if there is not a single pppoe instance */
929 1.140 yamaguch rw_enter(&pppoe_softc_list_lock, RW_READER);
930 1.140 yamaguch if (!LIST_EMPTY(&pppoe_softc_list)) {
931 1.157 yamaguch pppoe_printf(NULL, "received PADO"
932 1.140 yamaguch " but could not find request for it\n");
933 1.140 yamaguch }
934 1.140 yamaguch rw_exit(&pppoe_softc_list_lock);
935 1.29 itojun goto done;
936 1.1 martin }
937 1.120 knakahar
938 1.127 knakahar if (sc->sc_state != PPPOE_STATE_PADI_SENT) {
939 1.157 yamaguch pppoe_printf(sc, "received unexpected PADO\n");
940 1.127 knakahar PPPOE_UNLOCK(sc);
941 1.29 itojun goto done;
942 1.1 martin }
943 1.120 knakahar
944 1.1 martin if (ac_cookie) {
945 1.32 yamt if (sc->sc_ac_cookie)
946 1.32 yamt free(sc->sc_ac_cookie, M_DEVBUF);
947 1.29 itojun sc->sc_ac_cookie = malloc(ac_cookie_len, M_DEVBUF,
948 1.29 itojun M_DONTWAIT);
949 1.89 martin if (sc->sc_ac_cookie == NULL) {
950 1.157 yamaguch pppoe_printf(sc, "FATAL: could not allocate memory "
951 1.157 yamaguch "for AC cookie\n");
952 1.127 knakahar PPPOE_UNLOCK(sc);
953 1.29 itojun goto done;
954 1.89 martin }
955 1.1 martin sc->sc_ac_cookie_len = ac_cookie_len;
956 1.1 martin memcpy(sc->sc_ac_cookie, ac_cookie, ac_cookie_len);
957 1.1 martin }
958 1.94 christos if (relay_sid) {
959 1.94 christos if (sc->sc_relay_sid)
960 1.94 christos free(sc->sc_relay_sid, M_DEVBUF);
961 1.94 christos sc->sc_relay_sid = malloc(relay_sid_len, M_DEVBUF,
962 1.94 christos M_DONTWAIT);
963 1.94 christos if (sc->sc_relay_sid == NULL) {
964 1.157 yamaguch pppoe_printf(sc, "FATAL: could not allocate memory "
965 1.157 yamaguch "for relay SID\n");
966 1.127 knakahar PPPOE_UNLOCK(sc);
967 1.94 christos goto done;
968 1.94 christos }
969 1.94 christos sc->sc_relay_sid_len = relay_sid_len;
970 1.94 christos memcpy(sc->sc_relay_sid, relay_sid, relay_sid_len);
971 1.94 christos }
972 1.1 martin memcpy(&sc->sc_dest, eh->ether_shost, sizeof sc->sc_dest);
973 1.1 martin callout_stop(&sc->sc_timeout);
974 1.1 martin sc->sc_padr_retried = 0;
975 1.1 martin sc->sc_state = PPPOE_STATE_PADR_SENT;
976 1.45 martin if ((err = pppoe_send_padr(sc)) != 0) {
977 1.157 yamaguch pppoe_printf(sc,
978 1.157 yamaguch "failed to send PADR, error=%d\n", err);
979 1.45 martin }
980 1.150 yamaguch callout_schedule(&sc->sc_timeout,
981 1.150 yamaguch PPPOE_DISC_TIMEOUT * (1 + sc->sc_padr_retried));
982 1.120 knakahar
983 1.127 knakahar PPPOE_UNLOCK(sc);
984 1.1 martin break;
985 1.145 maxv
986 1.1 martin case PPPOE_CODE_PADS:
987 1.139 yamaguch rcvif = m_get_rcvif_psref(m, &psref);
988 1.139 yamaguch if (__predict_false(rcvif == NULL))
989 1.139 yamaguch goto done;
990 1.139 yamaguch
991 1.139 yamaguch if (hunique != NULL) {
992 1.139 yamaguch sc = pppoe_find_softc_by_hunique(hunique,
993 1.145 maxv hunique_len, rcvif, RW_WRITER);
994 1.139 yamaguch }
995 1.139 yamaguch
996 1.139 yamaguch m_put_rcvif_psref(rcvif, &psref);
997 1.139 yamaguch
998 1.1 martin if (sc == NULL)
999 1.29 itojun goto done;
1000 1.120 knakahar
1001 1.173 yamaguch if (memcmp(&sc->sc_dest, eh->ether_shost,
1002 1.173 yamaguch sizeof sc->sc_dest) != 0) {
1003 1.174 yamaguch PPPOE_UNLOCK(sc);
1004 1.173 yamaguch goto done;
1005 1.173 yamaguch }
1006 1.173 yamaguch
1007 1.1 martin sc->sc_session = session;
1008 1.1 martin callout_stop(&sc->sc_timeout);
1009 1.157 yamaguch pppoe_printf(sc, "session 0x%x connected\n", session);
1010 1.1 martin sc->sc_state = PPPOE_STATE_SESSION;
1011 1.127 knakahar PPPOE_UNLOCK(sc);
1012 1.120 knakahar
1013 1.1 martin sc->sc_sppp.pp_up(&sc->sc_sppp); /* notify upper layers */
1014 1.1 martin break;
1015 1.145 maxv
1016 1.139 yamaguch case PPPOE_CODE_PADT:
1017 1.139 yamaguch rcvif = m_get_rcvif_psref(m, &psref);
1018 1.139 yamaguch if (__predict_false(rcvif == NULL))
1019 1.139 yamaguch goto done;
1020 1.139 yamaguch
1021 1.139 yamaguch sc = pppoe_find_softc_by_session(session, rcvif,
1022 1.139 yamaguch RW_WRITER);
1023 1.108 ozaki
1024 1.125 ozaki m_put_rcvif_psref(rcvif, &psref);
1025 1.139 yamaguch
1026 1.1 martin if (sc == NULL)
1027 1.29 itojun goto done;
1028 1.120 knakahar
1029 1.173 yamaguch if (memcmp(&sc->sc_dest, eh->ether_shost,
1030 1.173 yamaguch sizeof sc->sc_dest) != 0) {
1031 1.174 yamaguch PPPOE_UNLOCK(sc);
1032 1.173 yamaguch goto done;
1033 1.173 yamaguch }
1034 1.173 yamaguch
1035 1.57 martin pppoe_clear_softc(sc, "received PADT");
1036 1.172 yamaguch if (sc->sc_sppp.pp_if.if_flags & IFF_RUNNING) {
1037 1.172 yamaguch pppoe_printf(sc, "wait for reconnect\n");
1038 1.172 yamaguch callout_schedule(&sc->sc_timeout,
1039 1.172 yamaguch PPPOE_RECON_PADTRCVD);
1040 1.172 yamaguch }
1041 1.127 knakahar PPPOE_UNLOCK(sc);
1042 1.25 itojun break;
1043 1.145 maxv
1044 1.25 itojun default:
1045 1.139 yamaguch rcvif = m_get_rcvif_psref(m, &psref);
1046 1.139 yamaguch if (__predict_false(rcvif == NULL))
1047 1.139 yamaguch goto done;
1048 1.139 yamaguch
1049 1.139 yamaguch if (hunique != NULL) {
1050 1.139 yamaguch sc = pppoe_find_softc_by_hunique(hunique,
1051 1.145 maxv hunique_len, rcvif, RW_READER);
1052 1.139 yamaguch }
1053 1.139 yamaguch
1054 1.139 yamaguch m_put_rcvif_psref(rcvif, &psref);
1055 1.139 yamaguch
1056 1.157 yamaguch pppoe_printf(sc, "unknown code (0x%04x) session = 0x%04x\n",
1057 1.157 yamaguch ph->code, session);
1058 1.157 yamaguch if (sc == NULL)
1059 1.157 yamaguch goto done;
1060 1.157 yamaguch PPPOE_UNLOCK(sc);
1061 1.25 itojun break;
1062 1.25 itojun }
1063 1.29 itojun
1064 1.29 itojun done:
1065 1.65 christos if (m)
1066 1.65 christos m_freem(m);
1067 1.29 itojun return;
1068 1.1 martin }
1069 1.1 martin
1070 1.1 martin static void
1071 1.1 martin pppoe_disc_input(struct mbuf *m)
1072 1.1 martin {
1073 1.137 maxv KASSERT(m->m_flags & M_PKTHDR);
1074 1.1 martin
1075 1.137 maxv /*
1076 1.137 maxv * Avoid error messages if there is not a single PPPoE instance.
1077 1.137 maxv */
1078 1.140 yamaguch rw_enter(&pppoe_softc_list_lock, RW_READER);
1079 1.25 itojun if (!LIST_EMPTY(&pppoe_softc_list)) {
1080 1.140 yamaguch rw_exit(&pppoe_softc_list_lock);
1081 1.29 itojun pppoe_dispatch_disc_pkt(m, 0);
1082 1.137 maxv } else {
1083 1.140 yamaguch rw_exit(&pppoe_softc_list_lock);
1084 1.29 itojun m_freem(m);
1085 1.137 maxv }
1086 1.1 martin }
1087 1.1 martin
1088 1.136 knakahar static bool
1089 1.136 knakahar pppoe_is_my_frame(uint8_t *dhost, struct ifnet *rcvif)
1090 1.136 knakahar {
1091 1.136 knakahar
1092 1.136 knakahar if (memcmp(CLLADDR(rcvif->if_sadl), dhost, ETHER_ADDR_LEN) == 0)
1093 1.136 knakahar return true;
1094 1.136 knakahar
1095 1.136 knakahar return false;
1096 1.136 knakahar }
1097 1.136 knakahar
1098 1.1 martin static void
1099 1.1 martin pppoe_data_input(struct mbuf *m)
1100 1.1 martin {
1101 1.84 matt uint16_t session, plen;
1102 1.25 itojun struct pppoe_softc *sc;
1103 1.29 itojun struct pppoehdr *ph;
1104 1.108 ozaki struct ifnet *rcvif;
1105 1.108 ozaki struct psref psref;
1106 1.84 matt uint8_t shost[ETHER_ADDR_LEN];
1107 1.136 knakahar uint8_t dhost[ETHER_ADDR_LEN];
1108 1.135 knakahar bool term_unknown = pppoe_term_unknown;
1109 1.1 martin
1110 1.25 itojun KASSERT(m->m_flags & M_PKTHDR);
1111 1.25 itojun
1112 1.137 maxv /*
1113 1.137 maxv * Avoid error messages if there is not a single PPPoE instance.
1114 1.137 maxv */
1115 1.140 yamaguch rw_enter(&pppoe_softc_list_lock, RW_READER);
1116 1.137 maxv if (LIST_EMPTY(&pppoe_softc_list)) {
1117 1.140 yamaguch rw_exit(&pppoe_softc_list_lock);
1118 1.137 maxv goto drop;
1119 1.137 maxv }
1120 1.140 yamaguch rw_exit(&pppoe_softc_list_lock);
1121 1.137 maxv
1122 1.136 knakahar if (term_unknown) {
1123 1.117 christos memcpy(shost, mtod(m, struct ether_header*)->ether_shost,
1124 1.117 christos ETHER_ADDR_LEN);
1125 1.136 knakahar memcpy(dhost, mtod(m, struct ether_header*)->ether_dhost,
1126 1.136 knakahar ETHER_ADDR_LEN);
1127 1.136 knakahar }
1128 1.25 itojun m_adj(m, sizeof(struct ether_header));
1129 1.25 itojun if (m->m_pkthdr.len <= PPPOE_HEADERLEN) {
1130 1.25 itojun goto drop;
1131 1.25 itojun }
1132 1.25 itojun
1133 1.30 itojun if (m->m_len < sizeof(*ph)) {
1134 1.30 itojun m = m_pullup(m, sizeof(*ph));
1135 1.145 maxv if (m == NULL) {
1136 1.30 itojun return;
1137 1.30 itojun }
1138 1.29 itojun }
1139 1.29 itojun ph = mtod(m, struct pppoehdr *);
1140 1.25 itojun
1141 1.29 itojun if (ph->vertype != PPPOE_VERTYPE) {
1142 1.25 itojun goto drop;
1143 1.25 itojun }
1144 1.146 maxv if (ph->code != 0) {
1145 1.25 itojun goto drop;
1146 1.146 maxv }
1147 1.25 itojun
1148 1.29 itojun session = ntohs(ph->session);
1149 1.108 ozaki rcvif = m_get_rcvif_psref(m, &psref);
1150 1.110 ozaki if (__predict_false(rcvif == NULL))
1151 1.110 ozaki goto drop;
1152 1.120 knakahar sc = pppoe_find_softc_by_session(session, rcvif, RW_READER);
1153 1.34 martin if (sc == NULL) {
1154 1.135 knakahar if (term_unknown) {
1155 1.136 knakahar static struct timeval lasttime = {0, 0};
1156 1.136 knakahar static int curpps = 0;
1157 1.136 knakahar /*
1158 1.136 knakahar * avoid to send wrong PADT which is response from
1159 1.147 msaitoh * session stage packets for other hosts when parent
1160 1.136 knakahar * ethernet is promiscuous mode.
1161 1.136 knakahar */
1162 1.145 maxv if (pppoe_is_my_frame(dhost, rcvif) &&
1163 1.145 maxv ppsratecheck(&lasttime, &curpps,
1164 1.136 knakahar pppoe_term_unknown_pps)) {
1165 1.157 yamaguch pppoe_printf(NULL, "input for unknown session %#x, "
1166 1.136 knakahar "sending PADT\n", session);
1167 1.136 knakahar pppoe_send_padt(rcvif, session, shost);
1168 1.136 knakahar }
1169 1.113 pgoyette }
1170 1.108 ozaki m_put_rcvif_psref(rcvif, &psref);
1171 1.25 itojun goto drop;
1172 1.34 martin }
1173 1.120 knakahar
1174 1.108 ozaki m_put_rcvif_psref(rcvif, &psref);
1175 1.25 itojun
1176 1.29 itojun plen = ntohs(ph->plen);
1177 1.1 martin
1178 1.141 msaitoh bpf_mtap(&sc->sc_sppp.pp_if, m, BPF_D_IN);
1179 1.1 martin
1180 1.25 itojun m_adj(m, PPPOE_HEADERLEN);
1181 1.1 martin
1182 1.1 martin #ifdef PPPOE_DEBUG
1183 1.25 itojun {
1184 1.25 itojun struct mbuf *p;
1185 1.1 martin
1186 1.25 itojun printf("%s: pkthdr.len=%d, pppoe.len=%d",
1187 1.129 msaitoh sc->sc_sppp.pp_if.if_xname, m->m_pkthdr.len, plen);
1188 1.25 itojun p = m;
1189 1.25 itojun while (p) {
1190 1.25 itojun printf(" l=%d", p->m_len);
1191 1.25 itojun p = p->m_next;
1192 1.25 itojun }
1193 1.25 itojun printf("\n");
1194 1.25 itojun }
1195 1.1 martin #endif
1196 1.127 knakahar PPPOE_UNLOCK(sc);
1197 1.26 itojun
1198 1.25 itojun if (m->m_pkthdr.len < plen)
1199 1.25 itojun goto drop;
1200 1.25 itojun
1201 1.156 yamaguch /* ignore trailing garbage */
1202 1.156 yamaguch m_adj(m, plen - m->m_pkthdr.len);
1203 1.129 msaitoh /*
1204 1.145 maxv * Fix incoming interface pointer (not the raw ethernet interface
1205 1.129 msaitoh * anymore)
1206 1.129 msaitoh */
1207 1.107 ozaki m_set_rcvif(m, &sc->sc_sppp.pp_if);
1208 1.25 itojun
1209 1.25 itojun /* pass packet up and account for it */
1210 1.148 thorpej if_statinc(&sc->sc_sppp.pp_if, if_ipackets);
1211 1.25 itojun sppp_input(&sc->sc_sppp.pp_if, m);
1212 1.25 itojun return;
1213 1.1 martin
1214 1.1 martin drop:
1215 1.29 itojun m_freem(m);
1216 1.1 martin }
1217 1.1 martin
1218 1.1 martin static int
1219 1.1 martin pppoe_output(struct pppoe_softc *sc, struct mbuf *m)
1220 1.1 martin {
1221 1.25 itojun struct sockaddr dst;
1222 1.25 itojun struct ether_header *eh;
1223 1.84 matt uint16_t etype;
1224 1.25 itojun
1225 1.52 oki if (sc->sc_eth_if == NULL) {
1226 1.52 oki m_freem(m);
1227 1.25 itojun return EIO;
1228 1.52 oki }
1229 1.25 itojun
1230 1.25 itojun memset(&dst, 0, sizeof dst);
1231 1.25 itojun dst.sa_family = AF_UNSPEC;
1232 1.25 itojun eh = (struct ether_header*)&dst.sa_data;
1233 1.129 msaitoh etype = sc->sc_state == PPPOE_STATE_SESSION
1234 1.129 msaitoh ? ETHERTYPE_PPPOE : ETHERTYPE_PPPOEDISC;
1235 1.25 itojun eh->ether_type = htons(etype);
1236 1.25 itojun memcpy(&eh->ether_dhost, &sc->sc_dest, sizeof sc->sc_dest);
1237 1.1 martin
1238 1.157 yamaguch DPRINTF(sc, "(%x) state=%d, session=0x%x output -> %s, len=%d\n",
1239 1.157 yamaguch etype, sc->sc_state, sc->sc_session,
1240 1.1 martin ether_sprintf((const unsigned char *)&sc->sc_dest), m->m_pkthdr.len);
1241 1.1 martin
1242 1.22 martin m->m_flags &= ~(M_BCAST|M_MCAST);
1243 1.148 thorpej if_statinc(&sc->sc_sppp.pp_if, if_opackets);
1244 1.109 knakahar return if_output_lock(sc->sc_eth_if, sc->sc_eth_if, m, &dst, NULL);
1245 1.1 martin }
1246 1.1 martin
1247 1.1 martin static int
1248 1.153 yamaguch pppoe_parm_cpyinstr(struct pppoe_softc *sc,
1249 1.153 yamaguch char **dst, const void *src, size_t len)
1250 1.153 yamaguch {
1251 1.153 yamaguch int error = 0;
1252 1.153 yamaguch char *next = NULL;
1253 1.153 yamaguch size_t bufsiz, cpysiz, strsiz;
1254 1.153 yamaguch
1255 1.153 yamaguch bufsiz = len + 1;
1256 1.153 yamaguch
1257 1.153 yamaguch if (src == NULL)
1258 1.153 yamaguch goto out;
1259 1.153 yamaguch
1260 1.153 yamaguch bufsiz = len + 1;
1261 1.153 yamaguch next = malloc(bufsiz, M_DEVBUF, M_WAITOK);
1262 1.153 yamaguch if (next == NULL)
1263 1.153 yamaguch return ENOMEM;
1264 1.153 yamaguch
1265 1.153 yamaguch error = copyinstr(src, next, bufsiz, &cpysiz);
1266 1.153 yamaguch if (error != 0)
1267 1.153 yamaguch goto fail;
1268 1.153 yamaguch if (cpysiz != bufsiz) {
1269 1.153 yamaguch error = EINVAL;
1270 1.153 yamaguch goto fail;
1271 1.153 yamaguch }
1272 1.153 yamaguch
1273 1.153 yamaguch strsiz = strnlen(next, bufsiz);
1274 1.153 yamaguch if (strsiz == bufsiz) {
1275 1.153 yamaguch error = EINVAL;
1276 1.153 yamaguch goto fail;
1277 1.153 yamaguch }
1278 1.153 yamaguch
1279 1.153 yamaguch out:
1280 1.153 yamaguch PPPOE_LOCK(sc, RW_WRITER);
1281 1.153 yamaguch if (*dst != NULL)
1282 1.153 yamaguch free(*dst, M_DEVBUF);
1283 1.153 yamaguch *dst = next;
1284 1.153 yamaguch next = NULL;
1285 1.153 yamaguch PPPOE_UNLOCK(sc);
1286 1.153 yamaguch fail:
1287 1.153 yamaguch if (next != NULL)
1288 1.153 yamaguch free(next, M_DEVBUF);
1289 1.153 yamaguch
1290 1.153 yamaguch return error;
1291 1.153 yamaguch }
1292 1.153 yamaguch
1293 1.153 yamaguch static int
1294 1.77 christos pppoe_ioctl(struct ifnet *ifp, unsigned long cmd, void *data)
1295 1.1 martin {
1296 1.70 ad struct lwp *l = curlwp; /* XXX */
1297 1.1 martin struct pppoe_softc *sc = (struct pppoe_softc*)ifp;
1298 1.83 dyoung struct ifreq *ifr = data;
1299 1.1 martin int error = 0;
1300 1.1 martin
1301 1.1 martin switch (cmd) {
1302 1.1 martin case PPPOESETPARMS:
1303 1.1 martin {
1304 1.1 martin struct pppoediscparms *parms = (struct pppoediscparms*)data;
1305 1.74 elad if (kauth_authorize_network(l->l_cred, KAUTH_NETWORK_INTERFACE,
1306 1.74 elad KAUTH_REQ_NETWORK_INTERFACE_SETPRIV, ifp, (void *)cmd,
1307 1.74 elad NULL) != 0)
1308 1.129 msaitoh return EPERM;
1309 1.1 martin if (parms->eth_ifname[0] != 0) {
1310 1.145 maxv struct ifnet *eth_if;
1311 1.67 tron
1312 1.127 knakahar PPPOE_LOCK(sc, RW_WRITER);
1313 1.167 yamaguch if (sc->sc_detaching) {
1314 1.167 yamaguch PPPOE_UNLOCK(sc);
1315 1.167 yamaguch return ENXIO;
1316 1.167 yamaguch }
1317 1.67 tron eth_if = ifunit(parms->eth_ifname);
1318 1.67 tron if (eth_if == NULL || eth_if->if_dlt != DLT_EN10MB) {
1319 1.66 tron sc->sc_eth_if = NULL;
1320 1.127 knakahar PPPOE_UNLOCK(sc);
1321 1.1 martin return ENXIO;
1322 1.66 tron }
1323 1.67 tron
1324 1.98 rjs if (sc->sc_sppp.pp_if.if_mtu !=
1325 1.67 tron eth_if->if_mtu - PPPOE_OVERHEAD) {
1326 1.67 tron sc->sc_sppp.pp_if.if_mtu = eth_if->if_mtu -
1327 1.67 tron PPPOE_OVERHEAD;
1328 1.67 tron }
1329 1.67 tron sc->sc_eth_if = eth_if;
1330 1.127 knakahar PPPOE_UNLOCK(sc);
1331 1.1 martin }
1332 1.120 knakahar
1333 1.153 yamaguch error = pppoe_parm_cpyinstr(sc, &sc->sc_concentrator_name,
1334 1.153 yamaguch parms->ac_name, parms->ac_name_len);
1335 1.153 yamaguch if (error != 0)
1336 1.153 yamaguch return error;
1337 1.153 yamaguch
1338 1.153 yamaguch error = pppoe_parm_cpyinstr(sc, &sc->sc_service_name,
1339 1.153 yamaguch parms->service_name, parms->service_name_len);
1340 1.153 yamaguch if (error != 0)
1341 1.153 yamaguch return error;
1342 1.1 martin return 0;
1343 1.1 martin }
1344 1.1 martin break;
1345 1.1 martin case PPPOEGETPARMS:
1346 1.1 martin {
1347 1.1 martin struct pppoediscparms *parms = (struct pppoediscparms*)data;
1348 1.1 martin memset(parms, 0, sizeof *parms);
1349 1.127 knakahar PPPOE_LOCK(sc, RW_READER);
1350 1.1 martin if (sc->sc_eth_if)
1351 1.106 christos strlcpy(parms->ifname, sc->sc_eth_if->if_xname,
1352 1.106 christos sizeof(parms->ifname));
1353 1.127 knakahar PPPOE_UNLOCK(sc);
1354 1.15 martin return 0;
1355 1.15 martin }
1356 1.15 martin break;
1357 1.15 martin case PPPOEGETSESSION:
1358 1.15 martin {
1359 1.15 martin struct pppoeconnectionstate *state = (struct pppoeconnectionstate*)data;
1360 1.127 knakahar PPPOE_LOCK(sc, RW_READER);
1361 1.15 martin state->state = sc->sc_state;
1362 1.15 martin state->session_id = sc->sc_session;
1363 1.15 martin state->padi_retry_no = sc->sc_padi_retried;
1364 1.15 martin state->padr_retry_no = sc->sc_padr_retried;
1365 1.127 knakahar PPPOE_UNLOCK(sc);
1366 1.1 martin return 0;
1367 1.1 martin }
1368 1.1 martin break;
1369 1.13 martin case SIOCSIFFLAGS:
1370 1.13 martin /*
1371 1.13 martin * Prevent running re-establishment timers overriding
1372 1.13 martin * administrators choice.
1373 1.13 martin */
1374 1.127 knakahar PPPOE_LOCK(sc, RW_WRITER);
1375 1.167 yamaguch if (sc->sc_detaching) {
1376 1.167 yamaguch PPPOE_UNLOCK(sc);
1377 1.167 yamaguch return ENXIO;
1378 1.167 yamaguch }
1379 1.120 knakahar
1380 1.14 martin if ((ifr->ifr_flags & IFF_UP) == 0
1381 1.14 martin && sc->sc_state < PPPOE_STATE_SESSION) {
1382 1.13 martin callout_stop(&sc->sc_timeout);
1383 1.14 martin sc->sc_state = PPPOE_STATE_INITIAL;
1384 1.13 martin sc->sc_padi_retried = 0;
1385 1.13 martin sc->sc_padr_retried = 0;
1386 1.28 itojun memcpy(&sc->sc_dest, etherbroadcastaddr,
1387 1.28 itojun sizeof(sc->sc_dest));
1388 1.13 martin }
1389 1.120 knakahar
1390 1.127 knakahar PPPOE_UNLOCK(sc);
1391 1.120 knakahar
1392 1.120 knakahar error = sppp_ioctl(ifp, cmd, data);
1393 1.120 knakahar
1394 1.120 knakahar return error;
1395 1.19 martin case SIOCSIFMTU:
1396 1.67 tron if (ifr->ifr_mtu > (sc->sc_eth_if == NULL ?
1397 1.67 tron PPPOE_MAXMTU : (sc->sc_eth_if->if_mtu - PPPOE_OVERHEAD))) {
1398 1.19 martin return EINVAL;
1399 1.67 tron }
1400 1.83 dyoung /*FALLTHROUGH*/
1401 1.1 martin default:
1402 1.1 martin return sppp_ioctl(ifp, cmd, data);
1403 1.1 martin }
1404 1.1 martin return 0;
1405 1.1 martin }
1406 1.1 martin
1407 1.1 martin /*
1408 1.1 martin * Allocate a mbuf/cluster with space to store the given data length
1409 1.1 martin * of payload, leaving space for prepending an ethernet header
1410 1.59 perry * in front.
1411 1.1 martin */
1412 1.1 martin static struct mbuf *
1413 1.1 martin pppoe_get_mbuf(size_t len)
1414 1.1 martin {
1415 1.1 martin struct mbuf *m;
1416 1.1 martin
1417 1.1 martin MGETHDR(m, M_DONTWAIT, MT_DATA);
1418 1.1 martin if (m == NULL)
1419 1.1 martin return NULL;
1420 1.26 itojun if (len + sizeof(struct ether_header) > MHLEN) {
1421 1.1 martin MCLGET(m, M_DONTWAIT);
1422 1.1 martin if ((m->m_flags & M_EXT) == 0) {
1423 1.101 martin m_free(m);
1424 1.101 martin return NULL;
1425 1.1 martin }
1426 1.1 martin }
1427 1.1 martin m->m_data += sizeof(struct ether_header);
1428 1.1 martin m->m_len = len;
1429 1.1 martin m->m_pkthdr.len = len;
1430 1.107 ozaki m_reset_rcvif(m);
1431 1.1 martin
1432 1.1 martin return m;
1433 1.1 martin }
1434 1.1 martin
1435 1.1 martin static int
1436 1.1 martin pppoe_send_padi(struct pppoe_softc *sc)
1437 1.1 martin {
1438 1.1 martin struct mbuf *m0;
1439 1.142 maxv int len, l1 = 0, l2 = 0;
1440 1.84 matt uint8_t *p;
1441 1.1 martin
1442 1.142 maxv if (sc->sc_state > PPPOE_STATE_PADI_SENT)
1443 1.1 martin panic("pppoe_send_padi in state %d", sc->sc_state);
1444 1.1 martin
1445 1.142 maxv /* Compute packet length. */
1446 1.142 maxv len = sizeof(struct pppoetag);
1447 1.1 martin if (sc->sc_service_name != NULL) {
1448 1.1 martin l1 = strlen(sc->sc_service_name);
1449 1.1 martin len += l1;
1450 1.1 martin }
1451 1.1 martin if (sc->sc_concentrator_name != NULL) {
1452 1.1 martin l2 = strlen(sc->sc_concentrator_name);
1453 1.142 maxv len += sizeof(struct pppoetag) + l2;
1454 1.1 martin }
1455 1.143 maxv len += sizeof(struct pppoetag) + sizeof(sc->sc_id);
1456 1.98 rjs if (sc->sc_sppp.pp_if.if_mtu > PPPOE_MAXMTU) {
1457 1.142 maxv len += sizeof(struct pppoetag) + 2;
1458 1.98 rjs }
1459 1.1 martin
1460 1.142 maxv /* Allocate packet. */
1461 1.142 maxv m0 = pppoe_get_mbuf(len + PPPOE_HEADERLEN);
1462 1.142 maxv if (m0 == NULL)
1463 1.26 itojun return ENOBUFS;
1464 1.1 martin
1465 1.142 maxv /* Fill in packet. */
1466 1.84 matt p = mtod(m0, uint8_t *);
1467 1.1 martin PPPOE_ADD_HEADER(p, PPPOE_CODE_PADI, 0, len);
1468 1.1 martin PPPOE_ADD_16(p, PPPOE_TAG_SNAME);
1469 1.1 martin if (sc->sc_service_name != NULL) {
1470 1.1 martin PPPOE_ADD_16(p, l1);
1471 1.1 martin memcpy(p, sc->sc_service_name, l1);
1472 1.1 martin p += l1;
1473 1.1 martin } else {
1474 1.1 martin PPPOE_ADD_16(p, 0);
1475 1.1 martin }
1476 1.1 martin if (sc->sc_concentrator_name != NULL) {
1477 1.1 martin PPPOE_ADD_16(p, PPPOE_TAG_ACNAME);
1478 1.1 martin PPPOE_ADD_16(p, l2);
1479 1.1 martin memcpy(p, sc->sc_concentrator_name, l2);
1480 1.1 martin p += l2;
1481 1.1 martin }
1482 1.1 martin PPPOE_ADD_16(p, PPPOE_TAG_HUNIQUE);
1483 1.143 maxv PPPOE_ADD_16(p, sizeof(sc->sc_id));
1484 1.143 maxv memcpy(p, &sc->sc_id, sizeof(sc->sc_id));
1485 1.143 maxv p += sizeof(sc->sc_id);
1486 1.98 rjs
1487 1.98 rjs if (sc->sc_sppp.pp_if.if_mtu > PPPOE_MAXMTU) {
1488 1.98 rjs PPPOE_ADD_16(p, PPPOE_TAG_MAX_PAYLOAD);
1489 1.98 rjs PPPOE_ADD_16(p, 2);
1490 1.98 rjs PPPOE_ADD_16(p, (uint16_t)sc->sc_sppp.pp_if.if_mtu);
1491 1.98 rjs }
1492 1.1 martin
1493 1.1 martin #ifdef PPPOE_DEBUG
1494 1.84 matt if (p - mtod(m0, uint8_t *) != len + PPPOE_HEADERLEN)
1495 1.1 martin panic("pppoe_send_padi: garbled output len, should be %ld, is %ld",
1496 1.84 matt (long)(len + PPPOE_HEADERLEN), (long)(p - mtod(m0, uint8_t *)));
1497 1.1 martin #endif
1498 1.1 martin
1499 1.142 maxv /* Send packet. */
1500 1.1 martin return pppoe_output(sc, m0);
1501 1.1 martin }
1502 1.1 martin
1503 1.1 martin static void
1504 1.151 yamaguch pppoe_timeout_co(void *arg)
1505 1.151 yamaguch {
1506 1.151 yamaguch struct pppoe_softc *sc = (struct pppoe_softc *)arg;
1507 1.151 yamaguch
1508 1.151 yamaguch if (atomic_swap_uint(&sc->sc_timeout_scheduled, 1) != 0)
1509 1.151 yamaguch return;
1510 1.151 yamaguch
1511 1.151 yamaguch workqueue_enqueue(sc->sc_timeout_wq, &sc->sc_timeout_wk, NULL);
1512 1.151 yamaguch }
1513 1.151 yamaguch
1514 1.151 yamaguch static void
1515 1.151 yamaguch pppoe_timeout_co_halt(void *unused __unused)
1516 1.151 yamaguch {
1517 1.151 yamaguch
1518 1.151 yamaguch /* do nothing to halt callout safely */
1519 1.151 yamaguch }
1520 1.151 yamaguch
1521 1.151 yamaguch static void
1522 1.151 yamaguch pppoe_timeout_wk(struct work *wk __unused, void *arg)
1523 1.151 yamaguch {
1524 1.151 yamaguch struct pppoe_softc *sc = (struct pppoe_softc *)arg;
1525 1.151 yamaguch
1526 1.151 yamaguch atomic_swap_uint(&sc->sc_timeout_scheduled, 0);
1527 1.151 yamaguch pppoe_timeout(sc);
1528 1.151 yamaguch }
1529 1.151 yamaguch
1530 1.151 yamaguch static void
1531 1.151 yamaguch pppoe_timeout(struct pppoe_softc *sc)
1532 1.1 martin {
1533 1.120 knakahar int retry_wait, err;
1534 1.120 knakahar DECLARE_SPLNET_VARIABLE;
1535 1.1 martin
1536 1.157 yamaguch pppoe_printf(sc, "timeout\n");
1537 1.1 martin
1538 1.127 knakahar PPPOE_LOCK(sc, RW_WRITER);
1539 1.1 martin switch (sc->sc_state) {
1540 1.90 martin case PPPOE_STATE_INITIAL:
1541 1.90 martin /* delayed connect from pppoe_tls() */
1542 1.167 yamaguch if (!sc->sc_detaching)
1543 1.167 yamaguch pppoe_connect(sc);
1544 1.90 martin break;
1545 1.1 martin case PPPOE_STATE_PADI_SENT:
1546 1.13 martin /*
1547 1.13 martin * We have two basic ways of retrying:
1548 1.13 martin * - Quick retry mode: try a few times in short sequence
1549 1.13 martin * - Slow retry mode: we already had a connection successfully
1550 1.13 martin * established and will try infinitely (without user
1551 1.13 martin * intervention)
1552 1.13 martin * We only enter slow retry mode if IFF_LINK1 (aka autodial)
1553 1.35 martin * is not set.
1554 1.13 martin */
1555 1.13 martin
1556 1.13 martin /* initialize for quick retry mode */
1557 1.30 itojun retry_wait = PPPOE_DISC_TIMEOUT * (1 + sc->sc_padi_retried);
1558 1.13 martin
1559 1.120 knakahar ACQUIRE_SPLNET();
1560 1.1 martin sc->sc_padi_retried++;
1561 1.1 martin if (sc->sc_padi_retried >= PPPOE_DISC_MAXPADI) {
1562 1.35 martin if ((sc->sc_sppp.pp_if.if_flags & IFF_LINK1) == 0) {
1563 1.28 itojun /* slow retry mode */
1564 1.28 itojun retry_wait = PPPOE_SLOW_RETRY;
1565 1.13 martin } else {
1566 1.28 itojun pppoe_abort_connect(sc);
1567 1.121 knakahar RELEASE_SPLNET();
1568 1.127 knakahar PPPOE_UNLOCK(sc);
1569 1.28 itojun return;
1570 1.13 martin }
1571 1.1 martin }
1572 1.45 martin if ((err = pppoe_send_padi(sc)) != 0) {
1573 1.45 martin sc->sc_padi_retried--;
1574 1.157 yamaguch pppoe_printf(sc,
1575 1.157 yamaguch "failed to transmit PADI, error=%d\n", err);
1576 1.45 martin }
1577 1.150 yamaguch callout_schedule(&sc->sc_timeout,retry_wait);
1578 1.120 knakahar RELEASE_SPLNET();
1579 1.1 martin break;
1580 1.1 martin
1581 1.1 martin case PPPOE_STATE_PADR_SENT:
1582 1.120 knakahar ACQUIRE_SPLNET();
1583 1.1 martin sc->sc_padr_retried++;
1584 1.1 martin if (sc->sc_padr_retried >= PPPOE_DISC_MAXPADR) {
1585 1.28 itojun memcpy(&sc->sc_dest, etherbroadcastaddr,
1586 1.28 itojun sizeof(sc->sc_dest));
1587 1.1 martin sc->sc_state = PPPOE_STATE_PADI_SENT;
1588 1.161 yamaguch sc->sc_padi_retried = 0;
1589 1.1 martin sc->sc_padr_retried = 0;
1590 1.45 martin if ((err = pppoe_send_padi(sc)) != 0) {
1591 1.157 yamaguch pppoe_printf(sc,
1592 1.157 yamaguch "failed to send PADI, error=%d\n", err);
1593 1.45 martin }
1594 1.150 yamaguch callout_schedule(&sc->sc_timeout,
1595 1.150 yamaguch PPPOE_DISC_TIMEOUT * (1 + sc->sc_padi_retried));
1596 1.120 knakahar RELEASE_SPLNET();
1597 1.127 knakahar PPPOE_UNLOCK(sc);
1598 1.1 martin return;
1599 1.1 martin }
1600 1.45 martin if ((err = pppoe_send_padr(sc)) != 0) {
1601 1.45 martin sc->sc_padr_retried--;
1602 1.157 yamaguch pppoe_printf(sc,"failed to send PADR, error=%d", err);
1603 1.45 martin }
1604 1.150 yamaguch callout_schedule(&sc->sc_timeout,
1605 1.150 yamaguch PPPOE_DISC_TIMEOUT * (1 + sc->sc_padr_retried));
1606 1.120 knakahar RELEASE_SPLNET();
1607 1.1 martin break;
1608 1.1 martin case PPPOE_STATE_CLOSING:
1609 1.1 martin pppoe_disconnect(sc);
1610 1.1 martin break;
1611 1.1 martin default:
1612 1.127 knakahar PPPOE_UNLOCK(sc);
1613 1.1 martin return; /* all done, work in peace */
1614 1.1 martin }
1615 1.127 knakahar PPPOE_UNLOCK(sc);
1616 1.1 martin }
1617 1.1 martin
1618 1.1 martin /* Start a connection (i.e. initiate discovery phase) */
1619 1.1 martin static int
1620 1.1 martin pppoe_connect(struct pppoe_softc *sc)
1621 1.1 martin {
1622 1.120 knakahar int err;
1623 1.120 knakahar DECLARE_SPLNET_VARIABLE;
1624 1.120 knakahar
1625 1.127 knakahar KASSERT(PPPOE_WLOCKED(sc));
1626 1.1 martin
1627 1.1 martin if (sc->sc_state != PPPOE_STATE_INITIAL)
1628 1.1 martin return EBUSY;
1629 1.1 martin
1630 1.43 oki #ifdef PPPOE_SERVER
1631 1.43 oki /* wait PADI if IFF_PASSIVE */
1632 1.43 oki if ((sc->sc_sppp.pp_if.if_flags & IFF_PASSIVE))
1633 1.43 oki return 0;
1634 1.43 oki #endif
1635 1.120 knakahar ACQUIRE_SPLNET();
1636 1.36 martin /* save state, in case we fail to send PADI */
1637 1.1 martin sc->sc_state = PPPOE_STATE_PADI_SENT;
1638 1.161 yamaguch sc->sc_padi_retried = 0;
1639 1.1 martin sc->sc_padr_retried = 0;
1640 1.1 martin err = pppoe_send_padi(sc);
1641 1.157 yamaguch if (err != 0)
1642 1.157 yamaguch pppoe_printf(sc, "failed to send PADI, error=%d\n", err);
1643 1.150 yamaguch callout_schedule(&sc->sc_timeout, PPPOE_DISC_TIMEOUT);
1644 1.120 knakahar RELEASE_SPLNET();
1645 1.1 martin return err;
1646 1.1 martin }
1647 1.1 martin
1648 1.1 martin /* disconnect */
1649 1.1 martin static int
1650 1.1 martin pppoe_disconnect(struct pppoe_softc *sc)
1651 1.1 martin {
1652 1.120 knakahar int err;
1653 1.120 knakahar DECLARE_SPLNET_VARIABLE;
1654 1.120 knakahar
1655 1.127 knakahar KASSERT(PPPOE_WLOCKED(sc));
1656 1.1 martin
1657 1.120 knakahar ACQUIRE_SPLNET();
1658 1.1 martin
1659 1.1 martin if (sc->sc_state < PPPOE_STATE_SESSION)
1660 1.1 martin err = EBUSY;
1661 1.1 martin else {
1662 1.157 yamaguch pppoe_printf(sc, "disconnecting\n");
1663 1.129 msaitoh err = pppoe_send_padt(sc->sc_eth_if, sc->sc_session,
1664 1.129 msaitoh (const uint8_t *)&sc->sc_dest);
1665 1.1 martin }
1666 1.1 martin
1667 1.1 martin /* cleanup softc */
1668 1.1 martin sc->sc_state = PPPOE_STATE_INITIAL;
1669 1.120 knakahar
1670 1.1 martin memcpy(&sc->sc_dest, etherbroadcastaddr, sizeof(sc->sc_dest));
1671 1.1 martin if (sc->sc_ac_cookie) {
1672 1.32 yamt free(sc->sc_ac_cookie, M_DEVBUF);
1673 1.1 martin sc->sc_ac_cookie = NULL;
1674 1.1 martin }
1675 1.1 martin sc->sc_ac_cookie_len = 0;
1676 1.94 christos if (sc->sc_relay_sid) {
1677 1.94 christos free(sc->sc_relay_sid, M_DEVBUF);
1678 1.94 christos sc->sc_relay_sid = NULL;
1679 1.94 christos }
1680 1.94 christos sc->sc_relay_sid_len = 0;
1681 1.43 oki #ifdef PPPOE_SERVER
1682 1.43 oki if (sc->sc_hunique) {
1683 1.43 oki free(sc->sc_hunique, M_DEVBUF);
1684 1.43 oki sc->sc_hunique = NULL;
1685 1.43 oki }
1686 1.43 oki sc->sc_hunique_len = 0;
1687 1.43 oki #endif
1688 1.1 martin sc->sc_session = 0;
1689 1.1 martin
1690 1.127 knakahar PPPOE_UNLOCK(sc);
1691 1.120 knakahar
1692 1.1 martin /* notify upper layer */
1693 1.1 martin sc->sc_sppp.pp_down(&sc->sc_sppp);
1694 1.1 martin
1695 1.127 knakahar PPPOE_LOCK(sc, RW_WRITER);
1696 1.1 martin
1697 1.120 knakahar RELEASE_SPLNET();
1698 1.1 martin return err;
1699 1.1 martin }
1700 1.1 martin
1701 1.1 martin /* Connection attempt aborted */
1702 1.1 martin static void
1703 1.1 martin pppoe_abort_connect(struct pppoe_softc *sc)
1704 1.1 martin {
1705 1.127 knakahar KASSERT(PPPOE_WLOCKED(sc));
1706 1.120 knakahar
1707 1.157 yamaguch pppoe_printf(sc, "could not establish connection\n");
1708 1.36 martin sc->sc_state = PPPOE_STATE_CLOSING;
1709 1.120 knakahar
1710 1.127 knakahar PPPOE_UNLOCK(sc);
1711 1.1 martin
1712 1.1 martin /* notify upper layer */
1713 1.1 martin sc->sc_sppp.pp_down(&sc->sc_sppp);
1714 1.120 knakahar
1715 1.127 knakahar PPPOE_LOCK(sc, RW_WRITER);
1716 1.36 martin
1717 1.36 martin /* clear connection state */
1718 1.36 martin memcpy(&sc->sc_dest, etherbroadcastaddr, sizeof(sc->sc_dest));
1719 1.36 martin sc->sc_state = PPPOE_STATE_INITIAL;
1720 1.1 martin }
1721 1.1 martin
1722 1.1 martin static int
1723 1.1 martin pppoe_send_padr(struct pppoe_softc *sc)
1724 1.1 martin {
1725 1.1 martin struct mbuf *m0;
1726 1.84 matt uint8_t *p;
1727 1.142 maxv size_t len, l1 = 0;
1728 1.1 martin
1729 1.1 martin if (sc->sc_state != PPPOE_STATE_PADR_SENT)
1730 1.1 martin return EIO;
1731 1.1 martin
1732 1.142 maxv /* Compute packet length. */
1733 1.142 maxv len = sizeof(struct pppoetag);
1734 1.142 maxv if (sc->sc_service_name != NULL) {
1735 1.1 martin l1 = strlen(sc->sc_service_name);
1736 1.1 martin len += l1;
1737 1.1 martin }
1738 1.142 maxv if (sc->sc_ac_cookie_len > 0) {
1739 1.142 maxv len += sizeof(struct pppoetag) + sc->sc_ac_cookie_len;
1740 1.142 maxv }
1741 1.142 maxv if (sc->sc_relay_sid_len > 0) {
1742 1.142 maxv len += sizeof(struct pppoetag) + sc->sc_relay_sid_len;
1743 1.142 maxv }
1744 1.143 maxv len += sizeof(struct pppoetag) + sizeof(sc->sc_id);
1745 1.98 rjs if (sc->sc_sppp.pp_if.if_mtu > PPPOE_MAXMTU) {
1746 1.142 maxv len += sizeof(struct pppoetag) + 2;
1747 1.98 rjs }
1748 1.142 maxv
1749 1.142 maxv /* Allocate packet. */
1750 1.26 itojun m0 = pppoe_get_mbuf(len + PPPOE_HEADERLEN);
1751 1.142 maxv if (m0 == NULL)
1752 1.26 itojun return ENOBUFS;
1753 1.142 maxv
1754 1.142 maxv /* Fill in packet. */
1755 1.84 matt p = mtod(m0, uint8_t *);
1756 1.1 martin PPPOE_ADD_HEADER(p, PPPOE_CODE_PADR, 0, len);
1757 1.1 martin PPPOE_ADD_16(p, PPPOE_TAG_SNAME);
1758 1.1 martin if (sc->sc_service_name != NULL) {
1759 1.1 martin PPPOE_ADD_16(p, l1);
1760 1.1 martin memcpy(p, sc->sc_service_name, l1);
1761 1.1 martin p += l1;
1762 1.1 martin } else {
1763 1.1 martin PPPOE_ADD_16(p, 0);
1764 1.1 martin }
1765 1.1 martin if (sc->sc_ac_cookie_len > 0) {
1766 1.1 martin PPPOE_ADD_16(p, PPPOE_TAG_ACCOOKIE);
1767 1.1 martin PPPOE_ADD_16(p, sc->sc_ac_cookie_len);
1768 1.1 martin memcpy(p, sc->sc_ac_cookie, sc->sc_ac_cookie_len);
1769 1.1 martin p += sc->sc_ac_cookie_len;
1770 1.1 martin }
1771 1.94 christos if (sc->sc_relay_sid_len > 0) {
1772 1.94 christos PPPOE_ADD_16(p, PPPOE_TAG_RELAYSID);
1773 1.94 christos PPPOE_ADD_16(p, sc->sc_relay_sid_len);
1774 1.94 christos memcpy(p, sc->sc_relay_sid, sc->sc_relay_sid_len);
1775 1.94 christos p += sc->sc_relay_sid_len;
1776 1.94 christos }
1777 1.1 martin PPPOE_ADD_16(p, PPPOE_TAG_HUNIQUE);
1778 1.143 maxv PPPOE_ADD_16(p, sizeof(sc->sc_id));
1779 1.143 maxv memcpy(p, &sc->sc_id, sizeof(sc->sc_id));
1780 1.143 maxv p += sizeof(sc->sc_id);
1781 1.98 rjs
1782 1.98 rjs if (sc->sc_sppp.pp_if.if_mtu > PPPOE_MAXMTU) {
1783 1.98 rjs PPPOE_ADD_16(p, PPPOE_TAG_MAX_PAYLOAD);
1784 1.98 rjs PPPOE_ADD_16(p, 2);
1785 1.98 rjs PPPOE_ADD_16(p, (uint16_t)sc->sc_sppp.pp_if.if_mtu);
1786 1.98 rjs }
1787 1.1 martin
1788 1.1 martin #ifdef PPPOE_DEBUG
1789 1.84 matt if (p - mtod(m0, uint8_t *) != len + PPPOE_HEADERLEN)
1790 1.1 martin panic("pppoe_send_padr: garbled output len, should be %ld, is %ld",
1791 1.84 matt (long)(len + PPPOE_HEADERLEN), (long)(p - mtod(m0, uint8_t *)));
1792 1.1 martin #endif
1793 1.1 martin
1794 1.142 maxv /* Send packet. */
1795 1.1 martin return pppoe_output(sc, m0);
1796 1.1 martin }
1797 1.1 martin
1798 1.1 martin /* send a PADT packet */
1799 1.1 martin static int
1800 1.84 matt pppoe_send_padt(struct ifnet *outgoing_if, u_int session, const uint8_t *dest)
1801 1.1 martin {
1802 1.39 martin struct ether_header *eh;
1803 1.39 martin struct sockaddr dst;
1804 1.1 martin struct mbuf *m0;
1805 1.84 matt uint8_t *p;
1806 1.1 martin
1807 1.1 martin m0 = pppoe_get_mbuf(PPPOE_HEADERLEN);
1808 1.26 itojun if (!m0)
1809 1.39 martin return EIO;
1810 1.84 matt p = mtod(m0, uint8_t *);
1811 1.39 martin PPPOE_ADD_HEADER(p, PPPOE_CODE_PADT, session, 0);
1812 1.39 martin
1813 1.39 martin memset(&dst, 0, sizeof dst);
1814 1.39 martin dst.sa_family = AF_UNSPEC;
1815 1.39 martin eh = (struct ether_header*)&dst.sa_data;
1816 1.39 martin eh->ether_type = htons(ETHERTYPE_PPPOEDISC);
1817 1.39 martin memcpy(&eh->ether_dhost, dest, ETHER_ADDR_LEN);
1818 1.39 martin
1819 1.39 martin m0->m_flags &= ~(M_BCAST|M_MCAST);
1820 1.109 knakahar return if_output_lock(outgoing_if, outgoing_if, m0, &dst, NULL);
1821 1.1 martin }
1822 1.43 oki
1823 1.43 oki #ifdef PPPOE_SERVER
1824 1.43 oki static int
1825 1.43 oki pppoe_send_pado(struct pppoe_softc *sc)
1826 1.43 oki {
1827 1.43 oki struct mbuf *m0;
1828 1.84 matt uint8_t *p;
1829 1.43 oki size_t len;
1830 1.43 oki
1831 1.43 oki if (sc->sc_state != PPPOE_STATE_PADO_SENT)
1832 1.43 oki return EIO;
1833 1.43 oki
1834 1.144 maxv /* Include AC cookie. */
1835 1.144 maxv len = sizeof(struct pppoetag) + sizeof(sc->sc_id);
1836 1.144 maxv /* Include hunique. */
1837 1.144 maxv len += sizeof(struct pppoetag) + sc->sc_hunique_len;
1838 1.144 maxv
1839 1.43 oki m0 = pppoe_get_mbuf(len + PPPOE_HEADERLEN);
1840 1.43 oki if (!m0)
1841 1.43 oki return EIO;
1842 1.84 matt p = mtod(m0, uint8_t *);
1843 1.144 maxv
1844 1.43 oki PPPOE_ADD_HEADER(p, PPPOE_CODE_PADO, 0, len);
1845 1.43 oki PPPOE_ADD_16(p, PPPOE_TAG_ACCOOKIE);
1846 1.143 maxv PPPOE_ADD_16(p, sizeof(sc->sc_id));
1847 1.143 maxv memcpy(p, &sc->sc_id, sizeof(sc->sc_id));
1848 1.143 maxv p += sizeof(sc->sc_id);
1849 1.43 oki PPPOE_ADD_16(p, PPPOE_TAG_HUNIQUE);
1850 1.43 oki PPPOE_ADD_16(p, sc->sc_hunique_len);
1851 1.43 oki memcpy(p, sc->sc_hunique, sc->sc_hunique_len);
1852 1.43 oki return pppoe_output(sc, m0);
1853 1.43 oki }
1854 1.43 oki
1855 1.43 oki static int
1856 1.43 oki pppoe_send_pads(struct pppoe_softc *sc)
1857 1.43 oki {
1858 1.69 kardel struct bintime bt;
1859 1.43 oki struct mbuf *m0;
1860 1.84 matt uint8_t *p;
1861 1.61 martin size_t len, l1 = 0; /* XXX: gcc */
1862 1.43 oki
1863 1.127 knakahar KASSERT(PPPOE_WLOCKED(sc));
1864 1.120 knakahar
1865 1.43 oki if (sc->sc_state != PPPOE_STATE_PADO_SENT)
1866 1.43 oki return EIO;
1867 1.43 oki
1868 1.69 kardel getbinuptime(&bt);
1869 1.69 kardel sc->sc_session = bt.sec % 0xff + 1;
1870 1.144 maxv
1871 1.144 maxv /* Include service name. */
1872 1.144 maxv len = sizeof(struct pppoetag);
1873 1.144 maxv if (sc->sc_service_name != NULL) {
1874 1.43 oki l1 = strlen(sc->sc_service_name);
1875 1.43 oki len += l1;
1876 1.43 oki }
1877 1.144 maxv /* Include hunique. */
1878 1.144 maxv len += sizeof(struct pppoetag) + sc->sc_hunique_len;
1879 1.144 maxv
1880 1.43 oki m0 = pppoe_get_mbuf(len + PPPOE_HEADERLEN);
1881 1.43 oki if (!m0)
1882 1.43 oki return ENOBUFS;
1883 1.84 matt p = mtod(m0, uint8_t *);
1884 1.144 maxv
1885 1.43 oki PPPOE_ADD_HEADER(p, PPPOE_CODE_PADS, sc->sc_session, len);
1886 1.43 oki PPPOE_ADD_16(p, PPPOE_TAG_SNAME);
1887 1.43 oki if (sc->sc_service_name != NULL) {
1888 1.43 oki PPPOE_ADD_16(p, l1);
1889 1.43 oki memcpy(p, sc->sc_service_name, l1);
1890 1.43 oki p += l1;
1891 1.43 oki } else {
1892 1.43 oki PPPOE_ADD_16(p, 0);
1893 1.43 oki }
1894 1.43 oki PPPOE_ADD_16(p, PPPOE_TAG_HUNIQUE);
1895 1.43 oki PPPOE_ADD_16(p, sc->sc_hunique_len);
1896 1.43 oki memcpy(p, sc->sc_hunique, sc->sc_hunique_len);
1897 1.43 oki return pppoe_output(sc, m0);
1898 1.43 oki }
1899 1.43 oki #endif
1900 1.1 martin
1901 1.1 martin static void
1902 1.1 martin pppoe_tls(struct sppp *sp)
1903 1.1 martin {
1904 1.26 itojun struct pppoe_softc *sc = (void *)sp;
1905 1.90 martin int wtime;
1906 1.90 martin
1907 1.127 knakahar PPPOE_LOCK(sc, RW_READER);
1908 1.120 knakahar
1909 1.120 knakahar if (sc->sc_state != PPPOE_STATE_INITIAL) {
1910 1.127 knakahar PPPOE_UNLOCK(sc);
1911 1.1 martin return;
1912 1.120 knakahar }
1913 1.120 knakahar
1914 1.90 martin if (sc->sc_sppp.pp_phase == SPPP_PHASE_ESTABLISH &&
1915 1.90 martin sc->sc_sppp.pp_auth_failures > 0) {
1916 1.90 martin /*
1917 1.90 martin * Delay trying to reconnect a bit more - the peer
1918 1.102 snj * might have failed to contact its radius server.
1919 1.90 martin */
1920 1.92 martin wtime = PPPOE_RECON_FAST * sc->sc_sppp.pp_auth_failures;
1921 1.92 martin if (wtime > PPPOE_SLOW_RETRY)
1922 1.92 martin wtime = PPPOE_SLOW_RETRY;
1923 1.90 martin } else {
1924 1.92 martin wtime = PPPOE_RECON_IMMEDIATE;
1925 1.90 martin }
1926 1.150 yamaguch callout_schedule(&sc->sc_timeout, wtime);
1927 1.120 knakahar
1928 1.127 knakahar PPPOE_UNLOCK(sc);
1929 1.1 martin }
1930 1.1 martin
1931 1.1 martin static void
1932 1.1 martin pppoe_tlf(struct sppp *sp)
1933 1.1 martin {
1934 1.26 itojun struct pppoe_softc *sc = (void *)sp;
1935 1.120 knakahar
1936 1.127 knakahar PPPOE_LOCK(sc, RW_WRITER);
1937 1.120 knakahar
1938 1.120 knakahar if (sc->sc_state < PPPOE_STATE_SESSION) {
1939 1.154 yamaguch callout_stop(&sc->sc_timeout);
1940 1.154 yamaguch sc->sc_state = PPPOE_STATE_INITIAL;
1941 1.154 yamaguch sc->sc_padi_retried = 0;
1942 1.154 yamaguch sc->sc_padr_retried = 0;
1943 1.154 yamaguch memcpy(&sc->sc_dest, etherbroadcastaddr,
1944 1.154 yamaguch sizeof(sc->sc_dest));
1945 1.127 knakahar PPPOE_UNLOCK(sc);
1946 1.1 martin return;
1947 1.120 knakahar }
1948 1.154 yamaguch
1949 1.1 martin /*
1950 1.1 martin * Do not call pppoe_disconnect here, the upper layer state
1951 1.1 martin * machine gets confused by this. We must return from this
1952 1.1 martin * function and defer disconnecting to the timeout handler.
1953 1.1 martin */
1954 1.1 martin sc->sc_state = PPPOE_STATE_CLOSING;
1955 1.120 knakahar
1956 1.150 yamaguch callout_schedule(&sc->sc_timeout, hz/50);
1957 1.120 knakahar
1958 1.127 knakahar PPPOE_UNLOCK(sc);
1959 1.1 martin }
1960 1.1 martin
1961 1.1 martin static void
1962 1.1 martin pppoe_start(struct ifnet *ifp)
1963 1.1 martin {
1964 1.26 itojun struct pppoe_softc *sc = (void *)ifp;
1965 1.1 martin struct mbuf *m;
1966 1.84 matt uint8_t *p;
1967 1.1 martin size_t len;
1968 1.1 martin
1969 1.1 martin if (sppp_isempty(ifp))
1970 1.1 martin return;
1971 1.1 martin
1972 1.48 wiz /* are we ready to process data yet? */
1973 1.127 knakahar PPPOE_LOCK(sc, RW_READER);
1974 1.1 martin if (sc->sc_state < PPPOE_STATE_SESSION) {
1975 1.1 martin sppp_flush(&sc->sc_sppp.pp_if);
1976 1.127 knakahar PPPOE_UNLOCK(sc);
1977 1.1 martin return;
1978 1.1 martin }
1979 1.1 martin
1980 1.1 martin while ((m = sppp_dequeue(ifp)) != NULL) {
1981 1.1 martin len = m->m_pkthdr.len;
1982 1.1 martin M_PREPEND(m, PPPOE_HEADERLEN, M_DONTWAIT);
1983 1.1 martin if (m == NULL) {
1984 1.148 thorpej if_statinc(ifp, if_oerrors);
1985 1.37 martin continue;
1986 1.1 martin }
1987 1.84 matt p = mtod(m, uint8_t *);
1988 1.1 martin PPPOE_ADD_HEADER(p, 0, sc->sc_session, len);
1989 1.1 martin
1990 1.141 msaitoh bpf_mtap(&sc->sc_sppp.pp_if, m, BPF_D_OUT);
1991 1.1 martin
1992 1.1 martin pppoe_output(sc, m);
1993 1.1 martin }
1994 1.127 knakahar PPPOE_UNLOCK(sc);
1995 1.1 martin }
1996 1.54 martin
1997 1.120 knakahar #ifdef PPPOE_MPSAFE
1998 1.120 knakahar static int
1999 1.120 knakahar pppoe_transmit(struct ifnet *ifp, struct mbuf *m)
2000 1.120 knakahar {
2001 1.120 knakahar struct pppoe_softc *sc = (void *)ifp;
2002 1.120 knakahar uint8_t *p;
2003 1.120 knakahar size_t len;
2004 1.120 knakahar
2005 1.120 knakahar if (m == NULL)
2006 1.120 knakahar return EINVAL;
2007 1.120 knakahar
2008 1.120 knakahar /* are we ready to process data yet? */
2009 1.127 knakahar PPPOE_LOCK(sc, RW_READER);
2010 1.120 knakahar if (sc->sc_state < PPPOE_STATE_SESSION) {
2011 1.127 knakahar PPPOE_UNLOCK(sc);
2012 1.134 maxv m_freem(m);
2013 1.120 knakahar return ENOBUFS;
2014 1.120 knakahar }
2015 1.120 knakahar
2016 1.120 knakahar len = m->m_pkthdr.len;
2017 1.120 knakahar M_PREPEND(m, PPPOE_HEADERLEN, M_DONTWAIT);
2018 1.120 knakahar if (m == NULL) {
2019 1.127 knakahar PPPOE_UNLOCK(sc);
2020 1.148 thorpej if_statinc(ifp, if_oerrors);
2021 1.120 knakahar return ENETDOWN;
2022 1.120 knakahar }
2023 1.120 knakahar p = mtod(m, uint8_t *);
2024 1.120 knakahar PPPOE_ADD_HEADER(p, 0, sc->sc_session, len);
2025 1.120 knakahar
2026 1.141 msaitoh bpf_mtap(&sc->sc_sppp.pp_if, m, BPF_D_OUT);
2027 1.120 knakahar
2028 1.120 knakahar pppoe_output(sc, m);
2029 1.127 knakahar PPPOE_UNLOCK(sc);
2030 1.120 knakahar return 0;
2031 1.120 knakahar }
2032 1.120 knakahar #endif /* PPPOE_MPSAFE */
2033 1.54 martin
2034 1.123 christos static void
2035 1.123 christos pppoe_ifattach_hook(void *arg, unsigned long cmd, void *arg2)
2036 1.54 martin {
2037 1.123 christos struct ifnet *ifp = arg2;
2038 1.54 martin struct pppoe_softc *sc;
2039 1.120 knakahar DECLARE_SPLNET_VARIABLE;
2040 1.54 martin
2041 1.123 christos if (cmd != PFIL_IFNET_DETACH)
2042 1.123 christos return;
2043 1.54 martin
2044 1.120 knakahar ACQUIRE_SPLNET();
2045 1.120 knakahar rw_enter(&pppoe_softc_list_lock, RW_READER);
2046 1.54 martin LIST_FOREACH(sc, &pppoe_softc_list, sc_list) {
2047 1.127 knakahar PPPOE_LOCK(sc, RW_WRITER);
2048 1.120 knakahar if (sc->sc_eth_if != ifp) {
2049 1.127 knakahar PPPOE_UNLOCK(sc);
2050 1.54 martin continue;
2051 1.120 knakahar }
2052 1.54 martin if (sc->sc_sppp.pp_if.if_flags & IFF_UP) {
2053 1.54 martin sc->sc_sppp.pp_if.if_flags &= ~(IFF_UP|IFF_RUNNING);
2054 1.157 yamaguch pppoe_printf(sc,
2055 1.157 yamaguch "ethernet interface detached, going down\n");
2056 1.54 martin }
2057 1.54 martin sc->sc_eth_if = NULL;
2058 1.57 martin pppoe_clear_softc(sc, "ethernet interface detached");
2059 1.127 knakahar PPPOE_UNLOCK(sc);
2060 1.54 martin }
2061 1.120 knakahar rw_exit(&pppoe_softc_list_lock);
2062 1.120 knakahar RELEASE_SPLNET();
2063 1.54 martin }
2064 1.57 martin
2065 1.57 martin static void
2066 1.57 martin pppoe_clear_softc(struct pppoe_softc *sc, const char *message)
2067 1.57 martin {
2068 1.127 knakahar KASSERT(PPPOE_WLOCKED(sc));
2069 1.120 knakahar
2070 1.58 martin /* stop timer */
2071 1.57 martin callout_stop(&sc->sc_timeout);
2072 1.157 yamaguch pppoe_printf(sc, "session 0x%x terminated, %s\n",
2073 1.157 yamaguch sc->sc_session, message);
2074 1.57 martin
2075 1.57 martin /* fix our state */
2076 1.57 martin sc->sc_state = PPPOE_STATE_INITIAL;
2077 1.120 knakahar
2078 1.127 knakahar PPPOE_UNLOCK(sc);
2079 1.57 martin
2080 1.57 martin /* signal upper layer */
2081 1.57 martin sc->sc_sppp.pp_down(&sc->sc_sppp);
2082 1.120 knakahar
2083 1.127 knakahar PPPOE_LOCK(sc, RW_WRITER);
2084 1.57 martin
2085 1.57 martin /* clean up softc */
2086 1.57 martin memcpy(&sc->sc_dest, etherbroadcastaddr, sizeof(sc->sc_dest));
2087 1.57 martin if (sc->sc_ac_cookie) {
2088 1.57 martin free(sc->sc_ac_cookie, M_DEVBUF);
2089 1.57 martin sc->sc_ac_cookie = NULL;
2090 1.57 martin }
2091 1.94 christos if (sc->sc_relay_sid) {
2092 1.94 christos free(sc->sc_relay_sid, M_DEVBUF);
2093 1.94 christos sc->sc_relay_sid = NULL;
2094 1.94 christos }
2095 1.57 martin sc->sc_ac_cookie_len = 0;
2096 1.57 martin sc->sc_session = 0;
2097 1.57 martin }
2098 1.105 ozaki
2099 1.105 ozaki static void
2100 1.105 ozaki pppoe_enqueue(struct ifqueue *inq, struct mbuf *m)
2101 1.105 ozaki {
2102 1.105 ozaki if (m->m_flags & M_PROMISC) {
2103 1.134 maxv m_freem(m);
2104 1.105 ozaki return;
2105 1.105 ozaki }
2106 1.105 ozaki
2107 1.105 ozaki #ifndef PPPOE_SERVER
2108 1.105 ozaki if (m->m_flags & (M_MCAST | M_BCAST)) {
2109 1.134 maxv m_freem(m);
2110 1.105 ozaki return;
2111 1.105 ozaki }
2112 1.105 ozaki #endif
2113 1.105 ozaki
2114 1.118 ozaki IFQ_LOCK(inq);
2115 1.105 ozaki if (IF_QFULL(inq)) {
2116 1.105 ozaki IF_DROP(inq);
2117 1.118 ozaki IFQ_UNLOCK(inq);
2118 1.105 ozaki m_freem(m);
2119 1.105 ozaki } else {
2120 1.105 ozaki IF_ENQUEUE(inq, m);
2121 1.118 ozaki IFQ_UNLOCK(inq);
2122 1.105 ozaki softint_schedule(pppoe_softintr);
2123 1.105 ozaki }
2124 1.105 ozaki return;
2125 1.105 ozaki }
2126 1.105 ozaki
2127 1.105 ozaki void
2128 1.105 ozaki pppoe_input(struct ifnet *ifp, struct mbuf *m)
2129 1.105 ozaki {
2130 1.105 ozaki pppoe_enqueue(&ppoeinq, m);
2131 1.105 ozaki return;
2132 1.105 ozaki }
2133 1.105 ozaki
2134 1.105 ozaki void
2135 1.105 ozaki pppoedisc_input(struct ifnet *ifp, struct mbuf *m)
2136 1.105 ozaki {
2137 1.105 ozaki pppoe_enqueue(&ppoediscinq, m);
2138 1.105 ozaki return;
2139 1.105 ozaki }
2140 1.112 pgoyette
2141 1.117 christos static void
2142 1.117 christos sysctl_net_pppoe_setup(struct sysctllog **clog)
2143 1.113 pgoyette {
2144 1.113 pgoyette const struct sysctlnode *node = NULL;
2145 1.113 pgoyette
2146 1.113 pgoyette sysctl_createv(clog, 0, NULL, &node,
2147 1.113 pgoyette CTLFLAG_PERMANENT,
2148 1.113 pgoyette CTLTYPE_NODE, "pppoe",
2149 1.113 pgoyette SYSCTL_DESCR("PPPOE protocol"),
2150 1.113 pgoyette NULL, 0, NULL, 0,
2151 1.113 pgoyette CTL_NET, CTL_CREATE, CTL_EOL);
2152 1.113 pgoyette
2153 1.113 pgoyette if (node == NULL)
2154 1.113 pgoyette return;
2155 1.113 pgoyette
2156 1.113 pgoyette sysctl_createv(clog, 0, &node, NULL,
2157 1.135 knakahar CTLFLAG_PERMANENT | CTLFLAG_READWRITE,
2158 1.113 pgoyette CTLTYPE_BOOL, "term_unknown",
2159 1.113 pgoyette SYSCTL_DESCR("Terminate unknown sessions"),
2160 1.113 pgoyette NULL, 0, &pppoe_term_unknown, sizeof(pppoe_term_unknown),
2161 1.113 pgoyette CTL_CREATE, CTL_EOL);
2162 1.113 pgoyette }
2163 1.114 christos
2164 1.114 christos /*
2165 1.114 christos * Module infrastructure
2166 1.114 christos */
2167 1.114 christos #include "if_module.h"
2168 1.114 christos
2169 1.114 christos IF_MODULE(MODULE_CLASS_DRIVER, pppoe, "sppp_subr")
2170