Home | History | Annotate | Line # | Download | only in net
if_pppoe.c revision 1.173
      1  1.173  yamaguch /* $NetBSD: if_pppoe.c,v 1.173 2021/05/13 03:48:55 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.173  yamaguch __KERNEL_RCSID(0, "$NetBSD: if_pppoe.c,v 1.173 2021/05/13 03:48:55 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.118     ozaki 	int disc_done, data_done;
    598    1.1    martin 
    599  1.132     ozaki 	SOFTNET_LOCK_UNLESS_NET_MPSAFE();
    600  1.120  knakahar 
    601    1.3    martin 	do {
    602    1.3    martin 		disc_done = 0;
    603    1.3    martin 		data_done = 0;
    604    1.3    martin 		for (;;) {
    605  1.118     ozaki 			IFQ_LOCK(&ppoediscinq);
    606    1.1    martin 			IF_DEQUEUE(&ppoediscinq, m);
    607  1.118     ozaki 			IFQ_UNLOCK(&ppoediscinq);
    608  1.145      maxv 			if (m == NULL)
    609  1.145      maxv 				break;
    610    1.3    martin 			disc_done = 1;
    611    1.1    martin 			pppoe_disc_input(m);
    612    1.1    martin 		}
    613    1.3    martin 
    614    1.3    martin 		for (;;) {
    615  1.118     ozaki 			IFQ_LOCK(&ppoeinq);
    616    1.1    martin 			IF_DEQUEUE(&ppoeinq, m);
    617  1.118     ozaki 			IFQ_UNLOCK(&ppoeinq);
    618  1.145      maxv 			if (m == NULL)
    619  1.145      maxv 				break;
    620    1.3    martin 			data_done = 1;
    621    1.1    martin 			pppoe_data_input(m);
    622    1.1    martin 		}
    623    1.3    martin 	} while (disc_done || data_done);
    624  1.132     ozaki 
    625  1.162  yamaguch 	if (!IF_IS_EMPTY(&ppoediscinq) || !IF_IS_EMPTY(&ppoeinq))
    626  1.162  yamaguch 		softint_schedule(pppoe_softintr);
    627  1.162  yamaguch 
    628  1.132     ozaki 	SOFTNET_UNLOCK_UNLESS_NET_MPSAFE();
    629    1.1    martin }
    630    1.1    martin 
    631    1.1    martin /* analyze and handle a single received packet while not in session state */
    632   1.63   thorpej static void
    633   1.63   thorpej pppoe_dispatch_disc_pkt(struct mbuf *m, int off)
    634    1.1    martin {
    635   1.84      matt 	uint16_t tag, len;
    636   1.84      matt 	uint16_t session, plen;
    637    1.1    martin 	struct pppoe_softc *sc;
    638  1.120  knakahar 	const char *err_msg;
    639   1.64    martin 	char *error;
    640  1.149   mlelstv 	size_t dlen;
    641   1.84      matt 	uint8_t *ac_cookie;
    642    1.1    martin 	size_t ac_cookie_len;
    643   1.94  christos 	uint8_t *relay_sid;
    644   1.94  christos 	size_t relay_sid_len;
    645   1.84      matt 	uint8_t *hunique;
    646   1.43       oki 	size_t hunique_len;
    647   1.29    itojun 	struct pppoehdr *ph;
    648   1.29    itojun 	struct pppoetag *pt;
    649   1.29    itojun 	struct mbuf *n;
    650   1.46    martin 	int noff, err, errortag;
    651   1.29    itojun 	struct ether_header *eh;
    652  1.139  yamaguch 	struct ifnet *rcvif;
    653  1.139  yamaguch 	struct psref psref;
    654   1.29    itojun 
    655   1.29    itojun 	if (m->m_len < sizeof(*eh)) {
    656   1.29    itojun 		m = m_pullup(m, sizeof(*eh));
    657  1.145      maxv 		if (m == NULL)
    658   1.29    itojun 			goto done;
    659   1.29    itojun 	}
    660   1.29    itojun 	eh = mtod(m, struct ether_header *);
    661   1.29    itojun 	off += sizeof(*eh);
    662    1.1    martin 
    663  1.171  yamaguch 	if (m->m_pkthdr.len - off < PPPOE_HEADERLEN) {
    664   1.29    itojun 		goto done;
    665   1.29    itojun 	}
    666   1.29    itojun 
    667  1.146      maxv 	M_REGION_GET(ph, struct pppoehdr *, m, off, sizeof(*ph));
    668  1.146      maxv 	if (ph == NULL) {
    669   1.29    itojun 		goto done;
    670   1.29    itojun 	}
    671   1.29    itojun 	if (ph->vertype != PPPOE_VERTYPE) {
    672   1.29    itojun 		goto done;
    673   1.29    itojun 	}
    674  1.146      maxv 
    675  1.146      maxv 	ac_cookie = NULL;
    676  1.146      maxv 	ac_cookie_len = 0;
    677  1.146      maxv 	relay_sid = NULL;
    678  1.146      maxv 	relay_sid_len = 0;
    679  1.146      maxv 	hunique = NULL;
    680  1.146      maxv 	hunique_len = 0;
    681  1.146      maxv 
    682   1.29    itojun 	session = ntohs(ph->session);
    683   1.29    itojun 	plen = ntohs(ph->plen);
    684   1.29    itojun 	off += sizeof(*ph);
    685   1.29    itojun 
    686   1.29    itojun 	if (plen + off > m->m_pkthdr.len) {
    687   1.29    itojun 		goto done;
    688    1.1    martin 	}
    689   1.29    itojun 	m_adj(m, off + plen - m->m_pkthdr.len);	/* ignore trailing garbage */
    690  1.145      maxv 
    691    1.1    martin 	tag = 0;
    692    1.1    martin 	len = 0;
    693    1.1    martin 	sc = NULL;
    694  1.146      maxv 	err_msg = NULL;
    695  1.146      maxv 	errortag = 0;
    696   1.31      yamt 	while (off + sizeof(*pt) <= m->m_pkthdr.len) {
    697  1.146      maxv 		M_REGION_GET(pt, struct pppoetag *, m, off, sizeof(*pt));
    698  1.146      maxv 		if (pt == NULL) {
    699   1.29    itojun 			goto done;
    700   1.29    itojun 		}
    701  1.146      maxv 
    702   1.29    itojun 		tag = ntohs(pt->tag);
    703   1.29    itojun 		len = ntohs(pt->len);
    704   1.88    martin 		if (off + len + sizeof(*pt) > m->m_pkthdr.len) {
    705   1.29    itojun 			goto done;
    706    1.1    martin 		}
    707    1.1    martin 		switch (tag) {
    708    1.1    martin 		case PPPOE_TAG_EOL:
    709   1.29    itojun 			goto breakbreak;
    710    1.1    martin 		case PPPOE_TAG_SNAME:
    711    1.1    martin 			break;	/* ignored */
    712    1.1    martin 		case PPPOE_TAG_ACNAME:
    713  1.139  yamaguch 			if (len > 0) {
    714  1.149   mlelstv 				dlen = 4 * len + 1;
    715  1.149   mlelstv 				error = malloc(dlen, M_TEMP, M_NOWAIT);
    716  1.124      maxv 				if (error == NULL)
    717  1.124      maxv 					break;
    718  1.124      maxv 
    719  1.124      maxv 				n = m_pulldown(m, off + sizeof(*pt), len,
    720  1.124      maxv 				    &noff);
    721  1.124      maxv 				if (!n) {
    722  1.124      maxv 					m = NULL;
    723   1.80    martin 					free(error, M_TEMP);
    724  1.124      maxv 					goto done;
    725   1.80    martin 				}
    726  1.124      maxv 
    727  1.149   mlelstv 				strnvisx(error, dlen,
    728  1.149   mlelstv 				    mtod(n, char*) + noff, len,
    729  1.149   mlelstv 				    VIS_SAFE | VIS_OCTAL);
    730  1.157  yamaguch 				pppoe_printf(NULL, "connected to %s\n", error);
    731  1.124      maxv 				free(error, M_TEMP);
    732   1.80    martin 			}
    733    1.1    martin 			break;	/* ignored */
    734  1.139  yamaguch 		case PPPOE_TAG_HUNIQUE:
    735  1.139  yamaguch 			if (hunique == NULL) {
    736  1.139  yamaguch 				n = m_pulldown(m, off + sizeof(*pt), len,
    737  1.139  yamaguch 				    &noff);
    738  1.139  yamaguch 				if (!n) {
    739  1.139  yamaguch 					m = NULL;
    740  1.139  yamaguch 					err_msg = "TAG HUNIQUE ERROR";
    741  1.139  yamaguch 					break;
    742  1.139  yamaguch 				}
    743  1.125     ozaki 
    744  1.139  yamaguch 				hunique = mtod(n, uint8_t *) + noff;
    745  1.139  yamaguch 				hunique_len = len;
    746  1.120  knakahar 			}
    747    1.1    martin 			break;
    748    1.1    martin 		case PPPOE_TAG_ACCOOKIE:
    749    1.1    martin 			if (ac_cookie == NULL) {
    750   1.29    itojun 				n = m_pulldown(m, off + sizeof(*pt), len,
    751   1.29    itojun 				    &noff);
    752   1.29    itojun 				if (!n) {
    753   1.29    itojun 					err_msg = "TAG ACCOOKIE ERROR";
    754   1.29    itojun 					m = NULL;
    755   1.29    itojun 					break;
    756   1.29    itojun 				}
    757   1.77  christos 				ac_cookie = mtod(n, char *) + noff;
    758    1.1    martin 				ac_cookie_len = len;
    759    1.1    martin 			}
    760    1.1    martin 			break;
    761   1.94  christos 		case PPPOE_TAG_RELAYSID:
    762   1.94  christos 			if (relay_sid == NULL) {
    763   1.94  christos 				n = m_pulldown(m, off + sizeof(*pt), len,
    764   1.94  christos 				    &noff);
    765   1.94  christos 				if (!n) {
    766   1.94  christos 					err_msg = "TAG RELAYSID ERROR";
    767   1.94  christos 					m = NULL;
    768   1.94  christos 					break;
    769   1.94  christos 				}
    770   1.94  christos 				relay_sid = mtod(n, char *) + noff;
    771   1.94  christos 				relay_sid_len = len;
    772   1.94  christos 			}
    773   1.94  christos 			break;
    774    1.1    martin 		case PPPOE_TAG_SNAME_ERR:
    775    1.1    martin 			err_msg = "SERVICE NAME ERROR";
    776   1.46    martin 			errortag = 1;
    777    1.1    martin 			break;
    778    1.1    martin 		case PPPOE_TAG_ACSYS_ERR:
    779    1.1    martin 			err_msg = "AC SYSTEM ERROR";
    780   1.46    martin 			errortag = 1;
    781    1.1    martin 			break;
    782    1.1    martin 		case PPPOE_TAG_GENERIC_ERR:
    783    1.1    martin 			err_msg = "GENERIC ERROR";
    784   1.46    martin 			errortag = 1;
    785    1.1    martin 			break;
    786    1.1    martin 		}
    787    1.1    martin 		if (err_msg) {
    788   1.64    martin 			error = NULL;
    789   1.46    martin 			if (errortag && len) {
    790  1.149   mlelstv 				dlen = 4 * len + 1;
    791  1.149   mlelstv 				error = malloc(dlen, M_TEMP,
    792  1.124      maxv 				    M_NOWAIT|M_ZERO);
    793   1.46    martin 				n = m_pulldown(m, off + sizeof(*pt), len,
    794   1.46    martin 				    &noff);
    795  1.124      maxv 				if (!n) {
    796  1.124      maxv 					m = NULL;
    797  1.124      maxv 				} else if (error) {
    798  1.149   mlelstv 					strnvisx(error, dlen,
    799  1.149   mlelstv 					    mtod(n, char*) + noff, len,
    800  1.149   mlelstv 					    VIS_SAFE | VIS_OCTAL);
    801   1.64    martin 				}
    802   1.46    martin 			}
    803   1.64    martin 			if (error) {
    804  1.157  yamaguch 				pppoe_printf(NULL, "%s: %s\n", err_msg, error);
    805   1.64    martin 				free(error, M_TEMP);
    806   1.64    martin 			} else
    807  1.157  yamaguch 				pppoe_printf(NULL, "%s\n", err_msg);
    808   1.88    martin 			if (errortag || m == NULL)
    809   1.46    martin 				goto done;
    810    1.1    martin 		}
    811   1.29    itojun 		off += sizeof(*pt) + len;
    812    1.1    martin 	}
    813   1.29    itojun breakbreak:;
    814  1.145      maxv 
    815   1.29    itojun 	switch (ph->code) {
    816    1.1    martin 	case PPPOE_CODE_PADI:
    817   1.43       oki #ifdef PPPOE_SERVER
    818   1.43       oki 		/*
    819   1.43       oki 		 * got service name, concentrator name, and/or host unique.
    820   1.43       oki 		 * ignore if we have no interfaces with IFF_PASSIVE|IFF_UP.
    821   1.43       oki 		 */
    822  1.140  yamaguch 		rw_enter(&pppoe_softc_list_lock, RW_READER);
    823  1.140  yamaguch 		if (LIST_EMPTY(&pppoe_softc_list)) {
    824  1.140  yamaguch 			rw_exit(&pppoe_softc_list_lock);
    825   1.43       oki 			goto done;
    826  1.140  yamaguch 		}
    827  1.140  yamaguch 
    828   1.43       oki 		LIST_FOREACH(sc, &pppoe_softc_list, sc_list) {
    829  1.127  knakahar 			PPPOE_LOCK(sc, RW_WRITER);
    830  1.120  knakahar 			if (!(sc->sc_sppp.pp_if.if_flags & IFF_UP)) {
    831  1.127  knakahar 				PPPOE_UNLOCK(sc);
    832   1.43       oki 				continue;
    833  1.120  knakahar 			}
    834  1.120  knakahar 			if (!(sc->sc_sppp.pp_if.if_flags & IFF_PASSIVE)) {
    835  1.127  knakahar 				PPPOE_UNLOCK(sc);
    836   1.43       oki 				continue;
    837  1.120  knakahar 			}
    838  1.120  knakahar 
    839  1.127  knakahar 			if (sc->sc_state == PPPOE_STATE_INITIAL)
    840   1.43       oki 				break;
    841  1.120  knakahar 
    842  1.127  knakahar 			PPPOE_UNLOCK(sc);
    843   1.43       oki 		}
    844  1.120  knakahar 		rw_exit(&pppoe_softc_list_lock);
    845  1.120  knakahar 
    846   1.43       oki 		if (sc == NULL) {
    847   1.43       oki 			goto done;
    848   1.43       oki 		}
    849  1.120  knakahar 
    850   1.43       oki 		if (hunique) {
    851   1.43       oki 			if (sc->sc_hunique)
    852   1.43       oki 				free(sc->sc_hunique, M_DEVBUF);
    853   1.43       oki 			sc->sc_hunique = malloc(hunique_len, M_DEVBUF,
    854   1.43       oki 			    M_DONTWAIT);
    855  1.120  knakahar 			if (sc->sc_hunique == NULL) {
    856  1.127  knakahar 				PPPOE_UNLOCK(sc);
    857   1.43       oki 				goto done;
    858  1.120  knakahar 			}
    859   1.43       oki 			sc->sc_hunique_len = hunique_len;
    860   1.43       oki 			memcpy(sc->sc_hunique, hunique, hunique_len);
    861   1.43       oki 		}
    862   1.44       oki 		memcpy(&sc->sc_dest, eh->ether_shost, sizeof sc->sc_dest);
    863   1.43       oki 		sc->sc_state = PPPOE_STATE_PADO_SENT;
    864   1.43       oki 		pppoe_send_pado(sc);
    865  1.127  knakahar 		PPPOE_UNLOCK(sc);
    866   1.43       oki 		break;
    867   1.43       oki #endif /* PPPOE_SERVER */
    868  1.145      maxv 
    869    1.1    martin 	case PPPOE_CODE_PADR:
    870   1.43       oki #ifdef PPPOE_SERVER
    871   1.43       oki 		/*
    872   1.43       oki 		 * get sc from ac_cookie if IFF_PASSIVE
    873   1.43       oki 		 */
    874   1.43       oki 		if (ac_cookie == NULL) {
    875   1.43       oki 			goto done;
    876   1.43       oki 		}
    877  1.125     ozaki 
    878  1.125     ozaki 		rcvif = m_get_rcvif_psref(m, &psref);
    879  1.125     ozaki 		if (__predict_true(rcvif != NULL)) {
    880  1.125     ozaki 			sc = pppoe_find_softc_by_hunique(ac_cookie,
    881  1.145      maxv 			    ac_cookie_len, rcvif, RW_WRITER);
    882  1.125     ozaki 		}
    883  1.125     ozaki 		m_put_rcvif_psref(rcvif, &psref);
    884   1.43       oki 		if (sc == NULL) {
    885   1.43       oki 			/* be quiet if there is not a single pppoe instance */
    886  1.140  yamaguch 			rw_enter(&pppoe_softc_list_lock, RW_READER);
    887  1.140  yamaguch 			if (!LIST_EMPTY(&pppoe_softc_list)) {
    888  1.157  yamaguch 				pppoe_printf(NULL, "received PADR"
    889  1.140  yamaguch 				    " but could not find request for it\n");
    890  1.140  yamaguch 			}
    891  1.140  yamaguch 			rw_exit(&pppoe_softc_list_lock);
    892   1.43       oki 			goto done;
    893   1.43       oki 		}
    894  1.120  knakahar 
    895  1.127  knakahar 		if (sc->sc_state != PPPOE_STATE_PADO_SENT) {
    896  1.157  yamaguch 			pppoe_printf(sc, "received unexpected PADR\n");
    897  1.127  knakahar 			PPPOE_UNLOCK(sc);
    898   1.43       oki 			goto done;
    899   1.43       oki 		}
    900  1.127  knakahar 
    901   1.43       oki 		if (hunique) {
    902   1.43       oki 			if (sc->sc_hunique)
    903   1.43       oki 				free(sc->sc_hunique, M_DEVBUF);
    904   1.43       oki 			sc->sc_hunique = malloc(hunique_len, M_DEVBUF,
    905   1.43       oki 			    M_DONTWAIT);
    906  1.120  knakahar 			if (sc->sc_hunique == NULL) {
    907  1.127  knakahar 				PPPOE_UNLOCK(sc);
    908   1.43       oki 				goto done;
    909  1.120  knakahar 			}
    910   1.43       oki 			sc->sc_hunique_len = hunique_len;
    911   1.43       oki 			memcpy(sc->sc_hunique, hunique, hunique_len);
    912   1.43       oki 		}
    913   1.43       oki 		pppoe_send_pads(sc);
    914   1.43       oki 		sc->sc_state = PPPOE_STATE_SESSION;
    915  1.127  knakahar 		PPPOE_UNLOCK(sc);
    916  1.120  knakahar 
    917   1.43       oki 		sc->sc_sppp.pp_up(&sc->sc_sppp);
    918   1.43       oki 		break;
    919   1.43       oki #else
    920    1.1    martin 		/* ignore, we are no access concentrator */
    921   1.29    itojun 		goto done;
    922   1.43       oki #endif /* PPPOE_SERVER */
    923  1.145      maxv 
    924    1.1    martin 	case PPPOE_CODE_PADO:
    925  1.139  yamaguch 		rcvif = m_get_rcvif_psref(m, &psref);
    926  1.139  yamaguch 		if (__predict_false(rcvif == NULL))
    927  1.139  yamaguch 			goto done;
    928  1.139  yamaguch 
    929  1.139  yamaguch 		if (hunique != NULL) {
    930  1.139  yamaguch 			sc = pppoe_find_softc_by_hunique(hunique,
    931  1.145      maxv 			    hunique_len, rcvif, RW_WRITER);
    932  1.139  yamaguch 		}
    933  1.139  yamaguch 
    934  1.139  yamaguch 		m_put_rcvif_psref(rcvif, &psref);
    935  1.139  yamaguch 
    936    1.1    martin 		if (sc == NULL) {
    937   1.33      tron 			/* be quiet if there is not a single pppoe instance */
    938  1.140  yamaguch 			rw_enter(&pppoe_softc_list_lock, RW_READER);
    939  1.140  yamaguch 			if (!LIST_EMPTY(&pppoe_softc_list)) {
    940  1.157  yamaguch 				pppoe_printf(NULL, "received PADO"
    941  1.140  yamaguch 				    " but could not find request for it\n");
    942  1.140  yamaguch 			}
    943  1.140  yamaguch 			rw_exit(&pppoe_softc_list_lock);
    944   1.29    itojun 			goto done;
    945    1.1    martin 		}
    946  1.120  knakahar 
    947  1.127  knakahar 		if (sc->sc_state != PPPOE_STATE_PADI_SENT) {
    948  1.157  yamaguch 			pppoe_printf(sc, "received unexpected PADO\n");
    949  1.127  knakahar 			PPPOE_UNLOCK(sc);
    950   1.29    itojun 			goto done;
    951    1.1    martin 		}
    952  1.120  knakahar 
    953    1.1    martin 		if (ac_cookie) {
    954   1.32      yamt 			if (sc->sc_ac_cookie)
    955   1.32      yamt 				free(sc->sc_ac_cookie, M_DEVBUF);
    956   1.29    itojun 			sc->sc_ac_cookie = malloc(ac_cookie_len, M_DEVBUF,
    957   1.29    itojun 			    M_DONTWAIT);
    958   1.89    martin 			if (sc->sc_ac_cookie == NULL) {
    959  1.157  yamaguch 				pppoe_printf(sc, "FATAL: could not allocate memory "
    960  1.157  yamaguch 				    "for AC cookie\n");
    961  1.127  knakahar 				PPPOE_UNLOCK(sc);
    962   1.29    itojun 				goto done;
    963   1.89    martin 			}
    964    1.1    martin 			sc->sc_ac_cookie_len = ac_cookie_len;
    965    1.1    martin 			memcpy(sc->sc_ac_cookie, ac_cookie, ac_cookie_len);
    966    1.1    martin 		}
    967   1.94  christos 		if (relay_sid) {
    968   1.94  christos 			if (sc->sc_relay_sid)
    969   1.94  christos 				free(sc->sc_relay_sid, M_DEVBUF);
    970   1.94  christos 			sc->sc_relay_sid = malloc(relay_sid_len, M_DEVBUF,
    971   1.94  christos 			    M_DONTWAIT);
    972   1.94  christos 			if (sc->sc_relay_sid == NULL) {
    973  1.157  yamaguch 				pppoe_printf(sc, "FATAL: could not allocate memory "
    974  1.157  yamaguch 				    "for relay SID\n");
    975  1.127  knakahar 				PPPOE_UNLOCK(sc);
    976   1.94  christos 				goto done;
    977   1.94  christos 			}
    978   1.94  christos 			sc->sc_relay_sid_len = relay_sid_len;
    979   1.94  christos 			memcpy(sc->sc_relay_sid, relay_sid, relay_sid_len);
    980   1.94  christos 		}
    981    1.1    martin 		memcpy(&sc->sc_dest, eh->ether_shost, sizeof sc->sc_dest);
    982    1.1    martin 		callout_stop(&sc->sc_timeout);
    983    1.1    martin 		sc->sc_padr_retried = 0;
    984    1.1    martin 		sc->sc_state = PPPOE_STATE_PADR_SENT;
    985   1.45    martin 		if ((err = pppoe_send_padr(sc)) != 0) {
    986  1.157  yamaguch 			pppoe_printf(sc,
    987  1.157  yamaguch 			    "failed to send PADR, error=%d\n", err);
    988   1.45    martin 		}
    989  1.150  yamaguch 		callout_schedule(&sc->sc_timeout,
    990  1.150  yamaguch 		    PPPOE_DISC_TIMEOUT * (1 + sc->sc_padr_retried));
    991  1.120  knakahar 
    992  1.127  knakahar 		PPPOE_UNLOCK(sc);
    993    1.1    martin 		break;
    994  1.145      maxv 
    995    1.1    martin 	case PPPOE_CODE_PADS:
    996  1.139  yamaguch 		rcvif = m_get_rcvif_psref(m, &psref);
    997  1.139  yamaguch 		if (__predict_false(rcvif == NULL))
    998  1.139  yamaguch 			goto done;
    999  1.139  yamaguch 
   1000  1.139  yamaguch 		if (hunique != NULL) {
   1001  1.139  yamaguch 			sc = pppoe_find_softc_by_hunique(hunique,
   1002  1.145      maxv 			    hunique_len, rcvif, RW_WRITER);
   1003  1.139  yamaguch 		}
   1004  1.139  yamaguch 
   1005  1.139  yamaguch 		m_put_rcvif_psref(rcvif, &psref);
   1006  1.139  yamaguch 
   1007    1.1    martin 		if (sc == NULL)
   1008   1.29    itojun 			goto done;
   1009  1.120  knakahar 
   1010  1.173  yamaguch 		if (memcmp(&sc->sc_dest, eh->ether_shost,
   1011  1.173  yamaguch 		    sizeof sc->sc_dest) != 0) {
   1012  1.173  yamaguch 			goto done;
   1013  1.173  yamaguch 		}
   1014  1.173  yamaguch 
   1015    1.1    martin 		sc->sc_session = session;
   1016    1.1    martin 		callout_stop(&sc->sc_timeout);
   1017  1.157  yamaguch 		pppoe_printf(sc, "session 0x%x connected\n", session);
   1018    1.1    martin 		sc->sc_state = PPPOE_STATE_SESSION;
   1019  1.127  knakahar 		PPPOE_UNLOCK(sc);
   1020  1.120  knakahar 
   1021    1.1    martin 		sc->sc_sppp.pp_up(&sc->sc_sppp);	/* notify upper layers */
   1022    1.1    martin 		break;
   1023  1.145      maxv 
   1024  1.139  yamaguch 	case PPPOE_CODE_PADT:
   1025  1.139  yamaguch 		rcvif = m_get_rcvif_psref(m, &psref);
   1026  1.139  yamaguch 		if (__predict_false(rcvif == NULL))
   1027  1.139  yamaguch 			goto done;
   1028  1.139  yamaguch 
   1029  1.139  yamaguch 		sc = pppoe_find_softc_by_session(session, rcvif,
   1030  1.139  yamaguch 		    RW_WRITER);
   1031  1.108     ozaki 
   1032  1.125     ozaki 		m_put_rcvif_psref(rcvif, &psref);
   1033  1.139  yamaguch 
   1034    1.1    martin 		if (sc == NULL)
   1035   1.29    itojun 			goto done;
   1036  1.120  knakahar 
   1037  1.173  yamaguch 		if (memcmp(&sc->sc_dest, eh->ether_shost,
   1038  1.173  yamaguch 		    sizeof sc->sc_dest) != 0) {
   1039  1.173  yamaguch 			goto done;
   1040  1.173  yamaguch 		}
   1041  1.173  yamaguch 
   1042   1.57    martin 		pppoe_clear_softc(sc, "received PADT");
   1043  1.172  yamaguch 		if (sc->sc_sppp.pp_if.if_flags & IFF_RUNNING) {
   1044  1.172  yamaguch 			pppoe_printf(sc, "wait for reconnect\n");
   1045  1.172  yamaguch 			callout_schedule(&sc->sc_timeout,
   1046  1.172  yamaguch 			    PPPOE_RECON_PADTRCVD);
   1047  1.172  yamaguch 		}
   1048  1.127  knakahar 		PPPOE_UNLOCK(sc);
   1049   1.25    itojun 		break;
   1050  1.145      maxv 
   1051   1.25    itojun 	default:
   1052  1.139  yamaguch 		rcvif = m_get_rcvif_psref(m, &psref);
   1053  1.139  yamaguch 		if (__predict_false(rcvif == NULL))
   1054  1.139  yamaguch 			goto done;
   1055  1.139  yamaguch 
   1056  1.139  yamaguch 		if (hunique != NULL) {
   1057  1.139  yamaguch 			sc = pppoe_find_softc_by_hunique(hunique,
   1058  1.145      maxv 			    hunique_len, rcvif, RW_READER);
   1059  1.139  yamaguch 		}
   1060  1.139  yamaguch 
   1061  1.139  yamaguch 		m_put_rcvif_psref(rcvif, &psref);
   1062  1.139  yamaguch 
   1063  1.157  yamaguch 		pppoe_printf(sc, "unknown code (0x%04x) session = 0x%04x\n",
   1064  1.157  yamaguch 		    ph->code, session);
   1065  1.157  yamaguch 		if (sc == NULL)
   1066  1.157  yamaguch 			goto done;
   1067  1.157  yamaguch 		PPPOE_UNLOCK(sc);
   1068   1.25    itojun 		break;
   1069   1.25    itojun 	}
   1070   1.29    itojun 
   1071   1.29    itojun done:
   1072   1.65  christos 	if (m)
   1073   1.65  christos 		m_freem(m);
   1074   1.29    itojun 	return;
   1075    1.1    martin }
   1076    1.1    martin 
   1077    1.1    martin static void
   1078    1.1    martin pppoe_disc_input(struct mbuf *m)
   1079    1.1    martin {
   1080  1.137      maxv 	KASSERT(m->m_flags & M_PKTHDR);
   1081    1.1    martin 
   1082  1.137      maxv 	/*
   1083  1.137      maxv 	 * Avoid error messages if there is not a single PPPoE instance.
   1084  1.137      maxv 	 */
   1085  1.140  yamaguch 	rw_enter(&pppoe_softc_list_lock, RW_READER);
   1086   1.25    itojun 	if (!LIST_EMPTY(&pppoe_softc_list)) {
   1087  1.140  yamaguch 		rw_exit(&pppoe_softc_list_lock);
   1088   1.29    itojun 		pppoe_dispatch_disc_pkt(m, 0);
   1089  1.137      maxv 	} else {
   1090  1.140  yamaguch 		rw_exit(&pppoe_softc_list_lock);
   1091   1.29    itojun 		m_freem(m);
   1092  1.137      maxv 	}
   1093    1.1    martin }
   1094    1.1    martin 
   1095  1.136  knakahar static bool
   1096  1.136  knakahar pppoe_is_my_frame(uint8_t *dhost, struct ifnet *rcvif)
   1097  1.136  knakahar {
   1098  1.136  knakahar 
   1099  1.136  knakahar 	if (memcmp(CLLADDR(rcvif->if_sadl), dhost, ETHER_ADDR_LEN) == 0)
   1100  1.136  knakahar 		return true;
   1101  1.136  knakahar 
   1102  1.136  knakahar 	return false;
   1103  1.136  knakahar }
   1104  1.136  knakahar 
   1105    1.1    martin static void
   1106    1.1    martin pppoe_data_input(struct mbuf *m)
   1107    1.1    martin {
   1108   1.84      matt 	uint16_t session, plen;
   1109   1.25    itojun 	struct pppoe_softc *sc;
   1110   1.29    itojun 	struct pppoehdr *ph;
   1111  1.108     ozaki 	struct ifnet *rcvif;
   1112  1.108     ozaki 	struct psref psref;
   1113   1.84      matt 	uint8_t shost[ETHER_ADDR_LEN];
   1114  1.136  knakahar 	uint8_t dhost[ETHER_ADDR_LEN];
   1115  1.135  knakahar 	bool term_unknown = pppoe_term_unknown;
   1116    1.1    martin 
   1117   1.25    itojun 	KASSERT(m->m_flags & M_PKTHDR);
   1118   1.25    itojun 
   1119  1.137      maxv 	/*
   1120  1.137      maxv 	 * Avoid error messages if there is not a single PPPoE instance.
   1121  1.137      maxv 	 */
   1122  1.140  yamaguch 	rw_enter(&pppoe_softc_list_lock, RW_READER);
   1123  1.137      maxv 	if (LIST_EMPTY(&pppoe_softc_list)) {
   1124  1.140  yamaguch 		rw_exit(&pppoe_softc_list_lock);
   1125  1.137      maxv 		goto drop;
   1126  1.137      maxv 	}
   1127  1.140  yamaguch 	rw_exit(&pppoe_softc_list_lock);
   1128  1.137      maxv 
   1129  1.136  knakahar 	if (term_unknown) {
   1130  1.117  christos 		memcpy(shost, mtod(m, struct ether_header*)->ether_shost,
   1131  1.117  christos 		    ETHER_ADDR_LEN);
   1132  1.136  knakahar 		memcpy(dhost, mtod(m, struct ether_header*)->ether_dhost,
   1133  1.136  knakahar 		    ETHER_ADDR_LEN);
   1134  1.136  knakahar 	}
   1135   1.25    itojun 	m_adj(m, sizeof(struct ether_header));
   1136   1.25    itojun 	if (m->m_pkthdr.len <= PPPOE_HEADERLEN) {
   1137   1.25    itojun 		goto drop;
   1138   1.25    itojun 	}
   1139   1.25    itojun 
   1140   1.30    itojun 	if (m->m_len < sizeof(*ph)) {
   1141   1.30    itojun 		m = m_pullup(m, sizeof(*ph));
   1142  1.145      maxv 		if (m == NULL) {
   1143   1.30    itojun 			return;
   1144   1.30    itojun 		}
   1145   1.29    itojun 	}
   1146   1.29    itojun 	ph = mtod(m, struct pppoehdr *);
   1147   1.25    itojun 
   1148   1.29    itojun 	if (ph->vertype != PPPOE_VERTYPE) {
   1149   1.25    itojun 		goto drop;
   1150   1.25    itojun 	}
   1151  1.146      maxv 	if (ph->code != 0) {
   1152   1.25    itojun 		goto drop;
   1153  1.146      maxv 	}
   1154   1.25    itojun 
   1155   1.29    itojun 	session = ntohs(ph->session);
   1156  1.108     ozaki 	rcvif = m_get_rcvif_psref(m, &psref);
   1157  1.110     ozaki 	if (__predict_false(rcvif == NULL))
   1158  1.110     ozaki 		goto drop;
   1159  1.120  knakahar 	sc = pppoe_find_softc_by_session(session, rcvif, RW_READER);
   1160   1.34    martin 	if (sc == NULL) {
   1161  1.135  knakahar 		if (term_unknown) {
   1162  1.136  knakahar 			static struct timeval lasttime = {0, 0};
   1163  1.136  knakahar 			static int curpps = 0;
   1164  1.136  knakahar 			/*
   1165  1.136  knakahar 			 * avoid to send wrong PADT which is response from
   1166  1.147   msaitoh 			 * session stage packets for other hosts when parent
   1167  1.136  knakahar 			 * ethernet is promiscuous mode.
   1168  1.136  knakahar 			 */
   1169  1.145      maxv 			if (pppoe_is_my_frame(dhost, rcvif) &&
   1170  1.145      maxv 			    ppsratecheck(&lasttime, &curpps,
   1171  1.136  knakahar 				pppoe_term_unknown_pps)) {
   1172  1.157  yamaguch 				pppoe_printf(NULL, "input for unknown session %#x, "
   1173  1.136  knakahar 				    "sending PADT\n", session);
   1174  1.136  knakahar 				pppoe_send_padt(rcvif, session, shost);
   1175  1.136  knakahar 			}
   1176  1.113  pgoyette 		}
   1177  1.108     ozaki 		m_put_rcvif_psref(rcvif, &psref);
   1178   1.25    itojun 		goto drop;
   1179   1.34    martin 	}
   1180  1.120  knakahar 
   1181  1.108     ozaki 	m_put_rcvif_psref(rcvif, &psref);
   1182   1.25    itojun 
   1183   1.29    itojun 	plen = ntohs(ph->plen);
   1184    1.1    martin 
   1185  1.141   msaitoh 	bpf_mtap(&sc->sc_sppp.pp_if, m, BPF_D_IN);
   1186    1.1    martin 
   1187   1.25    itojun 	m_adj(m, PPPOE_HEADERLEN);
   1188    1.1    martin 
   1189    1.1    martin #ifdef PPPOE_DEBUG
   1190   1.25    itojun 	{
   1191   1.25    itojun 		struct mbuf *p;
   1192    1.1    martin 
   1193   1.25    itojun 		printf("%s: pkthdr.len=%d, pppoe.len=%d",
   1194  1.129   msaitoh 		    sc->sc_sppp.pp_if.if_xname, m->m_pkthdr.len, plen);
   1195   1.25    itojun 		p = m;
   1196   1.25    itojun 		while (p) {
   1197   1.25    itojun 			printf(" l=%d", p->m_len);
   1198   1.25    itojun 			p = p->m_next;
   1199   1.25    itojun 		}
   1200   1.25    itojun 		printf("\n");
   1201   1.25    itojun 	}
   1202    1.1    martin #endif
   1203  1.127  knakahar 	PPPOE_UNLOCK(sc);
   1204   1.26    itojun 
   1205   1.25    itojun 	if (m->m_pkthdr.len < plen)
   1206   1.25    itojun 		goto drop;
   1207   1.25    itojun 
   1208  1.156  yamaguch 	/* ignore trailing garbage */
   1209  1.156  yamaguch 	m_adj(m, plen - m->m_pkthdr.len);
   1210  1.129   msaitoh 	/*
   1211  1.145      maxv 	 * Fix incoming interface pointer (not the raw ethernet interface
   1212  1.129   msaitoh 	 * anymore)
   1213  1.129   msaitoh 	 */
   1214  1.107     ozaki 	m_set_rcvif(m, &sc->sc_sppp.pp_if);
   1215   1.25    itojun 
   1216   1.25    itojun 	/* pass packet up and account for it */
   1217  1.148   thorpej 	if_statinc(&sc->sc_sppp.pp_if, if_ipackets);
   1218   1.25    itojun 	sppp_input(&sc->sc_sppp.pp_if, m);
   1219   1.25    itojun 	return;
   1220    1.1    martin 
   1221    1.1    martin drop:
   1222   1.29    itojun 	m_freem(m);
   1223    1.1    martin }
   1224    1.1    martin 
   1225    1.1    martin static int
   1226    1.1    martin pppoe_output(struct pppoe_softc *sc, struct mbuf *m)
   1227    1.1    martin {
   1228   1.25    itojun 	struct sockaddr dst;
   1229   1.25    itojun 	struct ether_header *eh;
   1230   1.84      matt 	uint16_t etype;
   1231   1.25    itojun 
   1232   1.52       oki 	if (sc->sc_eth_if == NULL) {
   1233   1.52       oki 		m_freem(m);
   1234   1.25    itojun 		return EIO;
   1235   1.52       oki 	}
   1236   1.25    itojun 
   1237   1.25    itojun 	memset(&dst, 0, sizeof dst);
   1238   1.25    itojun 	dst.sa_family = AF_UNSPEC;
   1239   1.25    itojun 	eh = (struct ether_header*)&dst.sa_data;
   1240  1.129   msaitoh 	etype = sc->sc_state == PPPOE_STATE_SESSION
   1241  1.129   msaitoh 	    ? ETHERTYPE_PPPOE : ETHERTYPE_PPPOEDISC;
   1242   1.25    itojun 	eh->ether_type = htons(etype);
   1243   1.25    itojun 	memcpy(&eh->ether_dhost, &sc->sc_dest, sizeof sc->sc_dest);
   1244    1.1    martin 
   1245  1.157  yamaguch 	DPRINTF(sc, "(%x) state=%d, session=0x%x output -> %s, len=%d\n",
   1246  1.157  yamaguch 	    etype, sc->sc_state, sc->sc_session,
   1247    1.1    martin 	    ether_sprintf((const unsigned char *)&sc->sc_dest), m->m_pkthdr.len);
   1248    1.1    martin 
   1249   1.22    martin 	m->m_flags &= ~(M_BCAST|M_MCAST);
   1250  1.148   thorpej 	if_statinc(&sc->sc_sppp.pp_if, if_opackets);
   1251  1.109  knakahar 	return if_output_lock(sc->sc_eth_if, sc->sc_eth_if, m, &dst, NULL);
   1252    1.1    martin }
   1253    1.1    martin 
   1254    1.1    martin static int
   1255  1.153  yamaguch pppoe_parm_cpyinstr(struct pppoe_softc *sc,
   1256  1.153  yamaguch     char **dst, const void *src, size_t len)
   1257  1.153  yamaguch {
   1258  1.153  yamaguch 	int error = 0;
   1259  1.153  yamaguch 	char *next = NULL;
   1260  1.153  yamaguch 	size_t bufsiz, cpysiz, strsiz;
   1261  1.153  yamaguch 
   1262  1.153  yamaguch 	bufsiz = len + 1;
   1263  1.153  yamaguch 
   1264  1.153  yamaguch 	if (src == NULL)
   1265  1.153  yamaguch 		goto out;
   1266  1.153  yamaguch 
   1267  1.153  yamaguch 	bufsiz = len + 1;
   1268  1.153  yamaguch 	next = malloc(bufsiz, M_DEVBUF, M_WAITOK);
   1269  1.153  yamaguch 	if (next == NULL)
   1270  1.153  yamaguch 		return ENOMEM;
   1271  1.153  yamaguch 
   1272  1.153  yamaguch 	error = copyinstr(src, next, bufsiz, &cpysiz);
   1273  1.153  yamaguch 	if (error != 0)
   1274  1.153  yamaguch 		goto fail;
   1275  1.153  yamaguch 	if (cpysiz != bufsiz) {
   1276  1.153  yamaguch 		error = EINVAL;
   1277  1.153  yamaguch 		goto fail;
   1278  1.153  yamaguch 	}
   1279  1.153  yamaguch 
   1280  1.153  yamaguch 	strsiz = strnlen(next, bufsiz);
   1281  1.153  yamaguch 	if (strsiz == bufsiz) {
   1282  1.153  yamaguch 		error = EINVAL;
   1283  1.153  yamaguch 		goto fail;
   1284  1.153  yamaguch 	}
   1285  1.153  yamaguch 
   1286  1.153  yamaguch out:
   1287  1.153  yamaguch 	PPPOE_LOCK(sc, RW_WRITER);
   1288  1.153  yamaguch 	if (*dst != NULL)
   1289  1.153  yamaguch 		free(*dst, M_DEVBUF);
   1290  1.153  yamaguch 	*dst = next;
   1291  1.153  yamaguch 	next = NULL;
   1292  1.153  yamaguch 	PPPOE_UNLOCK(sc);
   1293  1.153  yamaguch fail:
   1294  1.153  yamaguch 	if (next != NULL)
   1295  1.153  yamaguch 		free(next, M_DEVBUF);
   1296  1.153  yamaguch 
   1297  1.153  yamaguch 	return error;
   1298  1.153  yamaguch }
   1299  1.153  yamaguch 
   1300  1.153  yamaguch static int
   1301   1.77  christos pppoe_ioctl(struct ifnet *ifp, unsigned long cmd, void *data)
   1302    1.1    martin {
   1303   1.70        ad 	struct lwp *l = curlwp;	/* XXX */
   1304    1.1    martin 	struct pppoe_softc *sc = (struct pppoe_softc*)ifp;
   1305   1.83    dyoung 	struct ifreq *ifr = data;
   1306    1.1    martin 	int error = 0;
   1307    1.1    martin 
   1308    1.1    martin 	switch (cmd) {
   1309    1.1    martin 	case PPPOESETPARMS:
   1310    1.1    martin 	{
   1311    1.1    martin 		struct pppoediscparms *parms = (struct pppoediscparms*)data;
   1312   1.74      elad 		if (kauth_authorize_network(l->l_cred, KAUTH_NETWORK_INTERFACE,
   1313   1.74      elad 		    KAUTH_REQ_NETWORK_INTERFACE_SETPRIV, ifp, (void *)cmd,
   1314   1.74      elad 		    NULL) != 0)
   1315  1.129   msaitoh 			return EPERM;
   1316    1.1    martin 		if (parms->eth_ifname[0] != 0) {
   1317  1.145      maxv 			struct ifnet *eth_if;
   1318   1.67      tron 
   1319  1.127  knakahar 			PPPOE_LOCK(sc, RW_WRITER);
   1320  1.167  yamaguch 			if (sc->sc_detaching) {
   1321  1.167  yamaguch 				PPPOE_UNLOCK(sc);
   1322  1.167  yamaguch 				return ENXIO;
   1323  1.167  yamaguch 			}
   1324   1.67      tron 			eth_if = ifunit(parms->eth_ifname);
   1325   1.67      tron 			if (eth_if == NULL || eth_if->if_dlt != DLT_EN10MB) {
   1326   1.66      tron 				sc->sc_eth_if = NULL;
   1327  1.127  knakahar 				PPPOE_UNLOCK(sc);
   1328    1.1    martin 				return ENXIO;
   1329   1.66      tron 			}
   1330   1.67      tron 
   1331   1.98       rjs 			if (sc->sc_sppp.pp_if.if_mtu !=
   1332   1.67      tron 			    eth_if->if_mtu - PPPOE_OVERHEAD) {
   1333   1.67      tron 				sc->sc_sppp.pp_if.if_mtu = eth_if->if_mtu -
   1334   1.67      tron 				    PPPOE_OVERHEAD;
   1335   1.67      tron 			}
   1336   1.67      tron 			sc->sc_eth_if = eth_if;
   1337  1.127  knakahar 			PPPOE_UNLOCK(sc);
   1338    1.1    martin 		}
   1339  1.120  knakahar 
   1340  1.153  yamaguch 		error = pppoe_parm_cpyinstr(sc, &sc->sc_concentrator_name,
   1341  1.153  yamaguch 		    parms->ac_name, parms->ac_name_len);
   1342  1.153  yamaguch 		if (error != 0)
   1343  1.153  yamaguch 			return error;
   1344  1.153  yamaguch 
   1345  1.153  yamaguch 		error = pppoe_parm_cpyinstr(sc, &sc->sc_service_name,
   1346  1.153  yamaguch 		    parms->service_name, parms->service_name_len);
   1347  1.153  yamaguch 		if (error != 0)
   1348  1.153  yamaguch 			return error;
   1349    1.1    martin 		return 0;
   1350    1.1    martin 	}
   1351    1.1    martin 	break;
   1352    1.1    martin 	case PPPOEGETPARMS:
   1353    1.1    martin 	{
   1354    1.1    martin 		struct pppoediscparms *parms = (struct pppoediscparms*)data;
   1355    1.1    martin 		memset(parms, 0, sizeof *parms);
   1356  1.127  knakahar 		PPPOE_LOCK(sc, RW_READER);
   1357    1.1    martin 		if (sc->sc_eth_if)
   1358  1.106  christos 			strlcpy(parms->ifname, sc->sc_eth_if->if_xname,
   1359  1.106  christos 			    sizeof(parms->ifname));
   1360  1.127  knakahar 		PPPOE_UNLOCK(sc);
   1361   1.15    martin 		return 0;
   1362   1.15    martin 	}
   1363   1.15    martin 	break;
   1364   1.15    martin 	case PPPOEGETSESSION:
   1365   1.15    martin 	{
   1366   1.15    martin 		struct pppoeconnectionstate *state = (struct pppoeconnectionstate*)data;
   1367  1.127  knakahar 		PPPOE_LOCK(sc, RW_READER);
   1368   1.15    martin 		state->state = sc->sc_state;
   1369   1.15    martin 		state->session_id = sc->sc_session;
   1370   1.15    martin 		state->padi_retry_no = sc->sc_padi_retried;
   1371   1.15    martin 		state->padr_retry_no = sc->sc_padr_retried;
   1372  1.127  knakahar 		PPPOE_UNLOCK(sc);
   1373    1.1    martin 		return 0;
   1374    1.1    martin 	}
   1375    1.1    martin 	break;
   1376   1.13    martin 	case SIOCSIFFLAGS:
   1377   1.13    martin 		/*
   1378   1.13    martin 		 * Prevent running re-establishment timers overriding
   1379   1.13    martin 		 * administrators choice.
   1380   1.13    martin 		 */
   1381  1.127  knakahar 		PPPOE_LOCK(sc, RW_WRITER);
   1382  1.167  yamaguch 		if (sc->sc_detaching) {
   1383  1.167  yamaguch 			PPPOE_UNLOCK(sc);
   1384  1.167  yamaguch 			return ENXIO;
   1385  1.167  yamaguch 		}
   1386  1.120  knakahar 
   1387   1.14    martin 		if ((ifr->ifr_flags & IFF_UP) == 0
   1388   1.14    martin 		     && sc->sc_state < PPPOE_STATE_SESSION) {
   1389   1.13    martin 			callout_stop(&sc->sc_timeout);
   1390   1.14    martin 			sc->sc_state = PPPOE_STATE_INITIAL;
   1391   1.13    martin 			sc->sc_padi_retried = 0;
   1392   1.13    martin 			sc->sc_padr_retried = 0;
   1393   1.28    itojun 			memcpy(&sc->sc_dest, etherbroadcastaddr,
   1394   1.28    itojun 			    sizeof(sc->sc_dest));
   1395   1.13    martin 		}
   1396  1.120  knakahar 
   1397  1.127  knakahar 		PPPOE_UNLOCK(sc);
   1398  1.120  knakahar 
   1399  1.120  knakahar 		error = sppp_ioctl(ifp, cmd, data);
   1400  1.120  knakahar 
   1401  1.120  knakahar 		return error;
   1402   1.19    martin 	case SIOCSIFMTU:
   1403   1.67      tron 		if (ifr->ifr_mtu > (sc->sc_eth_if == NULL ?
   1404   1.67      tron 		    PPPOE_MAXMTU : (sc->sc_eth_if->if_mtu - PPPOE_OVERHEAD))) {
   1405   1.19    martin 			return EINVAL;
   1406   1.67      tron 		}
   1407   1.83    dyoung 		/*FALLTHROUGH*/
   1408    1.1    martin 	default:
   1409    1.1    martin 		return sppp_ioctl(ifp, cmd, data);
   1410    1.1    martin 	}
   1411    1.1    martin 	return 0;
   1412    1.1    martin }
   1413    1.1    martin 
   1414    1.1    martin /*
   1415    1.1    martin  * Allocate a mbuf/cluster with space to store the given data length
   1416    1.1    martin  * of payload, leaving space for prepending an ethernet header
   1417   1.59     perry  * in front.
   1418    1.1    martin  */
   1419    1.1    martin static struct mbuf *
   1420    1.1    martin pppoe_get_mbuf(size_t len)
   1421    1.1    martin {
   1422    1.1    martin 	struct mbuf *m;
   1423    1.1    martin 
   1424    1.1    martin 	MGETHDR(m, M_DONTWAIT, MT_DATA);
   1425    1.1    martin 	if (m == NULL)
   1426    1.1    martin 		return NULL;
   1427   1.26    itojun 	if (len + sizeof(struct ether_header) > MHLEN) {
   1428    1.1    martin 		MCLGET(m, M_DONTWAIT);
   1429    1.1    martin 		if ((m->m_flags & M_EXT) == 0) {
   1430  1.101    martin 			m_free(m);
   1431  1.101    martin 			return NULL;
   1432    1.1    martin 		}
   1433    1.1    martin 	}
   1434    1.1    martin 	m->m_data += sizeof(struct ether_header);
   1435    1.1    martin 	m->m_len = len;
   1436    1.1    martin 	m->m_pkthdr.len = len;
   1437  1.107     ozaki 	m_reset_rcvif(m);
   1438    1.1    martin 
   1439    1.1    martin 	return m;
   1440    1.1    martin }
   1441    1.1    martin 
   1442    1.1    martin static int
   1443    1.1    martin pppoe_send_padi(struct pppoe_softc *sc)
   1444    1.1    martin {
   1445    1.1    martin 	struct mbuf *m0;
   1446  1.142      maxv 	int len, l1 = 0, l2 = 0;
   1447   1.84      matt 	uint8_t *p;
   1448    1.1    martin 
   1449  1.142      maxv 	if (sc->sc_state > PPPOE_STATE_PADI_SENT)
   1450    1.1    martin 		panic("pppoe_send_padi in state %d", sc->sc_state);
   1451    1.1    martin 
   1452  1.142      maxv 	/* Compute packet length. */
   1453  1.142      maxv 	len = sizeof(struct pppoetag);
   1454    1.1    martin 	if (sc->sc_service_name != NULL) {
   1455    1.1    martin 		l1 = strlen(sc->sc_service_name);
   1456    1.1    martin 		len += l1;
   1457    1.1    martin 	}
   1458    1.1    martin 	if (sc->sc_concentrator_name != NULL) {
   1459    1.1    martin 		l2 = strlen(sc->sc_concentrator_name);
   1460  1.142      maxv 		len += sizeof(struct pppoetag) + l2;
   1461    1.1    martin 	}
   1462  1.143      maxv 	len += sizeof(struct pppoetag) + sizeof(sc->sc_id);
   1463   1.98       rjs 	if (sc->sc_sppp.pp_if.if_mtu > PPPOE_MAXMTU) {
   1464  1.142      maxv 		len += sizeof(struct pppoetag) + 2;
   1465   1.98       rjs 	}
   1466    1.1    martin 
   1467  1.142      maxv 	/* Allocate packet. */
   1468  1.142      maxv 	m0 = pppoe_get_mbuf(len + PPPOE_HEADERLEN);
   1469  1.142      maxv 	if (m0 == NULL)
   1470   1.26    itojun 		return ENOBUFS;
   1471    1.1    martin 
   1472  1.142      maxv 	/* Fill in packet. */
   1473   1.84      matt 	p = mtod(m0, uint8_t *);
   1474    1.1    martin 	PPPOE_ADD_HEADER(p, PPPOE_CODE_PADI, 0, len);
   1475    1.1    martin 	PPPOE_ADD_16(p, PPPOE_TAG_SNAME);
   1476    1.1    martin 	if (sc->sc_service_name != NULL) {
   1477    1.1    martin 		PPPOE_ADD_16(p, l1);
   1478    1.1    martin 		memcpy(p, sc->sc_service_name, l1);
   1479    1.1    martin 		p += l1;
   1480    1.1    martin 	} else {
   1481    1.1    martin 		PPPOE_ADD_16(p, 0);
   1482    1.1    martin 	}
   1483    1.1    martin 	if (sc->sc_concentrator_name != NULL) {
   1484    1.1    martin 		PPPOE_ADD_16(p, PPPOE_TAG_ACNAME);
   1485    1.1    martin 		PPPOE_ADD_16(p, l2);
   1486    1.1    martin 		memcpy(p, sc->sc_concentrator_name, l2);
   1487    1.1    martin 		p += l2;
   1488    1.1    martin 	}
   1489    1.1    martin 	PPPOE_ADD_16(p, PPPOE_TAG_HUNIQUE);
   1490  1.143      maxv 	PPPOE_ADD_16(p, sizeof(sc->sc_id));
   1491  1.143      maxv 	memcpy(p, &sc->sc_id, sizeof(sc->sc_id));
   1492  1.143      maxv 	p += sizeof(sc->sc_id);
   1493   1.98       rjs 
   1494   1.98       rjs 	if (sc->sc_sppp.pp_if.if_mtu > PPPOE_MAXMTU) {
   1495   1.98       rjs 		PPPOE_ADD_16(p, PPPOE_TAG_MAX_PAYLOAD);
   1496   1.98       rjs 		PPPOE_ADD_16(p, 2);
   1497   1.98       rjs 		PPPOE_ADD_16(p, (uint16_t)sc->sc_sppp.pp_if.if_mtu);
   1498   1.98       rjs 	}
   1499    1.1    martin 
   1500    1.1    martin #ifdef PPPOE_DEBUG
   1501   1.84      matt 	if (p - mtod(m0, uint8_t *) != len + PPPOE_HEADERLEN)
   1502    1.1    martin 		panic("pppoe_send_padi: garbled output len, should be %ld, is %ld",
   1503   1.84      matt 		    (long)(len + PPPOE_HEADERLEN), (long)(p - mtod(m0, uint8_t *)));
   1504    1.1    martin #endif
   1505    1.1    martin 
   1506  1.142      maxv 	/* Send packet. */
   1507    1.1    martin 	return pppoe_output(sc, m0);
   1508    1.1    martin }
   1509    1.1    martin 
   1510    1.1    martin static void
   1511  1.151  yamaguch pppoe_timeout_co(void *arg)
   1512  1.151  yamaguch {
   1513  1.151  yamaguch 	struct pppoe_softc *sc = (struct pppoe_softc *)arg;
   1514  1.151  yamaguch 
   1515  1.151  yamaguch 	if (atomic_swap_uint(&sc->sc_timeout_scheduled, 1) != 0)
   1516  1.151  yamaguch 		return;
   1517  1.151  yamaguch 
   1518  1.151  yamaguch 	workqueue_enqueue(sc->sc_timeout_wq, &sc->sc_timeout_wk, NULL);
   1519  1.151  yamaguch }
   1520  1.151  yamaguch 
   1521  1.151  yamaguch static void
   1522  1.151  yamaguch pppoe_timeout_co_halt(void *unused __unused)
   1523  1.151  yamaguch {
   1524  1.151  yamaguch 
   1525  1.151  yamaguch 	/* do nothing to halt callout safely */
   1526  1.151  yamaguch }
   1527  1.151  yamaguch 
   1528  1.151  yamaguch static void
   1529  1.151  yamaguch pppoe_timeout_wk(struct work *wk __unused, void *arg)
   1530  1.151  yamaguch {
   1531  1.151  yamaguch 	struct pppoe_softc *sc = (struct pppoe_softc *)arg;
   1532  1.151  yamaguch 
   1533  1.151  yamaguch 	atomic_swap_uint(&sc->sc_timeout_scheduled, 0);
   1534  1.151  yamaguch 	pppoe_timeout(sc);
   1535  1.151  yamaguch }
   1536  1.151  yamaguch 
   1537  1.151  yamaguch static void
   1538  1.151  yamaguch pppoe_timeout(struct pppoe_softc *sc)
   1539    1.1    martin {
   1540  1.120  knakahar 	int retry_wait, err;
   1541  1.120  knakahar 	DECLARE_SPLNET_VARIABLE;
   1542    1.1    martin 
   1543  1.157  yamaguch 	pppoe_printf(sc, "timeout\n");
   1544    1.1    martin 
   1545  1.127  knakahar 	PPPOE_LOCK(sc, RW_WRITER);
   1546    1.1    martin 	switch (sc->sc_state) {
   1547   1.90    martin 	case PPPOE_STATE_INITIAL:
   1548   1.90    martin 		/* delayed connect from pppoe_tls() */
   1549  1.167  yamaguch 		if (!sc->sc_detaching)
   1550  1.167  yamaguch 			pppoe_connect(sc);
   1551   1.90    martin 		break;
   1552    1.1    martin 	case PPPOE_STATE_PADI_SENT:
   1553   1.13    martin 		/*
   1554   1.13    martin 		 * We have two basic ways of retrying:
   1555   1.13    martin 		 *  - Quick retry mode: try a few times in short sequence
   1556   1.13    martin 		 *  - Slow retry mode: we already had a connection successfully
   1557   1.13    martin 		 *    established and will try infinitely (without user
   1558   1.13    martin 		 *    intervention)
   1559   1.13    martin 		 * We only enter slow retry mode if IFF_LINK1 (aka autodial)
   1560   1.35    martin 		 * is not set.
   1561   1.13    martin 		 */
   1562   1.13    martin 
   1563   1.13    martin 		/* initialize for quick retry mode */
   1564   1.30    itojun 		retry_wait = PPPOE_DISC_TIMEOUT * (1 + sc->sc_padi_retried);
   1565   1.13    martin 
   1566  1.120  knakahar 		ACQUIRE_SPLNET();
   1567    1.1    martin 		sc->sc_padi_retried++;
   1568    1.1    martin 		if (sc->sc_padi_retried >= PPPOE_DISC_MAXPADI) {
   1569   1.35    martin 			if ((sc->sc_sppp.pp_if.if_flags & IFF_LINK1) == 0) {
   1570   1.28    itojun 				/* slow retry mode */
   1571   1.28    itojun 				retry_wait = PPPOE_SLOW_RETRY;
   1572   1.13    martin 			} else {
   1573   1.28    itojun 				pppoe_abort_connect(sc);
   1574  1.121  knakahar 				RELEASE_SPLNET();
   1575  1.127  knakahar 				PPPOE_UNLOCK(sc);
   1576   1.28    itojun 				return;
   1577   1.13    martin 			}
   1578    1.1    martin 		}
   1579   1.45    martin 		if ((err = pppoe_send_padi(sc)) != 0) {
   1580   1.45    martin 			sc->sc_padi_retried--;
   1581  1.157  yamaguch 			pppoe_printf(sc,
   1582  1.157  yamaguch 			    "failed to transmit PADI, error=%d\n", err);
   1583   1.45    martin 		}
   1584  1.150  yamaguch 		callout_schedule(&sc->sc_timeout,retry_wait);
   1585  1.120  knakahar 		RELEASE_SPLNET();
   1586    1.1    martin 		break;
   1587    1.1    martin 
   1588    1.1    martin 	case PPPOE_STATE_PADR_SENT:
   1589  1.120  knakahar 		ACQUIRE_SPLNET();
   1590    1.1    martin 		sc->sc_padr_retried++;
   1591    1.1    martin 		if (sc->sc_padr_retried >= PPPOE_DISC_MAXPADR) {
   1592   1.28    itojun 			memcpy(&sc->sc_dest, etherbroadcastaddr,
   1593   1.28    itojun 			    sizeof(sc->sc_dest));
   1594    1.1    martin 			sc->sc_state = PPPOE_STATE_PADI_SENT;
   1595  1.161  yamaguch 			sc->sc_padi_retried = 0;
   1596    1.1    martin 			sc->sc_padr_retried = 0;
   1597   1.45    martin 			if ((err = pppoe_send_padi(sc)) != 0) {
   1598  1.157  yamaguch 				pppoe_printf(sc,
   1599  1.157  yamaguch 				    "failed to send PADI, error=%d\n", err);
   1600   1.45    martin 			}
   1601  1.150  yamaguch 			callout_schedule(&sc->sc_timeout,
   1602  1.150  yamaguch 			    PPPOE_DISC_TIMEOUT * (1 + sc->sc_padi_retried));
   1603  1.120  knakahar 			RELEASE_SPLNET();
   1604  1.127  knakahar 			PPPOE_UNLOCK(sc);
   1605    1.1    martin 			return;
   1606    1.1    martin 		}
   1607   1.45    martin 		if ((err = pppoe_send_padr(sc)) != 0) {
   1608   1.45    martin 			sc->sc_padr_retried--;
   1609  1.157  yamaguch 			pppoe_printf(sc,"failed to send PADR, error=%d", err);
   1610   1.45    martin 		}
   1611  1.150  yamaguch 		callout_schedule(&sc->sc_timeout,
   1612  1.150  yamaguch 		    PPPOE_DISC_TIMEOUT * (1 + sc->sc_padr_retried));
   1613  1.120  knakahar 		RELEASE_SPLNET();
   1614    1.1    martin 		break;
   1615    1.1    martin 	case PPPOE_STATE_CLOSING:
   1616    1.1    martin 		pppoe_disconnect(sc);
   1617    1.1    martin 		break;
   1618    1.1    martin 	default:
   1619  1.127  knakahar 		PPPOE_UNLOCK(sc);
   1620    1.1    martin 		return;	/* all done, work in peace */
   1621    1.1    martin 	}
   1622  1.127  knakahar 	PPPOE_UNLOCK(sc);
   1623    1.1    martin }
   1624    1.1    martin 
   1625    1.1    martin /* Start a connection (i.e. initiate discovery phase) */
   1626    1.1    martin static int
   1627    1.1    martin pppoe_connect(struct pppoe_softc *sc)
   1628    1.1    martin {
   1629  1.120  knakahar 	int err;
   1630  1.120  knakahar 	DECLARE_SPLNET_VARIABLE;
   1631  1.120  knakahar 
   1632  1.127  knakahar 	KASSERT(PPPOE_WLOCKED(sc));
   1633    1.1    martin 
   1634    1.1    martin 	if (sc->sc_state != PPPOE_STATE_INITIAL)
   1635    1.1    martin 		return EBUSY;
   1636    1.1    martin 
   1637   1.43       oki #ifdef PPPOE_SERVER
   1638   1.43       oki 	/* wait PADI if IFF_PASSIVE */
   1639   1.43       oki 	if ((sc->sc_sppp.pp_if.if_flags & IFF_PASSIVE))
   1640   1.43       oki 		return 0;
   1641   1.43       oki #endif
   1642  1.120  knakahar 	ACQUIRE_SPLNET();
   1643   1.36    martin 	/* save state, in case we fail to send PADI */
   1644    1.1    martin 	sc->sc_state = PPPOE_STATE_PADI_SENT;
   1645  1.161  yamaguch 	sc->sc_padi_retried = 0;
   1646    1.1    martin 	sc->sc_padr_retried = 0;
   1647    1.1    martin 	err = pppoe_send_padi(sc);
   1648  1.157  yamaguch 	if (err != 0)
   1649  1.157  yamaguch 		pppoe_printf(sc, "failed to send PADI, error=%d\n", err);
   1650  1.150  yamaguch 	callout_schedule(&sc->sc_timeout, PPPOE_DISC_TIMEOUT);
   1651  1.120  knakahar 	RELEASE_SPLNET();
   1652    1.1    martin 	return err;
   1653    1.1    martin }
   1654    1.1    martin 
   1655    1.1    martin /* disconnect */
   1656    1.1    martin static int
   1657    1.1    martin pppoe_disconnect(struct pppoe_softc *sc)
   1658    1.1    martin {
   1659  1.120  knakahar 	int err;
   1660  1.120  knakahar 	DECLARE_SPLNET_VARIABLE;
   1661  1.120  knakahar 
   1662  1.127  knakahar 	KASSERT(PPPOE_WLOCKED(sc));
   1663    1.1    martin 
   1664  1.120  knakahar 	ACQUIRE_SPLNET();
   1665    1.1    martin 
   1666    1.1    martin 	if (sc->sc_state < PPPOE_STATE_SESSION)
   1667    1.1    martin 		err = EBUSY;
   1668    1.1    martin 	else {
   1669  1.157  yamaguch 		pppoe_printf(sc, "disconnecting\n");
   1670  1.129   msaitoh 		err = pppoe_send_padt(sc->sc_eth_if, sc->sc_session,
   1671  1.129   msaitoh 		    (const uint8_t *)&sc->sc_dest);
   1672    1.1    martin 	}
   1673    1.1    martin 
   1674    1.1    martin 	/* cleanup softc */
   1675    1.1    martin 	sc->sc_state = PPPOE_STATE_INITIAL;
   1676  1.120  knakahar 
   1677    1.1    martin 	memcpy(&sc->sc_dest, etherbroadcastaddr, sizeof(sc->sc_dest));
   1678    1.1    martin 	if (sc->sc_ac_cookie) {
   1679   1.32      yamt 		free(sc->sc_ac_cookie, M_DEVBUF);
   1680    1.1    martin 		sc->sc_ac_cookie = NULL;
   1681    1.1    martin 	}
   1682    1.1    martin 	sc->sc_ac_cookie_len = 0;
   1683   1.94  christos 	if (sc->sc_relay_sid) {
   1684   1.94  christos 		free(sc->sc_relay_sid, M_DEVBUF);
   1685   1.94  christos 		sc->sc_relay_sid = NULL;
   1686   1.94  christos 	}
   1687   1.94  christos 	sc->sc_relay_sid_len = 0;
   1688   1.43       oki #ifdef PPPOE_SERVER
   1689   1.43       oki 	if (sc->sc_hunique) {
   1690   1.43       oki 		free(sc->sc_hunique, M_DEVBUF);
   1691   1.43       oki 		sc->sc_hunique = NULL;
   1692   1.43       oki 	}
   1693   1.43       oki 	sc->sc_hunique_len = 0;
   1694   1.43       oki #endif
   1695    1.1    martin 	sc->sc_session = 0;
   1696    1.1    martin 
   1697  1.127  knakahar 	PPPOE_UNLOCK(sc);
   1698  1.120  knakahar 
   1699    1.1    martin 	/* notify upper layer */
   1700    1.1    martin 	sc->sc_sppp.pp_down(&sc->sc_sppp);
   1701    1.1    martin 
   1702  1.127  knakahar 	PPPOE_LOCK(sc, RW_WRITER);
   1703    1.1    martin 
   1704  1.120  knakahar 	RELEASE_SPLNET();
   1705    1.1    martin 	return err;
   1706    1.1    martin }
   1707    1.1    martin 
   1708    1.1    martin /* Connection attempt aborted */
   1709    1.1    martin static void
   1710    1.1    martin pppoe_abort_connect(struct pppoe_softc *sc)
   1711    1.1    martin {
   1712  1.127  knakahar 	KASSERT(PPPOE_WLOCKED(sc));
   1713  1.120  knakahar 
   1714  1.157  yamaguch 	pppoe_printf(sc, "could not establish connection\n");
   1715   1.36    martin 	sc->sc_state = PPPOE_STATE_CLOSING;
   1716  1.120  knakahar 
   1717  1.127  knakahar 	PPPOE_UNLOCK(sc);
   1718    1.1    martin 
   1719    1.1    martin 	/* notify upper layer */
   1720    1.1    martin 	sc->sc_sppp.pp_down(&sc->sc_sppp);
   1721  1.120  knakahar 
   1722  1.127  knakahar 	PPPOE_LOCK(sc, RW_WRITER);
   1723   1.36    martin 
   1724   1.36    martin 	/* clear connection state */
   1725   1.36    martin 	memcpy(&sc->sc_dest, etherbroadcastaddr, sizeof(sc->sc_dest));
   1726   1.36    martin 	sc->sc_state = PPPOE_STATE_INITIAL;
   1727    1.1    martin }
   1728    1.1    martin 
   1729    1.1    martin static int
   1730    1.1    martin pppoe_send_padr(struct pppoe_softc *sc)
   1731    1.1    martin {
   1732    1.1    martin 	struct mbuf *m0;
   1733   1.84      matt 	uint8_t *p;
   1734  1.142      maxv 	size_t len, l1 = 0;
   1735    1.1    martin 
   1736    1.1    martin 	if (sc->sc_state != PPPOE_STATE_PADR_SENT)
   1737    1.1    martin 		return EIO;
   1738    1.1    martin 
   1739  1.142      maxv 	/* Compute packet length. */
   1740  1.142      maxv 	len = sizeof(struct pppoetag);
   1741  1.142      maxv 	if (sc->sc_service_name != NULL) {
   1742    1.1    martin 		l1 = strlen(sc->sc_service_name);
   1743    1.1    martin 		len += l1;
   1744    1.1    martin 	}
   1745  1.142      maxv 	if (sc->sc_ac_cookie_len > 0) {
   1746  1.142      maxv 		len += sizeof(struct pppoetag) + sc->sc_ac_cookie_len;
   1747  1.142      maxv 	}
   1748  1.142      maxv 	if (sc->sc_relay_sid_len > 0) {
   1749  1.142      maxv 		len += sizeof(struct pppoetag) + sc->sc_relay_sid_len;
   1750  1.142      maxv 	}
   1751  1.143      maxv 	len += sizeof(struct pppoetag) + sizeof(sc->sc_id);
   1752   1.98       rjs 	if (sc->sc_sppp.pp_if.if_mtu > PPPOE_MAXMTU) {
   1753  1.142      maxv 		len += sizeof(struct pppoetag) + 2;
   1754   1.98       rjs 	}
   1755  1.142      maxv 
   1756  1.142      maxv 	/* Allocate packet. */
   1757   1.26    itojun 	m0 = pppoe_get_mbuf(len + PPPOE_HEADERLEN);
   1758  1.142      maxv 	if (m0 == NULL)
   1759   1.26    itojun 		return ENOBUFS;
   1760  1.142      maxv 
   1761  1.142      maxv 	/* Fill in packet. */
   1762   1.84      matt 	p = mtod(m0, uint8_t *);
   1763    1.1    martin 	PPPOE_ADD_HEADER(p, PPPOE_CODE_PADR, 0, len);
   1764    1.1    martin 	PPPOE_ADD_16(p, PPPOE_TAG_SNAME);
   1765    1.1    martin 	if (sc->sc_service_name != NULL) {
   1766    1.1    martin 		PPPOE_ADD_16(p, l1);
   1767    1.1    martin 		memcpy(p, sc->sc_service_name, l1);
   1768    1.1    martin 		p += l1;
   1769    1.1    martin 	} else {
   1770    1.1    martin 		PPPOE_ADD_16(p, 0);
   1771    1.1    martin 	}
   1772    1.1    martin 	if (sc->sc_ac_cookie_len > 0) {
   1773    1.1    martin 		PPPOE_ADD_16(p, PPPOE_TAG_ACCOOKIE);
   1774    1.1    martin 		PPPOE_ADD_16(p, sc->sc_ac_cookie_len);
   1775    1.1    martin 		memcpy(p, sc->sc_ac_cookie, sc->sc_ac_cookie_len);
   1776    1.1    martin 		p += sc->sc_ac_cookie_len;
   1777    1.1    martin 	}
   1778   1.94  christos 	if (sc->sc_relay_sid_len > 0) {
   1779   1.94  christos 		PPPOE_ADD_16(p, PPPOE_TAG_RELAYSID);
   1780   1.94  christos 		PPPOE_ADD_16(p, sc->sc_relay_sid_len);
   1781   1.94  christos 		memcpy(p, sc->sc_relay_sid, sc->sc_relay_sid_len);
   1782   1.94  christos 		p += sc->sc_relay_sid_len;
   1783   1.94  christos 	}
   1784    1.1    martin 	PPPOE_ADD_16(p, PPPOE_TAG_HUNIQUE);
   1785  1.143      maxv 	PPPOE_ADD_16(p, sizeof(sc->sc_id));
   1786  1.143      maxv 	memcpy(p, &sc->sc_id, sizeof(sc->sc_id));
   1787  1.143      maxv 	p += sizeof(sc->sc_id);
   1788   1.98       rjs 
   1789   1.98       rjs 	if (sc->sc_sppp.pp_if.if_mtu > PPPOE_MAXMTU) {
   1790   1.98       rjs 		PPPOE_ADD_16(p, PPPOE_TAG_MAX_PAYLOAD);
   1791   1.98       rjs 		PPPOE_ADD_16(p, 2);
   1792   1.98       rjs 		PPPOE_ADD_16(p, (uint16_t)sc->sc_sppp.pp_if.if_mtu);
   1793   1.98       rjs 	}
   1794    1.1    martin 
   1795    1.1    martin #ifdef PPPOE_DEBUG
   1796   1.84      matt 	if (p - mtod(m0, uint8_t *) != len + PPPOE_HEADERLEN)
   1797    1.1    martin 		panic("pppoe_send_padr: garbled output len, should be %ld, is %ld",
   1798   1.84      matt 			(long)(len + PPPOE_HEADERLEN), (long)(p - mtod(m0, uint8_t *)));
   1799    1.1    martin #endif
   1800    1.1    martin 
   1801  1.142      maxv 	/* Send packet. */
   1802    1.1    martin 	return pppoe_output(sc, m0);
   1803    1.1    martin }
   1804    1.1    martin 
   1805    1.1    martin /* send a PADT packet */
   1806    1.1    martin static int
   1807   1.84      matt pppoe_send_padt(struct ifnet *outgoing_if, u_int session, const uint8_t *dest)
   1808    1.1    martin {
   1809   1.39    martin 	struct ether_header *eh;
   1810   1.39    martin 	struct sockaddr dst;
   1811    1.1    martin 	struct mbuf *m0;
   1812   1.84      matt 	uint8_t *p;
   1813    1.1    martin 
   1814    1.1    martin 	m0 = pppoe_get_mbuf(PPPOE_HEADERLEN);
   1815   1.26    itojun 	if (!m0)
   1816   1.39    martin 		return EIO;
   1817   1.84      matt 	p = mtod(m0, uint8_t *);
   1818   1.39    martin 	PPPOE_ADD_HEADER(p, PPPOE_CODE_PADT, session, 0);
   1819   1.39    martin 
   1820   1.39    martin 	memset(&dst, 0, sizeof dst);
   1821   1.39    martin 	dst.sa_family = AF_UNSPEC;
   1822   1.39    martin 	eh = (struct ether_header*)&dst.sa_data;
   1823   1.39    martin 	eh->ether_type = htons(ETHERTYPE_PPPOEDISC);
   1824   1.39    martin 	memcpy(&eh->ether_dhost, dest, ETHER_ADDR_LEN);
   1825   1.39    martin 
   1826   1.39    martin 	m0->m_flags &= ~(M_BCAST|M_MCAST);
   1827  1.109  knakahar 	return if_output_lock(outgoing_if, outgoing_if, m0, &dst, NULL);
   1828    1.1    martin }
   1829   1.43       oki 
   1830   1.43       oki #ifdef PPPOE_SERVER
   1831   1.43       oki static int
   1832   1.43       oki pppoe_send_pado(struct pppoe_softc *sc)
   1833   1.43       oki {
   1834   1.43       oki 	struct mbuf *m0;
   1835   1.84      matt 	uint8_t *p;
   1836   1.43       oki 	size_t len;
   1837   1.43       oki 
   1838   1.43       oki 	if (sc->sc_state != PPPOE_STATE_PADO_SENT)
   1839   1.43       oki 		return EIO;
   1840   1.43       oki 
   1841  1.144      maxv 	/* Include AC cookie. */
   1842  1.144      maxv 	len = sizeof(struct pppoetag) + sizeof(sc->sc_id);
   1843  1.144      maxv 	/* Include hunique. */
   1844  1.144      maxv 	len += sizeof(struct pppoetag) + sc->sc_hunique_len;
   1845  1.144      maxv 
   1846   1.43       oki 	m0 = pppoe_get_mbuf(len + PPPOE_HEADERLEN);
   1847   1.43       oki 	if (!m0)
   1848   1.43       oki 		return EIO;
   1849   1.84      matt 	p = mtod(m0, uint8_t *);
   1850  1.144      maxv 
   1851   1.43       oki 	PPPOE_ADD_HEADER(p, PPPOE_CODE_PADO, 0, len);
   1852   1.43       oki 	PPPOE_ADD_16(p, PPPOE_TAG_ACCOOKIE);
   1853  1.143      maxv 	PPPOE_ADD_16(p, sizeof(sc->sc_id));
   1854  1.143      maxv 	memcpy(p, &sc->sc_id, sizeof(sc->sc_id));
   1855  1.143      maxv 	p += sizeof(sc->sc_id);
   1856   1.43       oki 	PPPOE_ADD_16(p, PPPOE_TAG_HUNIQUE);
   1857   1.43       oki 	PPPOE_ADD_16(p, sc->sc_hunique_len);
   1858   1.43       oki 	memcpy(p, sc->sc_hunique, sc->sc_hunique_len);
   1859   1.43       oki 	return pppoe_output(sc, m0);
   1860   1.43       oki }
   1861   1.43       oki 
   1862   1.43       oki static int
   1863   1.43       oki pppoe_send_pads(struct pppoe_softc *sc)
   1864   1.43       oki {
   1865   1.69    kardel 	struct bintime bt;
   1866   1.43       oki 	struct mbuf *m0;
   1867   1.84      matt 	uint8_t *p;
   1868   1.61    martin 	size_t len, l1 = 0;	/* XXX: gcc */
   1869   1.43       oki 
   1870  1.127  knakahar 	KASSERT(PPPOE_WLOCKED(sc));
   1871  1.120  knakahar 
   1872   1.43       oki 	if (sc->sc_state != PPPOE_STATE_PADO_SENT)
   1873   1.43       oki 		return EIO;
   1874   1.43       oki 
   1875   1.69    kardel 	getbinuptime(&bt);
   1876   1.69    kardel 	sc->sc_session = bt.sec % 0xff + 1;
   1877  1.144      maxv 
   1878  1.144      maxv 	/* Include service name. */
   1879  1.144      maxv 	len = sizeof(struct pppoetag);
   1880  1.144      maxv 	if (sc->sc_service_name != NULL) {
   1881   1.43       oki 		l1 = strlen(sc->sc_service_name);
   1882   1.43       oki 		len += l1;
   1883   1.43       oki 	}
   1884  1.144      maxv 	/* Include hunique. */
   1885  1.144      maxv 	len += sizeof(struct pppoetag) + sc->sc_hunique_len;
   1886  1.144      maxv 
   1887   1.43       oki 	m0 = pppoe_get_mbuf(len + PPPOE_HEADERLEN);
   1888   1.43       oki 	if (!m0)
   1889   1.43       oki 		return ENOBUFS;
   1890   1.84      matt 	p = mtod(m0, uint8_t *);
   1891  1.144      maxv 
   1892   1.43       oki 	PPPOE_ADD_HEADER(p, PPPOE_CODE_PADS, sc->sc_session, len);
   1893   1.43       oki 	PPPOE_ADD_16(p, PPPOE_TAG_SNAME);
   1894   1.43       oki 	if (sc->sc_service_name != NULL) {
   1895   1.43       oki 		PPPOE_ADD_16(p, l1);
   1896   1.43       oki 		memcpy(p, sc->sc_service_name, l1);
   1897   1.43       oki 		p += l1;
   1898   1.43       oki 	} else {
   1899   1.43       oki 		PPPOE_ADD_16(p, 0);
   1900   1.43       oki 	}
   1901   1.43       oki 	PPPOE_ADD_16(p, PPPOE_TAG_HUNIQUE);
   1902   1.43       oki 	PPPOE_ADD_16(p, sc->sc_hunique_len);
   1903   1.43       oki 	memcpy(p, sc->sc_hunique, sc->sc_hunique_len);
   1904   1.43       oki 	return pppoe_output(sc, m0);
   1905   1.43       oki }
   1906   1.43       oki #endif
   1907    1.1    martin 
   1908    1.1    martin static void
   1909    1.1    martin pppoe_tls(struct sppp *sp)
   1910    1.1    martin {
   1911   1.26    itojun 	struct pppoe_softc *sc = (void *)sp;
   1912   1.90    martin 	int wtime;
   1913   1.90    martin 
   1914  1.127  knakahar 	PPPOE_LOCK(sc, RW_READER);
   1915  1.120  knakahar 
   1916  1.120  knakahar 	if (sc->sc_state != PPPOE_STATE_INITIAL) {
   1917  1.127  knakahar 		PPPOE_UNLOCK(sc);
   1918    1.1    martin 		return;
   1919  1.120  knakahar 	}
   1920  1.120  knakahar 
   1921   1.90    martin 	if (sc->sc_sppp.pp_phase == SPPP_PHASE_ESTABLISH &&
   1922   1.90    martin 	    sc->sc_sppp.pp_auth_failures > 0) {
   1923   1.90    martin 		/*
   1924   1.90    martin 		 * Delay trying to reconnect a bit more - the peer
   1925  1.102       snj 		 * might have failed to contact its radius server.
   1926   1.90    martin 		 */
   1927   1.92    martin 		wtime = PPPOE_RECON_FAST * sc->sc_sppp.pp_auth_failures;
   1928   1.92    martin 		if (wtime > PPPOE_SLOW_RETRY)
   1929   1.92    martin 			wtime = PPPOE_SLOW_RETRY;
   1930   1.90    martin 	} else {
   1931   1.92    martin 		wtime = PPPOE_RECON_IMMEDIATE;
   1932   1.90    martin 	}
   1933  1.150  yamaguch 	callout_schedule(&sc->sc_timeout, wtime);
   1934  1.120  knakahar 
   1935  1.127  knakahar 	PPPOE_UNLOCK(sc);
   1936    1.1    martin }
   1937    1.1    martin 
   1938    1.1    martin static void
   1939    1.1    martin pppoe_tlf(struct sppp *sp)
   1940    1.1    martin {
   1941   1.26    itojun 	struct pppoe_softc *sc = (void *)sp;
   1942  1.120  knakahar 
   1943  1.127  knakahar 	PPPOE_LOCK(sc, RW_WRITER);
   1944  1.120  knakahar 
   1945  1.120  knakahar 	if (sc->sc_state < PPPOE_STATE_SESSION) {
   1946  1.154  yamaguch 		callout_stop(&sc->sc_timeout);
   1947  1.154  yamaguch 		sc->sc_state = PPPOE_STATE_INITIAL;
   1948  1.154  yamaguch 		sc->sc_padi_retried = 0;
   1949  1.154  yamaguch 		sc->sc_padr_retried = 0;
   1950  1.154  yamaguch 		memcpy(&sc->sc_dest, etherbroadcastaddr,
   1951  1.154  yamaguch 		    sizeof(sc->sc_dest));
   1952  1.127  knakahar 		PPPOE_UNLOCK(sc);
   1953    1.1    martin 		return;
   1954  1.120  knakahar 	}
   1955  1.154  yamaguch 
   1956    1.1    martin 	/*
   1957    1.1    martin 	 * Do not call pppoe_disconnect here, the upper layer state
   1958    1.1    martin 	 * machine gets confused by this. We must return from this
   1959    1.1    martin 	 * function and defer disconnecting to the timeout handler.
   1960    1.1    martin 	 */
   1961    1.1    martin 	sc->sc_state = PPPOE_STATE_CLOSING;
   1962  1.120  knakahar 
   1963  1.150  yamaguch 	callout_schedule(&sc->sc_timeout, hz/50);
   1964  1.120  knakahar 
   1965  1.127  knakahar 	PPPOE_UNLOCK(sc);
   1966    1.1    martin }
   1967    1.1    martin 
   1968    1.1    martin static void
   1969    1.1    martin pppoe_start(struct ifnet *ifp)
   1970    1.1    martin {
   1971   1.26    itojun 	struct pppoe_softc *sc = (void *)ifp;
   1972    1.1    martin 	struct mbuf *m;
   1973   1.84      matt 	uint8_t *p;
   1974    1.1    martin 	size_t len;
   1975    1.1    martin 
   1976    1.1    martin 	if (sppp_isempty(ifp))
   1977    1.1    martin 		return;
   1978    1.1    martin 
   1979   1.48       wiz 	/* are we ready to process data yet? */
   1980  1.127  knakahar 	PPPOE_LOCK(sc, RW_READER);
   1981    1.1    martin 	if (sc->sc_state < PPPOE_STATE_SESSION) {
   1982    1.1    martin 		sppp_flush(&sc->sc_sppp.pp_if);
   1983  1.127  knakahar 		PPPOE_UNLOCK(sc);
   1984    1.1    martin 		return;
   1985    1.1    martin 	}
   1986    1.1    martin 
   1987    1.1    martin 	while ((m = sppp_dequeue(ifp)) != NULL) {
   1988    1.1    martin 		len = m->m_pkthdr.len;
   1989    1.1    martin 		M_PREPEND(m, PPPOE_HEADERLEN, M_DONTWAIT);
   1990    1.1    martin 		if (m == NULL) {
   1991  1.148   thorpej 			if_statinc(ifp, if_oerrors);
   1992   1.37    martin 			continue;
   1993    1.1    martin 		}
   1994   1.84      matt 		p = mtod(m, uint8_t *);
   1995    1.1    martin 		PPPOE_ADD_HEADER(p, 0, sc->sc_session, len);
   1996    1.1    martin 
   1997  1.141   msaitoh 		bpf_mtap(&sc->sc_sppp.pp_if, m, BPF_D_OUT);
   1998    1.1    martin 
   1999    1.1    martin 		pppoe_output(sc, m);
   2000    1.1    martin 	}
   2001  1.127  knakahar 	PPPOE_UNLOCK(sc);
   2002    1.1    martin }
   2003   1.54    martin 
   2004  1.120  knakahar #ifdef PPPOE_MPSAFE
   2005  1.120  knakahar static int
   2006  1.120  knakahar pppoe_transmit(struct ifnet *ifp, struct mbuf *m)
   2007  1.120  knakahar {
   2008  1.120  knakahar 	struct pppoe_softc *sc = (void *)ifp;
   2009  1.120  knakahar 	uint8_t *p;
   2010  1.120  knakahar 	size_t len;
   2011  1.120  knakahar 
   2012  1.120  knakahar 	if (m == NULL)
   2013  1.120  knakahar 		return EINVAL;
   2014  1.120  knakahar 
   2015  1.120  knakahar 	/* are we ready to process data yet? */
   2016  1.127  knakahar 	PPPOE_LOCK(sc, RW_READER);
   2017  1.120  knakahar 	if (sc->sc_state < PPPOE_STATE_SESSION) {
   2018  1.127  knakahar 		PPPOE_UNLOCK(sc);
   2019  1.134      maxv 		m_freem(m);
   2020  1.120  knakahar 		return ENOBUFS;
   2021  1.120  knakahar 	}
   2022  1.120  knakahar 
   2023  1.120  knakahar 	len = m->m_pkthdr.len;
   2024  1.120  knakahar 	M_PREPEND(m, PPPOE_HEADERLEN, M_DONTWAIT);
   2025  1.120  knakahar 	if (m == NULL) {
   2026  1.127  knakahar 		PPPOE_UNLOCK(sc);
   2027  1.148   thorpej 		if_statinc(ifp, if_oerrors);
   2028  1.120  knakahar 		return ENETDOWN;
   2029  1.120  knakahar 	}
   2030  1.120  knakahar 	p = mtod(m, uint8_t *);
   2031  1.120  knakahar 	PPPOE_ADD_HEADER(p, 0, sc->sc_session, len);
   2032  1.120  knakahar 
   2033  1.141   msaitoh 	bpf_mtap(&sc->sc_sppp.pp_if, m, BPF_D_OUT);
   2034  1.120  knakahar 
   2035  1.120  knakahar 	pppoe_output(sc, m);
   2036  1.127  knakahar 	PPPOE_UNLOCK(sc);
   2037  1.120  knakahar 	return 0;
   2038  1.120  knakahar }
   2039  1.120  knakahar #endif /* PPPOE_MPSAFE */
   2040   1.54    martin 
   2041  1.123  christos static void
   2042  1.123  christos pppoe_ifattach_hook(void *arg, unsigned long cmd, void *arg2)
   2043   1.54    martin {
   2044  1.123  christos 	struct ifnet *ifp = arg2;
   2045   1.54    martin 	struct pppoe_softc *sc;
   2046  1.120  knakahar 	DECLARE_SPLNET_VARIABLE;
   2047   1.54    martin 
   2048  1.123  christos 	if (cmd != PFIL_IFNET_DETACH)
   2049  1.123  christos 		return;
   2050   1.54    martin 
   2051  1.120  knakahar 	ACQUIRE_SPLNET();
   2052  1.120  knakahar 	rw_enter(&pppoe_softc_list_lock, RW_READER);
   2053   1.54    martin 	LIST_FOREACH(sc, &pppoe_softc_list, sc_list) {
   2054  1.127  knakahar 		PPPOE_LOCK(sc, RW_WRITER);
   2055  1.120  knakahar 		if (sc->sc_eth_if != ifp) {
   2056  1.127  knakahar 			PPPOE_UNLOCK(sc);
   2057   1.54    martin 			continue;
   2058  1.120  knakahar 		}
   2059   1.54    martin 		if (sc->sc_sppp.pp_if.if_flags & IFF_UP) {
   2060   1.54    martin 			sc->sc_sppp.pp_if.if_flags &= ~(IFF_UP|IFF_RUNNING);
   2061  1.157  yamaguch 			pppoe_printf(sc,
   2062  1.157  yamaguch 			    "ethernet interface detached, going down\n");
   2063   1.54    martin 		}
   2064   1.54    martin 		sc->sc_eth_if = NULL;
   2065   1.57    martin 		pppoe_clear_softc(sc, "ethernet interface detached");
   2066  1.127  knakahar 		PPPOE_UNLOCK(sc);
   2067   1.54    martin 	}
   2068  1.120  knakahar 	rw_exit(&pppoe_softc_list_lock);
   2069  1.120  knakahar 	RELEASE_SPLNET();
   2070   1.54    martin }
   2071   1.57    martin 
   2072   1.57    martin static void
   2073   1.57    martin pppoe_clear_softc(struct pppoe_softc *sc, const char *message)
   2074   1.57    martin {
   2075  1.127  knakahar 	KASSERT(PPPOE_WLOCKED(sc));
   2076  1.120  knakahar 
   2077   1.58    martin 	/* stop timer */
   2078   1.57    martin 	callout_stop(&sc->sc_timeout);
   2079  1.157  yamaguch 	pppoe_printf(sc, "session 0x%x terminated, %s\n",
   2080  1.157  yamaguch 	    sc->sc_session, message);
   2081   1.57    martin 
   2082   1.57    martin 	/* fix our state */
   2083   1.57    martin 	sc->sc_state = PPPOE_STATE_INITIAL;
   2084  1.120  knakahar 
   2085  1.127  knakahar 	PPPOE_UNLOCK(sc);
   2086   1.57    martin 
   2087   1.57    martin 	/* signal upper layer */
   2088   1.57    martin 	sc->sc_sppp.pp_down(&sc->sc_sppp);
   2089  1.120  knakahar 
   2090  1.127  knakahar 	PPPOE_LOCK(sc, RW_WRITER);
   2091   1.57    martin 
   2092   1.57    martin 	/* clean up softc */
   2093   1.57    martin 	memcpy(&sc->sc_dest, etherbroadcastaddr, sizeof(sc->sc_dest));
   2094   1.57    martin 	if (sc->sc_ac_cookie) {
   2095   1.57    martin 		free(sc->sc_ac_cookie, M_DEVBUF);
   2096   1.57    martin 		sc->sc_ac_cookie = NULL;
   2097   1.57    martin 	}
   2098   1.94  christos 	if (sc->sc_relay_sid) {
   2099   1.94  christos 		free(sc->sc_relay_sid, M_DEVBUF);
   2100   1.94  christos 		sc->sc_relay_sid = NULL;
   2101   1.94  christos 	}
   2102   1.57    martin 	sc->sc_ac_cookie_len = 0;
   2103   1.57    martin 	sc->sc_session = 0;
   2104   1.57    martin }
   2105  1.105     ozaki 
   2106  1.105     ozaki static void
   2107  1.105     ozaki pppoe_enqueue(struct ifqueue *inq, struct mbuf *m)
   2108  1.105     ozaki {
   2109  1.105     ozaki 	if (m->m_flags & M_PROMISC) {
   2110  1.134      maxv 		m_freem(m);
   2111  1.105     ozaki 		return;
   2112  1.105     ozaki 	}
   2113  1.105     ozaki 
   2114  1.105     ozaki #ifndef PPPOE_SERVER
   2115  1.105     ozaki 	if (m->m_flags & (M_MCAST | M_BCAST)) {
   2116  1.134      maxv 		m_freem(m);
   2117  1.105     ozaki 		return;
   2118  1.105     ozaki 	}
   2119  1.105     ozaki #endif
   2120  1.105     ozaki 
   2121  1.118     ozaki 	IFQ_LOCK(inq);
   2122  1.105     ozaki 	if (IF_QFULL(inq)) {
   2123  1.105     ozaki 		IF_DROP(inq);
   2124  1.118     ozaki 		IFQ_UNLOCK(inq);
   2125  1.105     ozaki 		m_freem(m);
   2126  1.105     ozaki 	} else {
   2127  1.105     ozaki 		IF_ENQUEUE(inq, m);
   2128  1.118     ozaki 		IFQ_UNLOCK(inq);
   2129  1.105     ozaki 		softint_schedule(pppoe_softintr);
   2130  1.105     ozaki 	}
   2131  1.105     ozaki 	return;
   2132  1.105     ozaki }
   2133  1.105     ozaki 
   2134  1.105     ozaki void
   2135  1.105     ozaki pppoe_input(struct ifnet *ifp, struct mbuf *m)
   2136  1.105     ozaki {
   2137  1.105     ozaki 	pppoe_enqueue(&ppoeinq, m);
   2138  1.105     ozaki 	return;
   2139  1.105     ozaki }
   2140  1.105     ozaki 
   2141  1.105     ozaki void
   2142  1.105     ozaki pppoedisc_input(struct ifnet *ifp, struct mbuf *m)
   2143  1.105     ozaki {
   2144  1.105     ozaki 	pppoe_enqueue(&ppoediscinq, m);
   2145  1.105     ozaki 	return;
   2146  1.105     ozaki }
   2147  1.112  pgoyette 
   2148  1.117  christos static void
   2149  1.117  christos sysctl_net_pppoe_setup(struct sysctllog **clog)
   2150  1.113  pgoyette {
   2151  1.113  pgoyette 	const struct sysctlnode *node = NULL;
   2152  1.113  pgoyette 
   2153  1.113  pgoyette 	sysctl_createv(clog, 0, NULL, &node,
   2154  1.113  pgoyette 	    CTLFLAG_PERMANENT,
   2155  1.113  pgoyette 	    CTLTYPE_NODE, "pppoe",
   2156  1.113  pgoyette 	    SYSCTL_DESCR("PPPOE protocol"),
   2157  1.113  pgoyette 	    NULL, 0, NULL, 0,
   2158  1.113  pgoyette 	    CTL_NET, CTL_CREATE, CTL_EOL);
   2159  1.113  pgoyette 
   2160  1.113  pgoyette 	if (node == NULL)
   2161  1.113  pgoyette 		return;
   2162  1.113  pgoyette 
   2163  1.113  pgoyette 	sysctl_createv(clog, 0, &node, NULL,
   2164  1.135  knakahar 	    CTLFLAG_PERMANENT | CTLFLAG_READWRITE,
   2165  1.113  pgoyette 	    CTLTYPE_BOOL, "term_unknown",
   2166  1.113  pgoyette 	    SYSCTL_DESCR("Terminate unknown sessions"),
   2167  1.113  pgoyette 	    NULL, 0, &pppoe_term_unknown, sizeof(pppoe_term_unknown),
   2168  1.113  pgoyette 	    CTL_CREATE, CTL_EOL);
   2169  1.113  pgoyette }
   2170  1.114  christos 
   2171  1.114  christos /*
   2172  1.114  christos  * Module infrastructure
   2173  1.114  christos  */
   2174  1.114  christos #include "if_module.h"
   2175  1.114  christos 
   2176  1.114  christos IF_MODULE(MODULE_CLASS_DRIVER, pppoe, "sppp_subr")
   2177