StrippedDownNetServices - This library is stripped down version of NetServi…

Users » idinor » Code » StrippedDownNetServices

idinor Launcher / StrippedDownNetServices

This library is stripped down version of NetServices library. HTTP server and client function is NOT supported.

lwip/netif/ppp/ppp_oe.c@0:dcf3c92487ca, 2011-07-20 (annotated)

Committer:: idinor
Date:: Wed Jul 20 11:45:39 2011 +0000
Revision:: 0:dcf3c92487ca

Who changed what in which revision?

User	Revision	Line number	New contents of line
idinor	0:dcf3c92487ca	1	/*****************************************************************************
idinor	0:dcf3c92487ca	2	* ppp_oe.c - PPP Over Ethernet implementation for lwIP.
idinor	0:dcf3c92487ca	3	*
idinor	0:dcf3c92487ca	4	* Copyright (c) 2006 by Marc Boucher, Services Informatiques (MBSI) inc.
idinor	0:dcf3c92487ca	5	*
idinor	0:dcf3c92487ca	6	* The authors hereby grant permission to use, copy, modify, distribute,
idinor	0:dcf3c92487ca	7	* and license this software and its documentation for any purpose, provided
idinor	0:dcf3c92487ca	8	* that existing copyright notices are retained in all copies and that this
idinor	0:dcf3c92487ca	9	* notice and the following disclaimer are included verbatim in any
idinor	0:dcf3c92487ca	10	* distributions. No written agreement, license, or royalty fee is required
idinor	0:dcf3c92487ca	11	* for any of the authorized uses.
idinor	0:dcf3c92487ca	12	*
idinor	0:dcf3c92487ca	13	* THIS SOFTWARE IS PROVIDED BY THE CONTRIBUTORS AS IS AND ANY EXPRESS OR
idinor	0:dcf3c92487ca	14	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
idinor	0:dcf3c92487ca	15	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
idinor	0:dcf3c92487ca	16	* IN NO EVENT SHALL THE CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
idinor	0:dcf3c92487ca	17	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
idinor	0:dcf3c92487ca	18	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
idinor	0:dcf3c92487ca	19	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
idinor	0:dcf3c92487ca	20	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
idinor	0:dcf3c92487ca	21	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
idinor	0:dcf3c92487ca	22	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
idinor	0:dcf3c92487ca	23	*
idinor	0:dcf3c92487ca	24	******************************************************************************
idinor	0:dcf3c92487ca	25	* REVISION HISTORY
idinor	0:dcf3c92487ca	26	*
idinor	0:dcf3c92487ca	27	* 06-01-01 Marc Boucher <marc@mbsi.ca>
idinor	0:dcf3c92487ca	28	* Ported to lwIP.
idinor	0:dcf3c92487ca	29	*****************************************************************************/
idinor	0:dcf3c92487ca	30
idinor	0:dcf3c92487ca	31
idinor	0:dcf3c92487ca	32
idinor	0:dcf3c92487ca	33	/* based on NetBSD: if_pppoe.c,v 1.64 2006/01/31 23:50:15 martin Exp */
idinor	0:dcf3c92487ca	34
idinor	0:dcf3c92487ca	35	/*-
idinor	0:dcf3c92487ca	36	* Copyright (c) 2002 The NetBSD Foundation, Inc.
idinor	0:dcf3c92487ca	37	* All rights reserved.
idinor	0:dcf3c92487ca	38	*
idinor	0:dcf3c92487ca	39	* This code is derived from software contributed to The NetBSD Foundation
idinor	0:dcf3c92487ca	40	* by Martin Husemann <martin@NetBSD.org>.
idinor	0:dcf3c92487ca	41	*
idinor	0:dcf3c92487ca	42	* Redistribution and use in source and binary forms, with or without
idinor	0:dcf3c92487ca	43	* modification, are permitted provided that the following conditions
idinor	0:dcf3c92487ca	44	* are met:
idinor	0:dcf3c92487ca	45	* 1. Redistributions of source code must retain the above copyright
idinor	0:dcf3c92487ca	46	* notice, this list of conditions and the following disclaimer.
idinor	0:dcf3c92487ca	47	* 2. Redistributions in binary form must reproduce the above copyright
idinor	0:dcf3c92487ca	48	* notice, this list of conditions and the following disclaimer in the
idinor	0:dcf3c92487ca	49	* documentation and/or other materials provided with the distribution.
idinor	0:dcf3c92487ca	50	* 3. All advertising materials mentioning features or use of this software
idinor	0:dcf3c92487ca	51	* must display the following acknowledgement:
idinor	0:dcf3c92487ca	52	* This product includes software developed by the NetBSD
idinor	0:dcf3c92487ca	53	* Foundation, Inc. and its contributors.
idinor	0:dcf3c92487ca	54	* 4. Neither the name of The NetBSD Foundation nor the names of its
idinor	0:dcf3c92487ca	55	* contributors may be used to endorse or promote products derived
idinor	0:dcf3c92487ca	56	* from this software without specific prior written permission.
idinor	0:dcf3c92487ca	57	*
idinor	0:dcf3c92487ca	58	* THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
idinor	0:dcf3c92487ca	59	* ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
idinor	0:dcf3c92487ca	60	* TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
idinor	0:dcf3c92487ca	61	* PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
idinor	0:dcf3c92487ca	62	* BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
idinor	0:dcf3c92487ca	63	* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
idinor	0:dcf3c92487ca	64	* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
idinor	0:dcf3c92487ca	65	* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
idinor	0:dcf3c92487ca	66	* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
idinor	0:dcf3c92487ca	67	* ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
idinor	0:dcf3c92487ca	68	* POSSIBILITY OF SUCH DAMAGE.
idinor	0:dcf3c92487ca	69	*/
idinor	0:dcf3c92487ca	70
idinor	0:dcf3c92487ca	71	#include "lwip/opt.h"
idinor	0:dcf3c92487ca	72
idinor	0:dcf3c92487ca	73	#if PPPOE_SUPPORT /* don't build if not configured for use in lwipopts.h */
idinor	0:dcf3c92487ca	74
idinor	0:dcf3c92487ca	75	#include "netif/ppp_oe.h"
idinor	0:dcf3c92487ca	76
idinor	0:dcf3c92487ca	77	#include "ppp.h"
idinor	0:dcf3c92487ca	78	#include "pppdebug.h"
idinor	0:dcf3c92487ca	79
idinor	0:dcf3c92487ca	80	#include "lwip/timers.h"
idinor	0:dcf3c92487ca	81	#include "lwip/memp.h"
idinor	0:dcf3c92487ca	82
idinor	0:dcf3c92487ca	83	#include <string.h>
idinor	0:dcf3c92487ca	84	#include <stdio.h>
idinor	0:dcf3c92487ca	85
idinor	0:dcf3c92487ca	86
idinor	0:dcf3c92487ca	87	/* Add a 16 bit unsigned value to a buffer pointed to by PTR */
idinor	0:dcf3c92487ca	88	#define PPPOE_ADD_16(PTR, VAL) \
idinor	0:dcf3c92487ca	89	*(PTR)++ = (u8_t)((VAL) / 256); \
idinor	0:dcf3c92487ca	90	*(PTR)++ = (u8_t)((VAL) % 256)
idinor	0:dcf3c92487ca	91
idinor	0:dcf3c92487ca	92	/* Add a complete PPPoE header to the buffer pointed to by PTR */
idinor	0:dcf3c92487ca	93	#define PPPOE_ADD_HEADER(PTR, CODE, SESS, LEN) \
idinor	0:dcf3c92487ca	94	*(PTR)++ = PPPOE_VERTYPE; \
idinor	0:dcf3c92487ca	95	*(PTR)++ = (CODE); \
idinor	0:dcf3c92487ca	96	PPPOE_ADD_16(PTR, SESS); \
idinor	0:dcf3c92487ca	97	PPPOE_ADD_16(PTR, LEN)
idinor	0:dcf3c92487ca	98
idinor	0:dcf3c92487ca	99	#define PPPOE_DISC_TIMEOUT (51000) / base for quick timeout calculation */
idinor	0:dcf3c92487ca	100	#define PPPOE_SLOW_RETRY (601000) / persistent retry interval */
idinor	0:dcf3c92487ca	101	#define PPPOE_DISC_MAXPADI 4 /* retry PADI four times (quickly) */
idinor	0:dcf3c92487ca	102	#define PPPOE_DISC_MAXPADR 2 /* retry PADR twice */
idinor	0:dcf3c92487ca	103
idinor	0:dcf3c92487ca	104	#ifdef PPPOE_SERVER
idinor	0:dcf3c92487ca	105	#error "PPPOE_SERVER is not yet supported under lwIP!"
idinor	0:dcf3c92487ca	106	/* from if_spppsubr.c */
idinor	0:dcf3c92487ca	107	#define IFF_PASSIVE IFF_LINK0 /* wait passively for connection */
idinor	0:dcf3c92487ca	108	#endif
idinor	0:dcf3c92487ca	109
idinor	0:dcf3c92487ca	110	#ifndef PPPOE_ERRORSTRING_LEN
idinor	0:dcf3c92487ca	111	#define PPPOE_ERRORSTRING_LEN 64
idinor	0:dcf3c92487ca	112	#endif
idinor	0:dcf3c92487ca	113	static char pppoe_error_tmp[PPPOE_ERRORSTRING_LEN];
idinor	0:dcf3c92487ca	114
idinor	0:dcf3c92487ca	115
idinor	0:dcf3c92487ca	116	/* input routines */
idinor	0:dcf3c92487ca	117	static void pppoe_dispatch_disc_pkt(struct netif , struct pbuf );
idinor	0:dcf3c92487ca	118
idinor	0:dcf3c92487ca	119	/* management routines */
idinor	0:dcf3c92487ca	120	static int pppoe_do_disconnect(struct pppoe_softc *);
idinor	0:dcf3c92487ca	121	static void pppoe_abort_connect(struct pppoe_softc *);
idinor	0:dcf3c92487ca	122	static void pppoe_clear_softc(struct pppoe_softc , const char );
idinor	0:dcf3c92487ca	123
idinor	0:dcf3c92487ca	124	/* internal timeout handling */
idinor	0:dcf3c92487ca	125	static void pppoe_timeout(void *);
idinor	0:dcf3c92487ca	126
idinor	0:dcf3c92487ca	127	/* sending actual protocol controll packets */
idinor	0:dcf3c92487ca	128	static err_t pppoe_send_padi(struct pppoe_softc *);
idinor	0:dcf3c92487ca	129	static err_t pppoe_send_padr(struct pppoe_softc *);
idinor	0:dcf3c92487ca	130	#ifdef PPPOE_SERVER
idinor	0:dcf3c92487ca	131	static err_t pppoe_send_pado(struct pppoe_softc *);
idinor	0:dcf3c92487ca	132	static err_t pppoe_send_pads(struct pppoe_softc *);
idinor	0:dcf3c92487ca	133	#endif
idinor	0:dcf3c92487ca	134	static err_t pppoe_send_padt(struct netif , u_int, const u8_t );
idinor	0:dcf3c92487ca	135
idinor	0:dcf3c92487ca	136	/* internal helper functions */
idinor	0:dcf3c92487ca	137	static struct pppoe_softc * pppoe_find_softc_by_session(u_int, struct netif *);
idinor	0:dcf3c92487ca	138	static struct pppoe_softc * pppoe_find_softc_by_hunique(u8_t , size_t, struct netif );
idinor	0:dcf3c92487ca	139
idinor	0:dcf3c92487ca	140	/** linked list of created pppoe interfaces */
idinor	0:dcf3c92487ca	141	static struct pppoe_softc *pppoe_softc_list;
idinor	0:dcf3c92487ca	142
idinor	0:dcf3c92487ca	143	err_t
idinor	0:dcf3c92487ca	144	pppoe_create(struct netif ethif, int pd, void (linkStatusCB)(int pd, int up), struct pppoe_softc **scptr)
idinor	0:dcf3c92487ca	145	{
idinor	0:dcf3c92487ca	146	struct pppoe_softc *sc;
idinor	0:dcf3c92487ca	147
idinor	0:dcf3c92487ca	148	sc = (struct pppoe_softc *)memp_malloc(MEMP_PPPOE_IF);
idinor	0:dcf3c92487ca	149	if (sc == NULL) {
idinor	0:dcf3c92487ca	150	*scptr = NULL;
idinor	0:dcf3c92487ca	151	return ERR_MEM;
idinor	0:dcf3c92487ca	152	}
idinor	0:dcf3c92487ca	153	memset(sc, 0, sizeof(struct pppoe_softc));
idinor	0:dcf3c92487ca	154
idinor	0:dcf3c92487ca	155	/* changed to real address later */
idinor	0:dcf3c92487ca	156	MEMCPY(&sc->sc_dest, ethbroadcast.addr, sizeof(sc->sc_dest));
idinor	0:dcf3c92487ca	157
idinor	0:dcf3c92487ca	158	sc->sc_pd = pd;
idinor	0:dcf3c92487ca	159	sc->sc_linkStatusCB = linkStatusCB;
idinor	0:dcf3c92487ca	160	sc->sc_ethif = ethif;
idinor	0:dcf3c92487ca	161
idinor	0:dcf3c92487ca	162	/* put the new interface at the head of the list */
idinor	0:dcf3c92487ca	163	sc->next = pppoe_softc_list;
idinor	0:dcf3c92487ca	164	pppoe_softc_list = sc;
idinor	0:dcf3c92487ca	165
idinor	0:dcf3c92487ca	166	*scptr = sc;
idinor	0:dcf3c92487ca	167
idinor	0:dcf3c92487ca	168	return ERR_OK;
idinor	0:dcf3c92487ca	169	}
idinor	0:dcf3c92487ca	170
idinor	0:dcf3c92487ca	171	err_t
idinor	0:dcf3c92487ca	172	pppoe_destroy(struct netif *ifp)
idinor	0:dcf3c92487ca	173	{
idinor	0:dcf3c92487ca	174	struct pppoe_softc sc, prev = NULL;
idinor	0:dcf3c92487ca	175
idinor	0:dcf3c92487ca	176	for (sc = pppoe_softc_list; sc != NULL; prev = sc, sc = sc->next) {
idinor	0:dcf3c92487ca	177	if (sc->sc_ethif == ifp) {
idinor	0:dcf3c92487ca	178	break;
idinor	0:dcf3c92487ca	179	}
idinor	0:dcf3c92487ca	180	}
idinor	0:dcf3c92487ca	181
idinor	0:dcf3c92487ca	182	if(!(sc && (sc->sc_ethif == ifp))) {
idinor	0:dcf3c92487ca	183	return ERR_IF;
idinor	0:dcf3c92487ca	184	}
idinor	0:dcf3c92487ca	185
idinor	0:dcf3c92487ca	186	sys_untimeout(pppoe_timeout, sc);
idinor	0:dcf3c92487ca	187	if (prev == NULL) {
idinor	0:dcf3c92487ca	188	/* remove sc from the head of the list */
idinor	0:dcf3c92487ca	189	pppoe_softc_list = sc->next;
idinor	0:dcf3c92487ca	190	} else {
idinor	0:dcf3c92487ca	191	/* remove sc from the list */
idinor	0:dcf3c92487ca	192	prev->next = sc->next;
idinor	0:dcf3c92487ca	193	}
idinor	0:dcf3c92487ca	194
idinor	0:dcf3c92487ca	195	#ifdef PPPOE_TODO
idinor	0:dcf3c92487ca	196	if (sc->sc_concentrator_name) {
idinor	0:dcf3c92487ca	197	mem_free(sc->sc_concentrator_name);
idinor	0:dcf3c92487ca	198	}
idinor	0:dcf3c92487ca	199	if (sc->sc_service_name) {
idinor	0:dcf3c92487ca	200	mem_free(sc->sc_service_name);
idinor	0:dcf3c92487ca	201	}
idinor	0:dcf3c92487ca	202	#endif /* PPPOE_TODO */
idinor	0:dcf3c92487ca	203	memp_free(MEMP_PPPOE_IF, sc);
idinor	0:dcf3c92487ca	204
idinor	0:dcf3c92487ca	205	return ERR_OK;
idinor	0:dcf3c92487ca	206	}
idinor	0:dcf3c92487ca	207
idinor	0:dcf3c92487ca	208	/*
idinor	0:dcf3c92487ca	209	* Find the interface handling the specified session.
idinor	0:dcf3c92487ca	210	* Note: O(number of sessions open), this is a client-side only, mean
idinor	0:dcf3c92487ca	211	* and lean implementation, so number of open sessions typically should
idinor	0:dcf3c92487ca	212	* be 1.
idinor	0:dcf3c92487ca	213	*/
idinor	0:dcf3c92487ca	214	static struct pppoe_softc *
idinor	0:dcf3c92487ca	215	pppoe_find_softc_by_session(u_int session, struct netif *rcvif)
idinor	0:dcf3c92487ca	216	{
idinor	0:dcf3c92487ca	217	struct pppoe_softc *sc;
idinor	0:dcf3c92487ca	218
idinor	0:dcf3c92487ca	219	if (session == 0) {
idinor	0:dcf3c92487ca	220	return NULL;
idinor	0:dcf3c92487ca	221	}
idinor	0:dcf3c92487ca	222
idinor	0:dcf3c92487ca	223	for (sc = pppoe_softc_list; sc != NULL; sc = sc->next) {
idinor	0:dcf3c92487ca	224	if (sc->sc_state == PPPOE_STATE_SESSION
idinor	0:dcf3c92487ca	225	&& sc->sc_session == session) {
idinor	0:dcf3c92487ca	226	if (sc->sc_ethif == rcvif) {
idinor	0:dcf3c92487ca	227	return sc;
idinor	0:dcf3c92487ca	228	} else {
idinor	0:dcf3c92487ca	229	return NULL;
idinor	0:dcf3c92487ca	230	}
idinor	0:dcf3c92487ca	231	}
idinor	0:dcf3c92487ca	232	}
idinor	0:dcf3c92487ca	233	return NULL;
idinor	0:dcf3c92487ca	234	}
idinor	0:dcf3c92487ca	235
idinor	0:dcf3c92487ca	236	/* Check host unique token passed and return appropriate softc pointer,
idinor	0:dcf3c92487ca	237	* or NULL if token is bogus. */
idinor	0:dcf3c92487ca	238	static struct pppoe_softc *
idinor	0:dcf3c92487ca	239	pppoe_find_softc_by_hunique(u8_t token, size_t len, struct netif rcvif)
idinor	0:dcf3c92487ca	240	{
idinor	0:dcf3c92487ca	241	struct pppoe_softc sc, t;
idinor	0:dcf3c92487ca	242
idinor	0:dcf3c92487ca	243	if (pppoe_softc_list == NULL) {
idinor	0:dcf3c92487ca	244	return NULL;
idinor	0:dcf3c92487ca	245	}
idinor	0:dcf3c92487ca	246
idinor	0:dcf3c92487ca	247	if (len != sizeof sc) {
idinor	0:dcf3c92487ca	248	return NULL;
idinor	0:dcf3c92487ca	249	}
idinor	0:dcf3c92487ca	250	MEMCPY(&t, token, len);
idinor	0:dcf3c92487ca	251
idinor	0:dcf3c92487ca	252	for (sc = pppoe_softc_list; sc != NULL; sc = sc->next) {
idinor	0:dcf3c92487ca	253	if (sc == t) {
idinor	0:dcf3c92487ca	254	break;
idinor	0:dcf3c92487ca	255	}
idinor	0:dcf3c92487ca	256	}
idinor	0:dcf3c92487ca	257
idinor	0:dcf3c92487ca	258	if (sc == NULL) {
idinor	0:dcf3c92487ca	259	PPPDEBUG(LOG_DEBUG, ("pppoe: alien host unique tag, no session found\n"));
idinor	0:dcf3c92487ca	260	return NULL;
idinor	0:dcf3c92487ca	261	}
idinor	0:dcf3c92487ca	262
idinor	0:dcf3c92487ca	263	/* should be safe to access sc now /
idinor	0:dcf3c92487ca	264	if (sc->sc_state < PPPOE_STATE_PADI_SENT \|\| sc->sc_state >= PPPOE_STATE_SESSION) {
idinor	0:dcf3c92487ca	265	printf("%c%c%"U16_F": host unique tag found, but it belongs to a connection in state %d\n",
idinor	0:dcf3c92487ca	266	sc->sc_ethif->name[0], sc->sc_ethif->name[1], sc->sc_ethif->num, sc->sc_state);
idinor	0:dcf3c92487ca	267	return NULL;
idinor	0:dcf3c92487ca	268	}
idinor	0:dcf3c92487ca	269	if (sc->sc_ethif != rcvif) {
idinor	0:dcf3c92487ca	270	printf("%c%c%"U16_F": wrong interface, not accepting host unique\n",
idinor	0:dcf3c92487ca	271	sc->sc_ethif->name[0], sc->sc_ethif->name[1], sc->sc_ethif->num);
idinor	0:dcf3c92487ca	272	return NULL;
idinor	0:dcf3c92487ca	273	}
idinor	0:dcf3c92487ca	274	return sc;
idinor	0:dcf3c92487ca	275	}
idinor	0:dcf3c92487ca	276
idinor	0:dcf3c92487ca	277	static void
idinor	0:dcf3c92487ca	278	pppoe_linkstatus_up(struct pppoe_softc *sc)
idinor	0:dcf3c92487ca	279	{
idinor	0:dcf3c92487ca	280	sc->sc_linkStatusCB(sc->sc_pd, 1);
idinor	0:dcf3c92487ca	281	}
idinor	0:dcf3c92487ca	282
idinor	0:dcf3c92487ca	283	/* analyze and handle a single received packet while not in session state */
idinor	0:dcf3c92487ca	284	static void
idinor	0:dcf3c92487ca	285	pppoe_dispatch_disc_pkt(struct netif netif, struct pbuf pb)
idinor	0:dcf3c92487ca	286	{
idinor	0:dcf3c92487ca	287	u16_t tag, len;
idinor	0:dcf3c92487ca	288	u16_t session, plen;
idinor	0:dcf3c92487ca	289	struct pppoe_softc *sc;
idinor	0:dcf3c92487ca	290	const char *err_msg;
idinor	0:dcf3c92487ca	291	char devname[6];
idinor	0:dcf3c92487ca	292	u8_t *ac_cookie;
idinor	0:dcf3c92487ca	293	u16_t ac_cookie_len;
idinor	0:dcf3c92487ca	294	#ifdef PPPOE_SERVER
idinor	0:dcf3c92487ca	295	u8_t *hunique;
idinor	0:dcf3c92487ca	296	size_t hunique_len;
idinor	0:dcf3c92487ca	297	#endif
idinor	0:dcf3c92487ca	298	struct pppoehdr *ph;
idinor	0:dcf3c92487ca	299	struct pppoetag pt;
idinor	0:dcf3c92487ca	300	int off, err, errortag;
idinor	0:dcf3c92487ca	301	struct eth_hdr *ethhdr;
idinor	0:dcf3c92487ca	302
idinor	0:dcf3c92487ca	303	pb = pppSingleBuf(pb);
idinor	0:dcf3c92487ca	304
idinor	0:dcf3c92487ca	305	strcpy(devname, "pppoe"); /* as long as we don't know which instance */
idinor	0:dcf3c92487ca	306	err_msg = NULL;
idinor	0:dcf3c92487ca	307	errortag = 0;
idinor	0:dcf3c92487ca	308	if (pb->len < sizeof(*ethhdr)) {
idinor	0:dcf3c92487ca	309	goto done;
idinor	0:dcf3c92487ca	310	}
idinor	0:dcf3c92487ca	311	ethhdr = (struct eth_hdr *)pb->payload;
idinor	0:dcf3c92487ca	312	off = sizeof(*ethhdr);
idinor	0:dcf3c92487ca	313
idinor	0:dcf3c92487ca	314	ac_cookie = NULL;
idinor	0:dcf3c92487ca	315	ac_cookie_len = 0;
idinor	0:dcf3c92487ca	316	#ifdef PPPOE_SERVER
idinor	0:dcf3c92487ca	317	hunique = NULL;
idinor	0:dcf3c92487ca	318	hunique_len = 0;
idinor	0:dcf3c92487ca	319	#endif
idinor	0:dcf3c92487ca	320	session = 0;
idinor	0:dcf3c92487ca	321	if (pb->len - off < PPPOE_HEADERLEN) {
idinor	0:dcf3c92487ca	322	printf("pppoe: packet too short: %d\n", pb->len);
idinor	0:dcf3c92487ca	323	goto done;
idinor	0:dcf3c92487ca	324	}
idinor	0:dcf3c92487ca	325
idinor	0:dcf3c92487ca	326	ph = (struct pppoehdr *) (ethhdr + 1);
idinor	0:dcf3c92487ca	327	if (ph->vertype != PPPOE_VERTYPE) {
idinor	0:dcf3c92487ca	328	printf("pppoe: unknown version/type packet: 0x%x\n", ph->vertype);
idinor	0:dcf3c92487ca	329	goto done;
idinor	0:dcf3c92487ca	330	}
idinor	0:dcf3c92487ca	331	session = ntohs(ph->session);
idinor	0:dcf3c92487ca	332	plen = ntohs(ph->plen);
idinor	0:dcf3c92487ca	333	off += sizeof(*ph);
idinor	0:dcf3c92487ca	334
idinor	0:dcf3c92487ca	335	if (plen + off > pb->len) {
idinor	0:dcf3c92487ca	336	printf("pppoe: packet content does not fit: data available = %d, packet size = %u\n",
idinor	0:dcf3c92487ca	337	pb->len - off, plen);
idinor	0:dcf3c92487ca	338	goto done;
idinor	0:dcf3c92487ca	339	}
idinor	0:dcf3c92487ca	340	if(pb->tot_len == pb->len) {
idinor	0:dcf3c92487ca	341	pb->tot_len = pb->len = (u16_t)off + plen; /* ignore trailing garbage */
idinor	0:dcf3c92487ca	342	}
idinor	0:dcf3c92487ca	343	tag = 0;
idinor	0:dcf3c92487ca	344	len = 0;
idinor	0:dcf3c92487ca	345	sc = NULL;
idinor	0:dcf3c92487ca	346	while (off + sizeof(pt) <= pb->len) {
idinor	0:dcf3c92487ca	347	MEMCPY(&pt, (u8_t*)pb->payload + off, sizeof(pt));
idinor	0:dcf3c92487ca	348	tag = ntohs(pt.tag);
idinor	0:dcf3c92487ca	349	len = ntohs(pt.len);
idinor	0:dcf3c92487ca	350	if (off + sizeof(pt) + len > pb->len) {
idinor	0:dcf3c92487ca	351	printf("pppoe: tag 0x%x len 0x%x is too long\n", tag, len);
idinor	0:dcf3c92487ca	352	goto done;
idinor	0:dcf3c92487ca	353	}
idinor	0:dcf3c92487ca	354	switch (tag) {
idinor	0:dcf3c92487ca	355	case PPPOE_TAG_EOL:
idinor	0:dcf3c92487ca	356	goto breakbreak;
idinor	0:dcf3c92487ca	357	case PPPOE_TAG_SNAME:
idinor	0:dcf3c92487ca	358	break; /* ignored */
idinor	0:dcf3c92487ca	359	case PPPOE_TAG_ACNAME:
idinor	0:dcf3c92487ca	360	break; /* ignored */
idinor	0:dcf3c92487ca	361	case PPPOE_TAG_HUNIQUE:
idinor	0:dcf3c92487ca	362	if (sc != NULL) {
idinor	0:dcf3c92487ca	363	break;
idinor	0:dcf3c92487ca	364	}
idinor	0:dcf3c92487ca	365	#ifdef PPPOE_SERVER
idinor	0:dcf3c92487ca	366	hunique = (u8_t*)pb->payload + off + sizeof(pt);
idinor	0:dcf3c92487ca	367	hunique_len = len;
idinor	0:dcf3c92487ca	368	#endif
idinor	0:dcf3c92487ca	369	sc = pppoe_find_softc_by_hunique((u8_t*)pb->payload + off + sizeof(pt), len, netif);
idinor	0:dcf3c92487ca	370	if (sc != NULL) {
idinor	0:dcf3c92487ca	371	snprintf(devname, sizeof(devname), "%c%c%"U16_F, sc->sc_ethif->name[0], sc->sc_ethif->name[1], sc->sc_ethif->num);
idinor	0:dcf3c92487ca	372	}
idinor	0:dcf3c92487ca	373	break;
idinor	0:dcf3c92487ca	374	case PPPOE_TAG_ACCOOKIE:
idinor	0:dcf3c92487ca	375	if (ac_cookie == NULL) {
idinor	0:dcf3c92487ca	376	ac_cookie = (u8_t*)pb->payload + off + sizeof(pt);
idinor	0:dcf3c92487ca	377	ac_cookie_len = len;
idinor	0:dcf3c92487ca	378	}
idinor	0:dcf3c92487ca	379	break;
idinor	0:dcf3c92487ca	380	case PPPOE_TAG_SNAME_ERR:
idinor	0:dcf3c92487ca	381	err_msg = "SERVICE NAME ERROR";
idinor	0:dcf3c92487ca	382	errortag = 1;
idinor	0:dcf3c92487ca	383	break;
idinor	0:dcf3c92487ca	384	case PPPOE_TAG_ACSYS_ERR:
idinor	0:dcf3c92487ca	385	err_msg = "AC SYSTEM ERROR";
idinor	0:dcf3c92487ca	386	errortag = 1;
idinor	0:dcf3c92487ca	387	break;
idinor	0:dcf3c92487ca	388	case PPPOE_TAG_GENERIC_ERR:
idinor	0:dcf3c92487ca	389	err_msg = "GENERIC ERROR";
idinor	0:dcf3c92487ca	390	errortag = 1;
idinor	0:dcf3c92487ca	391	break;
idinor	0:dcf3c92487ca	392	}
idinor	0:dcf3c92487ca	393	if (err_msg) {
idinor	0:dcf3c92487ca	394	if (errortag && len) {
idinor	0:dcf3c92487ca	395	u16_t error_len = LWIP_MIN(len, sizeof(pppoe_error_tmp)-1);
idinor	0:dcf3c92487ca	396	strncpy(pppoe_error_tmp, (char*)pb->payload + off + sizeof(pt), error_len);
idinor	0:dcf3c92487ca	397	pppoe_error_tmp[error_len-1] = '\0';
idinor	0:dcf3c92487ca	398	printf("%s: %s: %s\n", devname, err_msg, pppoe_error_tmp);
idinor	0:dcf3c92487ca	399	} else {
idinor	0:dcf3c92487ca	400	printf("%s: %s\n", devname, err_msg);
idinor	0:dcf3c92487ca	401	}
idinor	0:dcf3c92487ca	402	if (errortag) {
idinor	0:dcf3c92487ca	403	goto done;
idinor	0:dcf3c92487ca	404	}
idinor	0:dcf3c92487ca	405	}
idinor	0:dcf3c92487ca	406	off += sizeof(pt) + len;
idinor	0:dcf3c92487ca	407	}
idinor	0:dcf3c92487ca	408
idinor	0:dcf3c92487ca	409	breakbreak:;
idinor	0:dcf3c92487ca	410	switch (ph->code) {
idinor	0:dcf3c92487ca	411	case PPPOE_CODE_PADI:
idinor	0:dcf3c92487ca	412	#ifdef PPPOE_SERVER
idinor	0:dcf3c92487ca	413	/*
idinor	0:dcf3c92487ca	414	* got service name, concentrator name, and/or host unique.
idinor	0:dcf3c92487ca	415	* ignore if we have no interfaces with IFF_PASSIVE\|IFF_UP.
idinor	0:dcf3c92487ca	416	*/
idinor	0:dcf3c92487ca	417	if (LIST_EMPTY(&pppoe_softc_list)) {
idinor	0:dcf3c92487ca	418	goto done;
idinor	0:dcf3c92487ca	419	}
idinor	0:dcf3c92487ca	420	LIST_FOREACH(sc, &pppoe_softc_list, sc_list) {
idinor	0:dcf3c92487ca	421	if (!(sc->sc_sppp.pp_if.if_flags & IFF_UP)) {
idinor	0:dcf3c92487ca	422	continue;
idinor	0:dcf3c92487ca	423	}
idinor	0:dcf3c92487ca	424	if (!(sc->sc_sppp.pp_if.if_flags & IFF_PASSIVE)) {
idinor	0:dcf3c92487ca	425	continue;
idinor	0:dcf3c92487ca	426	}
idinor	0:dcf3c92487ca	427	if (sc->sc_state == PPPOE_STATE_INITIAL) {
idinor	0:dcf3c92487ca	428	break;
idinor	0:dcf3c92487ca	429	}
idinor	0:dcf3c92487ca	430	}
idinor	0:dcf3c92487ca	431	if (sc == NULL) {
idinor	0:dcf3c92487ca	432	/* printf("pppoe: free passive interface is not found\n"); */
idinor	0:dcf3c92487ca	433	goto done;
idinor	0:dcf3c92487ca	434	}
idinor	0:dcf3c92487ca	435	if (hunique) {
idinor	0:dcf3c92487ca	436	if (sc->sc_hunique) {
idinor	0:dcf3c92487ca	437	mem_free(sc->sc_hunique);
idinor	0:dcf3c92487ca	438	}
idinor	0:dcf3c92487ca	439	sc->sc_hunique = mem_malloc(hunique_len);
idinor	0:dcf3c92487ca	440	if (sc->sc_hunique == NULL) {
idinor	0:dcf3c92487ca	441	goto done;
idinor	0:dcf3c92487ca	442	}
idinor	0:dcf3c92487ca	443	sc->sc_hunique_len = hunique_len;
idinor	0:dcf3c92487ca	444	MEMCPY(sc->sc_hunique, hunique, hunique_len);
idinor	0:dcf3c92487ca	445	}
idinor	0:dcf3c92487ca	446	MEMCPY(&sc->sc_dest, eh->ether_shost, sizeof sc->sc_dest);
idinor	0:dcf3c92487ca	447	sc->sc_state = PPPOE_STATE_PADO_SENT;
idinor	0:dcf3c92487ca	448	pppoe_send_pado(sc);
idinor	0:dcf3c92487ca	449	break;
idinor	0:dcf3c92487ca	450	#endif /* PPPOE_SERVER */
idinor	0:dcf3c92487ca	451	case PPPOE_CODE_PADR:
idinor	0:dcf3c92487ca	452	#ifdef PPPOE_SERVER
idinor	0:dcf3c92487ca	453	/*
idinor	0:dcf3c92487ca	454	* get sc from ac_cookie if IFF_PASSIVE
idinor	0:dcf3c92487ca	455	*/
idinor	0:dcf3c92487ca	456	if (ac_cookie == NULL) {
idinor	0:dcf3c92487ca	457	/* be quiet if there is not a single pppoe instance */
idinor	0:dcf3c92487ca	458	printf("pppoe: received PADR but not includes ac_cookie\n");
idinor	0:dcf3c92487ca	459	goto done;
idinor	0:dcf3c92487ca	460	}
idinor	0:dcf3c92487ca	461	sc = pppoe_find_softc_by_hunique(ac_cookie, ac_cookie_len, netif);
idinor	0:dcf3c92487ca	462	if (sc == NULL) {
idinor	0:dcf3c92487ca	463	/* be quiet if there is not a single pppoe instance */
idinor	0:dcf3c92487ca	464	if (!LIST_EMPTY(&pppoe_softc_list)) {
idinor	0:dcf3c92487ca	465	printf("pppoe: received PADR but could not find request for it\n");
idinor	0:dcf3c92487ca	466	}
idinor	0:dcf3c92487ca	467	goto done;
idinor	0:dcf3c92487ca	468	}
idinor	0:dcf3c92487ca	469	if (sc->sc_state != PPPOE_STATE_PADO_SENT) {
idinor	0:dcf3c92487ca	470	printf("%c%c%"U16_F": received unexpected PADR\n", sc->sc_ethif->name[0], sc->sc_ethif->name[1], sc->sc_ethif->num);
idinor	0:dcf3c92487ca	471	goto done;
idinor	0:dcf3c92487ca	472	}
idinor	0:dcf3c92487ca	473	if (hunique) {
idinor	0:dcf3c92487ca	474	if (sc->sc_hunique) {
idinor	0:dcf3c92487ca	475	mem_free(sc->sc_hunique);
idinor	0:dcf3c92487ca	476	}
idinor	0:dcf3c92487ca	477	sc->sc_hunique = mem_malloc(hunique_len);
idinor	0:dcf3c92487ca	478	if (sc->sc_hunique == NULL) {
idinor	0:dcf3c92487ca	479	goto done;
idinor	0:dcf3c92487ca	480	}
idinor	0:dcf3c92487ca	481	sc->sc_hunique_len = hunique_len;
idinor	0:dcf3c92487ca	482	MEMCPY(sc->sc_hunique, hunique, hunique_len);
idinor	0:dcf3c92487ca	483	}
idinor	0:dcf3c92487ca	484	pppoe_send_pads(sc);
idinor	0:dcf3c92487ca	485	sc->sc_state = PPPOE_STATE_SESSION;
idinor	0:dcf3c92487ca	486	pppoe_linkstatus_up(sc); /* notify upper layers */
idinor	0:dcf3c92487ca	487	break;
idinor	0:dcf3c92487ca	488	#else
idinor	0:dcf3c92487ca	489	/* ignore, we are no access concentrator */
idinor	0:dcf3c92487ca	490	goto done;
idinor	0:dcf3c92487ca	491	#endif /* PPPOE_SERVER */
idinor	0:dcf3c92487ca	492	case PPPOE_CODE_PADO:
idinor	0:dcf3c92487ca	493	if (sc == NULL) {
idinor	0:dcf3c92487ca	494	/* be quiet if there is not a single pppoe instance */
idinor	0:dcf3c92487ca	495	if (pppoe_softc_list != NULL) {
idinor	0:dcf3c92487ca	496	printf("pppoe: received PADO but could not find request for it\n");
idinor	0:dcf3c92487ca	497	}
idinor	0:dcf3c92487ca	498	goto done;
idinor	0:dcf3c92487ca	499	}
idinor	0:dcf3c92487ca	500	if (sc->sc_state != PPPOE_STATE_PADI_SENT) {
idinor	0:dcf3c92487ca	501	printf("%c%c%"U16_F": received unexpected PADO\n", sc->sc_ethif->name[0], sc->sc_ethif->name[1], sc->sc_ethif->num);
idinor	0:dcf3c92487ca	502	goto done;
idinor	0:dcf3c92487ca	503	}
idinor	0:dcf3c92487ca	504	if (ac_cookie) {
idinor	0:dcf3c92487ca	505	sc->sc_ac_cookie_len = ac_cookie_len;
idinor	0:dcf3c92487ca	506	MEMCPY(sc->sc_ac_cookie, ac_cookie, ac_cookie_len);
idinor	0:dcf3c92487ca	507	}
idinor	0:dcf3c92487ca	508	MEMCPY(&sc->sc_dest, ethhdr->src.addr, sizeof(sc->sc_dest.addr));
idinor	0:dcf3c92487ca	509	sys_untimeout(pppoe_timeout, sc);
idinor	0:dcf3c92487ca	510	sc->sc_padr_retried = 0;
idinor	0:dcf3c92487ca	511	sc->sc_state = PPPOE_STATE_PADR_SENT;
idinor	0:dcf3c92487ca	512	if ((err = pppoe_send_padr(sc)) != 0) {
idinor	0:dcf3c92487ca	513	PPPDEBUG(LOG_DEBUG, ("pppoe: %c%c%"U16_F": failed to send PADR, error=%d\n", sc->sc_ethif->name[0], sc->sc_ethif->name[1], sc->sc_ethif->num, err));
idinor	0:dcf3c92487ca	514	}
idinor	0:dcf3c92487ca	515	sys_timeout(PPPOE_DISC_TIMEOUT * (1 + sc->sc_padr_retried), pppoe_timeout, sc);
idinor	0:dcf3c92487ca	516	break;
idinor	0:dcf3c92487ca	517	case PPPOE_CODE_PADS:
idinor	0:dcf3c92487ca	518	if (sc == NULL) {
idinor	0:dcf3c92487ca	519	goto done;
idinor	0:dcf3c92487ca	520	}
idinor	0:dcf3c92487ca	521	sc->sc_session = session;
idinor	0:dcf3c92487ca	522	sys_untimeout(pppoe_timeout, sc);
idinor	0:dcf3c92487ca	523	PPPDEBUG(LOG_DEBUG, ("pppoe: %c%c%"U16_F": session 0x%x connected\n", sc->sc_ethif->name[0], sc->sc_ethif->name[1], sc->sc_ethif->num, session));
idinor	0:dcf3c92487ca	524	sc->sc_state = PPPOE_STATE_SESSION;
idinor	0:dcf3c92487ca	525	pppoe_linkstatus_up(sc); /* notify upper layers */
idinor	0:dcf3c92487ca	526	break;
idinor	0:dcf3c92487ca	527	case PPPOE_CODE_PADT:
idinor	0:dcf3c92487ca	528	if (sc == NULL) {
idinor	0:dcf3c92487ca	529	goto done;
idinor	0:dcf3c92487ca	530	}
idinor	0:dcf3c92487ca	531	pppoe_clear_softc(sc, "received PADT");
idinor	0:dcf3c92487ca	532	break;
idinor	0:dcf3c92487ca	533	default:
idinor	0:dcf3c92487ca	534	if(sc) {
idinor	0:dcf3c92487ca	535	printf("%c%c%"U16_F": unknown code (0x%"X16_F") session = 0x%"X16_F"\n",
idinor	0:dcf3c92487ca	536	sc->sc_ethif->name[0], sc->sc_ethif->name[1], sc->sc_ethif->num,
idinor	0:dcf3c92487ca	537	(u16_t)ph->code, session);
idinor	0:dcf3c92487ca	538	} else {
idinor	0:dcf3c92487ca	539	printf("pppoe: unknown code (0x%"X16_F") session = 0x%"X16_F"\n", (u16_t)ph->code, session);
idinor	0:dcf3c92487ca	540	}
idinor	0:dcf3c92487ca	541	break;
idinor	0:dcf3c92487ca	542	}
idinor	0:dcf3c92487ca	543
idinor	0:dcf3c92487ca	544	done:
idinor	0:dcf3c92487ca	545	pbuf_free(pb);
idinor	0:dcf3c92487ca	546	return;
idinor	0:dcf3c92487ca	547	}
idinor	0:dcf3c92487ca	548
idinor	0:dcf3c92487ca	549	void
idinor	0:dcf3c92487ca	550	pppoe_disc_input(struct netif netif, struct pbuf p)
idinor	0:dcf3c92487ca	551	{
idinor	0:dcf3c92487ca	552	/* avoid error messages if there is not a single pppoe instance */
idinor	0:dcf3c92487ca	553	if (pppoe_softc_list != NULL) {
idinor	0:dcf3c92487ca	554	pppoe_dispatch_disc_pkt(netif, p);
idinor	0:dcf3c92487ca	555	} else {
idinor	0:dcf3c92487ca	556	pbuf_free(p);
idinor	0:dcf3c92487ca	557	}
idinor	0:dcf3c92487ca	558	}
idinor	0:dcf3c92487ca	559
idinor	0:dcf3c92487ca	560	void
idinor	0:dcf3c92487ca	561	pppoe_data_input(struct netif netif, struct pbuf pb)
idinor	0:dcf3c92487ca	562	{
idinor	0:dcf3c92487ca	563	u16_t session, plen;
idinor	0:dcf3c92487ca	564	struct pppoe_softc *sc;
idinor	0:dcf3c92487ca	565	struct pppoehdr *ph;
idinor	0:dcf3c92487ca	566	#ifdef PPPOE_TERM_UNKNOWN_SESSIONS
idinor	0:dcf3c92487ca	567	u8_t shost[ETHER_ADDR_LEN];
idinor	0:dcf3c92487ca	568	#endif
idinor	0:dcf3c92487ca	569
idinor	0:dcf3c92487ca	570	#ifdef PPPOE_TERM_UNKNOWN_SESSIONS
idinor	0:dcf3c92487ca	571	MEMCPY(shost, ((struct eth_hdr *)pb->payload)->src.addr, sizeof(shost));
idinor	0:dcf3c92487ca	572	#endif
idinor	0:dcf3c92487ca	573	if (pbuf_header(pb, -(int)sizeof(struct eth_hdr)) != 0) {
idinor	0:dcf3c92487ca	574	/* bail out */
idinor	0:dcf3c92487ca	575	PPPDEBUG(LOG_ERR, ("pppoe_data_input: pbuf_header failed\n"));
idinor	0:dcf3c92487ca	576	LINK_STATS_INC(link.lenerr);
idinor	0:dcf3c92487ca	577	goto drop;
idinor	0:dcf3c92487ca	578	}
idinor	0:dcf3c92487ca	579
idinor	0:dcf3c92487ca	580	pb = pppSingleBuf (pb);
idinor	0:dcf3c92487ca	581
idinor	0:dcf3c92487ca	582	if (pb->len <= PPPOE_HEADERLEN) {
idinor	0:dcf3c92487ca	583	printf("pppoe (data): dropping too short packet: %d bytes\n", pb->len);
idinor	0:dcf3c92487ca	584	goto drop;
idinor	0:dcf3c92487ca	585	}
idinor	0:dcf3c92487ca	586
idinor	0:dcf3c92487ca	587	if (pb->len < sizeof(*ph)) {
idinor	0:dcf3c92487ca	588	printf("pppoe_data_input: could not get PPPoE header\n");
idinor	0:dcf3c92487ca	589	goto drop;
idinor	0:dcf3c92487ca	590	}
idinor	0:dcf3c92487ca	591	ph = (struct pppoehdr *)pb->payload;
idinor	0:dcf3c92487ca	592
idinor	0:dcf3c92487ca	593	if (ph->vertype != PPPOE_VERTYPE) {
idinor	0:dcf3c92487ca	594	printf("pppoe (data): unknown version/type packet: 0x%x\n", ph->vertype);
idinor	0:dcf3c92487ca	595	goto drop;
idinor	0:dcf3c92487ca	596	}
idinor	0:dcf3c92487ca	597	if (ph->code != 0) {
idinor	0:dcf3c92487ca	598	goto drop;
idinor	0:dcf3c92487ca	599	}
idinor	0:dcf3c92487ca	600
idinor	0:dcf3c92487ca	601	session = ntohs(ph->session);
idinor	0:dcf3c92487ca	602	sc = pppoe_find_softc_by_session(session, netif);
idinor	0:dcf3c92487ca	603	if (sc == NULL) {
idinor	0:dcf3c92487ca	604	#ifdef PPPOE_TERM_UNKNOWN_SESSIONS
idinor	0:dcf3c92487ca	605	printf("pppoe: input for unknown session 0x%x, sending PADT\n", session);
idinor	0:dcf3c92487ca	606	pppoe_send_padt(netif, session, shost);
idinor	0:dcf3c92487ca	607	#endif
idinor	0:dcf3c92487ca	608	goto drop;
idinor	0:dcf3c92487ca	609	}
idinor	0:dcf3c92487ca	610
idinor	0:dcf3c92487ca	611	plen = ntohs(ph->plen);
idinor	0:dcf3c92487ca	612
idinor	0:dcf3c92487ca	613	if (pbuf_header(pb, -(int)(PPPOE_HEADERLEN)) != 0) {
idinor	0:dcf3c92487ca	614	/* bail out */
idinor	0:dcf3c92487ca	615	PPPDEBUG(LOG_ERR, ("pppoe_data_input: pbuf_header PPPOE_HEADERLEN failed\n"));
idinor	0:dcf3c92487ca	616	LINK_STATS_INC(link.lenerr);
idinor	0:dcf3c92487ca	617	goto drop;
idinor	0:dcf3c92487ca	618	}
idinor	0:dcf3c92487ca	619
idinor	0:dcf3c92487ca	620	PPPDEBUG(LOG_DEBUG, ("pppoe_data_input: %c%c%"U16_F": pkthdr.len=%d, pppoe.len=%d\n",
idinor	0:dcf3c92487ca	621	sc->sc_ethif->name[0], sc->sc_ethif->name[1], sc->sc_ethif->num,
idinor	0:dcf3c92487ca	622	pb->len, plen));
idinor	0:dcf3c92487ca	623
idinor	0:dcf3c92487ca	624	if (pb->len < plen) {
idinor	0:dcf3c92487ca	625	goto drop;
idinor	0:dcf3c92487ca	626	}
idinor	0:dcf3c92487ca	627
idinor	0:dcf3c92487ca	628	pppInProcOverEthernet(sc->sc_pd, pb);
idinor	0:dcf3c92487ca	629
idinor	0:dcf3c92487ca	630	return;
idinor	0:dcf3c92487ca	631
idinor	0:dcf3c92487ca	632	drop:
idinor	0:dcf3c92487ca	633	pbuf_free(pb);
idinor	0:dcf3c92487ca	634	}
idinor	0:dcf3c92487ca	635
idinor	0:dcf3c92487ca	636	static err_t
idinor	0:dcf3c92487ca	637	pppoe_output(struct pppoe_softc sc, struct pbuf pb)
idinor	0:dcf3c92487ca	638	{
idinor	0:dcf3c92487ca	639	struct eth_hdr *ethhdr;
idinor	0:dcf3c92487ca	640	u16_t etype;
idinor	0:dcf3c92487ca	641	err_t res;
idinor	0:dcf3c92487ca	642
idinor	0:dcf3c92487ca	643	if (!sc->sc_ethif) {
idinor	0:dcf3c92487ca	644	pbuf_free(pb);
idinor	0:dcf3c92487ca	645	return ERR_IF;
idinor	0:dcf3c92487ca	646	}
idinor	0:dcf3c92487ca	647
idinor	0:dcf3c92487ca	648	ethhdr = (struct eth_hdr *)pb->payload;
idinor	0:dcf3c92487ca	649	etype = sc->sc_state == PPPOE_STATE_SESSION ? ETHTYPE_PPPOE : ETHTYPE_PPPOEDISC;
idinor	0:dcf3c92487ca	650	ethhdr->type = htons(etype);
idinor	0:dcf3c92487ca	651	MEMCPY(ethhdr->dest.addr, sc->sc_dest.addr, sizeof(ethhdr->dest.addr));
idinor	0:dcf3c92487ca	652	MEMCPY(ethhdr->src.addr, ((struct eth_addr *)sc->sc_ethif->hwaddr)->addr, sizeof(ethhdr->src.addr));
idinor	0:dcf3c92487ca	653
idinor	0:dcf3c92487ca	654	PPPDEBUG(LOG_DEBUG, ("pppoe: %c%c%"U16_F" (%x) state=%d, session=0x%x output -> %02"X16_F":%02"X16_F":%02"X16_F":%02"X16_F":%02"X16_F":%02"X16_F", len=%d\n",
idinor	0:dcf3c92487ca	655	sc->sc_ethif->name[0], sc->sc_ethif->name[1], sc->sc_ethif->num, etype,
idinor	0:dcf3c92487ca	656	sc->sc_state, sc->sc_session,
idinor	0:dcf3c92487ca	657	sc->sc_dest.addr[0], sc->sc_dest.addr[1], sc->sc_dest.addr[2], sc->sc_dest.addr[3], sc->sc_dest.addr[4], sc->sc_dest.addr[5],
idinor	0:dcf3c92487ca	658	pb->tot_len));
idinor	0:dcf3c92487ca	659
idinor	0:dcf3c92487ca	660	res = sc->sc_ethif->linkoutput(sc->sc_ethif, pb);
idinor	0:dcf3c92487ca	661
idinor	0:dcf3c92487ca	662	pbuf_free(pb);
idinor	0:dcf3c92487ca	663
idinor	0:dcf3c92487ca	664	return res;
idinor	0:dcf3c92487ca	665	}
idinor	0:dcf3c92487ca	666
idinor	0:dcf3c92487ca	667	static err_t
idinor	0:dcf3c92487ca	668	pppoe_send_padi(struct pppoe_softc *sc)
idinor	0:dcf3c92487ca	669	{
idinor	0:dcf3c92487ca	670	struct pbuf *pb;
idinor	0:dcf3c92487ca	671	u8_t *p;
idinor	0:dcf3c92487ca	672	int len;
idinor	0:dcf3c92487ca	673	#ifdef PPPOE_TODO
idinor	0:dcf3c92487ca	674	int l1 = 0, l2 = 0; /* XXX: gcc */
idinor	0:dcf3c92487ca	675	#endif /* PPPOE_TODO */
idinor	0:dcf3c92487ca	676
idinor	0:dcf3c92487ca	677	if (sc->sc_state >PPPOE_STATE_PADI_SENT) {
idinor	0:dcf3c92487ca	678	PPPDEBUG(LOG_ERR, ("ERROR: pppoe_send_padi in state %d", sc->sc_state));
idinor	0:dcf3c92487ca	679	}
idinor	0:dcf3c92487ca	680
idinor	0:dcf3c92487ca	681	/* calculate length of frame (excluding ethernet header + pppoe header) */
idinor	0:dcf3c92487ca	682	len = 2 + 2 + 2 + 2 + sizeof sc; /* service name tag is required, host unique is send too */
idinor	0:dcf3c92487ca	683	#ifdef PPPOE_TODO
idinor	0:dcf3c92487ca	684	if (sc->sc_service_name != NULL) {
idinor	0:dcf3c92487ca	685	l1 = (int)strlen(sc->sc_service_name);
idinor	0:dcf3c92487ca	686	len += l1;
idinor	0:dcf3c92487ca	687	}
idinor	0:dcf3c92487ca	688	if (sc->sc_concentrator_name != NULL) {
idinor	0:dcf3c92487ca	689	l2 = (int)strlen(sc->sc_concentrator_name);
idinor	0:dcf3c92487ca	690	len += 2 + 2 + l2;
idinor	0:dcf3c92487ca	691	}
idinor	0:dcf3c92487ca	692	#endif /* PPPOE_TODO */
idinor	0:dcf3c92487ca	693	LWIP_ASSERT("sizeof(struct eth_hdr) + PPPOE_HEADERLEN + len <= 0xffff",
idinor	0:dcf3c92487ca	694	sizeof(struct eth_hdr) + PPPOE_HEADERLEN + len <= 0xffff);
idinor	0:dcf3c92487ca	695
idinor	0:dcf3c92487ca	696	/* allocate a buffer */
idinor	0:dcf3c92487ca	697	pb = pbuf_alloc(PBUF_LINK, (u16_t)(sizeof(struct eth_hdr) + PPPOE_HEADERLEN + len), PBUF_RAM);
idinor	0:dcf3c92487ca	698	if (!pb) {
idinor	0:dcf3c92487ca	699	return ERR_MEM;
idinor	0:dcf3c92487ca	700	}
idinor	0:dcf3c92487ca	701	LWIP_ASSERT("pb->tot_len == pb->len", pb->tot_len == pb->len);
idinor	0:dcf3c92487ca	702
idinor	0:dcf3c92487ca	703	p = (u8_t*)pb->payload + sizeof (struct eth_hdr);
idinor	0:dcf3c92487ca	704	/* fill in pkt */
idinor	0:dcf3c92487ca	705	PPPOE_ADD_HEADER(p, PPPOE_CODE_PADI, 0, (u16_t)len);
idinor	0:dcf3c92487ca	706	PPPOE_ADD_16(p, PPPOE_TAG_SNAME);
idinor	0:dcf3c92487ca	707	#ifdef PPPOE_TODO
idinor	0:dcf3c92487ca	708	if (sc->sc_service_name != NULL) {
idinor	0:dcf3c92487ca	709	PPPOE_ADD_16(p, l1);
idinor	0:dcf3c92487ca	710	MEMCPY(p, sc->sc_service_name, l1);
idinor	0:dcf3c92487ca	711	p += l1;
idinor	0:dcf3c92487ca	712	} else
idinor	0:dcf3c92487ca	713	#endif /* PPPOE_TODO */
idinor	0:dcf3c92487ca	714	{
idinor	0:dcf3c92487ca	715	PPPOE_ADD_16(p, 0);
idinor	0:dcf3c92487ca	716	}
idinor	0:dcf3c92487ca	717	#ifdef PPPOE_TODO
idinor	0:dcf3c92487ca	718	if (sc->sc_concentrator_name != NULL) {
idinor	0:dcf3c92487ca	719	PPPOE_ADD_16(p, PPPOE_TAG_ACNAME);
idinor	0:dcf3c92487ca	720	PPPOE_ADD_16(p, l2);
idinor	0:dcf3c92487ca	721	MEMCPY(p, sc->sc_concentrator_name, l2);
idinor	0:dcf3c92487ca	722	p += l2;
idinor	0:dcf3c92487ca	723	}
idinor	0:dcf3c92487ca	724	#endif /* PPPOE_TODO */
idinor	0:dcf3c92487ca	725	PPPOE_ADD_16(p, PPPOE_TAG_HUNIQUE);
idinor	0:dcf3c92487ca	726	PPPOE_ADD_16(p, sizeof(sc));
idinor	0:dcf3c92487ca	727	MEMCPY(p, &sc, sizeof sc);
idinor	0:dcf3c92487ca	728
idinor	0:dcf3c92487ca	729	/* send pkt */
idinor	0:dcf3c92487ca	730	return pppoe_output(sc, pb);
idinor	0:dcf3c92487ca	731	}
idinor	0:dcf3c92487ca	732
idinor	0:dcf3c92487ca	733	static void
idinor	0:dcf3c92487ca	734	pppoe_timeout(void *arg)
idinor	0:dcf3c92487ca	735	{
idinor	0:dcf3c92487ca	736	int retry_wait, err;
idinor	0:dcf3c92487ca	737	struct pppoe_softc sc = (struct pppoe_softc)arg;
idinor	0:dcf3c92487ca	738
idinor	0:dcf3c92487ca	739	PPPDEBUG(LOG_DEBUG, ("pppoe: %c%c%"U16_F": timeout\n", sc->sc_ethif->name[0], sc->sc_ethif->name[1], sc->sc_ethif->num));
idinor	0:dcf3c92487ca	740
idinor	0:dcf3c92487ca	741	switch (sc->sc_state) {
idinor	0:dcf3c92487ca	742	case PPPOE_STATE_PADI_SENT:
idinor	0:dcf3c92487ca	743	/*
idinor	0:dcf3c92487ca	744	* We have two basic ways of retrying:
idinor	0:dcf3c92487ca	745	* - Quick retry mode: try a few times in short sequence
idinor	0:dcf3c92487ca	746	* - Slow retry mode: we already had a connection successfully
idinor	0:dcf3c92487ca	747	* established and will try infinitely (without user
idinor	0:dcf3c92487ca	748	* intervention)
idinor	0:dcf3c92487ca	749	* We only enter slow retry mode if IFF_LINK1 (aka autodial)
idinor	0:dcf3c92487ca	750	* is not set.
idinor	0:dcf3c92487ca	751	*/
idinor	0:dcf3c92487ca	752
idinor	0:dcf3c92487ca	753	/* initialize for quick retry mode */
idinor	0:dcf3c92487ca	754	retry_wait = PPPOE_DISC_TIMEOUT * (1 + sc->sc_padi_retried);
idinor	0:dcf3c92487ca	755
idinor	0:dcf3c92487ca	756	sc->sc_padi_retried++;
idinor	0:dcf3c92487ca	757	if (sc->sc_padi_retried >= PPPOE_DISC_MAXPADI) {
idinor	0:dcf3c92487ca	758	#if 0
idinor	0:dcf3c92487ca	759	if ((sc->sc_sppp.pp_if.if_flags & IFF_LINK1) == 0) {
idinor	0:dcf3c92487ca	760	/* slow retry mode */
idinor	0:dcf3c92487ca	761	retry_wait = PPPOE_SLOW_RETRY;
idinor	0:dcf3c92487ca	762	} else
idinor	0:dcf3c92487ca	763	#endif
idinor	0:dcf3c92487ca	764	{
idinor	0:dcf3c92487ca	765	pppoe_abort_connect(sc);
idinor	0:dcf3c92487ca	766	return;
idinor	0:dcf3c92487ca	767	}
idinor	0:dcf3c92487ca	768	}
idinor	0:dcf3c92487ca	769	if ((err = pppoe_send_padi(sc)) != 0) {
idinor	0:dcf3c92487ca	770	sc->sc_padi_retried--;
idinor	0:dcf3c92487ca	771	PPPDEBUG(LOG_DEBUG, ("pppoe: %c%c%"U16_F": failed to transmit PADI, error=%d\n", sc->sc_ethif->name[0], sc->sc_ethif->name[1], sc->sc_ethif->num, err));
idinor	0:dcf3c92487ca	772	}
idinor	0:dcf3c92487ca	773	sys_timeout(retry_wait, pppoe_timeout, sc);
idinor	0:dcf3c92487ca	774	break;
idinor	0:dcf3c92487ca	775
idinor	0:dcf3c92487ca	776	case PPPOE_STATE_PADR_SENT:
idinor	0:dcf3c92487ca	777	sc->sc_padr_retried++;
idinor	0:dcf3c92487ca	778	if (sc->sc_padr_retried >= PPPOE_DISC_MAXPADR) {
idinor	0:dcf3c92487ca	779	MEMCPY(&sc->sc_dest, ethbroadcast.addr, sizeof(sc->sc_dest));
idinor	0:dcf3c92487ca	780	sc->sc_state = PPPOE_STATE_PADI_SENT;
idinor	0:dcf3c92487ca	781	sc->sc_padr_retried = 0;
idinor	0:dcf3c92487ca	782	if ((err = pppoe_send_padi(sc)) != 0) {
idinor	0:dcf3c92487ca	783	PPPDEBUG(LOG_DEBUG, ("pppoe: %c%c%"U16_F": failed to send PADI, error=%d\n", sc->sc_ethif->name[0], sc->sc_ethif->name[1], sc->sc_ethif->num, err));
idinor	0:dcf3c92487ca	784	}
idinor	0:dcf3c92487ca	785	sys_timeout(PPPOE_DISC_TIMEOUT * (1 + sc->sc_padi_retried), pppoe_timeout, sc);
idinor	0:dcf3c92487ca	786	return;
idinor	0:dcf3c92487ca	787	}
idinor	0:dcf3c92487ca	788	if ((err = pppoe_send_padr(sc)) != 0) {
idinor	0:dcf3c92487ca	789	sc->sc_padr_retried--;
idinor	0:dcf3c92487ca	790	PPPDEBUG(LOG_DEBUG, ("pppoe: %c%c%"U16_F": failed to send PADR, error=%d\n", sc->sc_ethif->name[0], sc->sc_ethif->name[1], sc->sc_ethif->num, err));
idinor	0:dcf3c92487ca	791	}
idinor	0:dcf3c92487ca	792	sys_timeout(PPPOE_DISC_TIMEOUT * (1 + sc->sc_padr_retried), pppoe_timeout, sc);
idinor	0:dcf3c92487ca	793	break;
idinor	0:dcf3c92487ca	794	case PPPOE_STATE_CLOSING:
idinor	0:dcf3c92487ca	795	pppoe_do_disconnect(sc);
idinor	0:dcf3c92487ca	796	break;
idinor	0:dcf3c92487ca	797	default:
idinor	0:dcf3c92487ca	798	return; /* all done, work in peace */
idinor	0:dcf3c92487ca	799	}
idinor	0:dcf3c92487ca	800	}
idinor	0:dcf3c92487ca	801
idinor	0:dcf3c92487ca	802	/* Start a connection (i.e. initiate discovery phase) */
idinor	0:dcf3c92487ca	803	int
idinor	0:dcf3c92487ca	804	pppoe_connect(struct pppoe_softc *sc)
idinor	0:dcf3c92487ca	805	{
idinor	0:dcf3c92487ca	806	int err;
idinor	0:dcf3c92487ca	807
idinor	0:dcf3c92487ca	808	if (sc->sc_state != PPPOE_STATE_INITIAL) {
idinor	0:dcf3c92487ca	809	return EBUSY;
idinor	0:dcf3c92487ca	810	}
idinor	0:dcf3c92487ca	811
idinor	0:dcf3c92487ca	812	#ifdef PPPOE_SERVER
idinor	0:dcf3c92487ca	813	/* wait PADI if IFF_PASSIVE */
idinor	0:dcf3c92487ca	814	if ((sc->sc_sppp.pp_if.if_flags & IFF_PASSIVE)) {
idinor	0:dcf3c92487ca	815	return 0;
idinor	0:dcf3c92487ca	816	}
idinor	0:dcf3c92487ca	817	#endif
idinor	0:dcf3c92487ca	818	/* save state, in case we fail to send PADI */
idinor	0:dcf3c92487ca	819	sc->sc_state = PPPOE_STATE_PADI_SENT;
idinor	0:dcf3c92487ca	820	sc->sc_padr_retried = 0;
idinor	0:dcf3c92487ca	821	err = pppoe_send_padi(sc);
idinor	0:dcf3c92487ca	822	PPPDEBUG(LOG_DEBUG, ("pppoe: %c%c%"U16_F": failed to send PADI, error=%d\n", sc->sc_ethif->name[0], sc->sc_ethif->name[1], sc->sc_ethif->num, err));
idinor	0:dcf3c92487ca	823	sys_timeout(PPPOE_DISC_TIMEOUT, pppoe_timeout, sc);
idinor	0:dcf3c92487ca	824	return err;
idinor	0:dcf3c92487ca	825	}
idinor	0:dcf3c92487ca	826
idinor	0:dcf3c92487ca	827	/* disconnect */
idinor	0:dcf3c92487ca	828	void
idinor	0:dcf3c92487ca	829	pppoe_disconnect(struct pppoe_softc *sc)
idinor	0:dcf3c92487ca	830	{
idinor	0:dcf3c92487ca	831	if (sc->sc_state < PPPOE_STATE_SESSION) {
idinor	0:dcf3c92487ca	832	return;
idinor	0:dcf3c92487ca	833	}
idinor	0:dcf3c92487ca	834	/*
idinor	0:dcf3c92487ca	835	* Do not call pppoe_disconnect here, the upper layer state
idinor	0:dcf3c92487ca	836	* machine gets confused by this. We must return from this
idinor	0:dcf3c92487ca	837	* function and defer disconnecting to the timeout handler.
idinor	0:dcf3c92487ca	838	*/
idinor	0:dcf3c92487ca	839	sc->sc_state = PPPOE_STATE_CLOSING;
idinor	0:dcf3c92487ca	840	sys_timeout(20, pppoe_timeout, sc);
idinor	0:dcf3c92487ca	841	}
idinor	0:dcf3c92487ca	842
idinor	0:dcf3c92487ca	843	static int
idinor	0:dcf3c92487ca	844	pppoe_do_disconnect(struct pppoe_softc *sc)
idinor	0:dcf3c92487ca	845	{
idinor	0:dcf3c92487ca	846	int err;
idinor	0:dcf3c92487ca	847
idinor	0:dcf3c92487ca	848	if (sc->sc_state < PPPOE_STATE_SESSION) {
idinor	0:dcf3c92487ca	849	err = EBUSY;
idinor	0:dcf3c92487ca	850	} else {
idinor	0:dcf3c92487ca	851	PPPDEBUG(LOG_DEBUG, ("pppoe: %c%c%"U16_F": disconnecting\n", sc->sc_ethif->name[0], sc->sc_ethif->name[1], sc->sc_ethif->num));
idinor	0:dcf3c92487ca	852	err = pppoe_send_padt(sc->sc_ethif, sc->sc_session, (const u8_t *)&sc->sc_dest);
idinor	0:dcf3c92487ca	853	}
idinor	0:dcf3c92487ca	854
idinor	0:dcf3c92487ca	855	/* cleanup softc */
idinor	0:dcf3c92487ca	856	sc->sc_state = PPPOE_STATE_INITIAL;
idinor	0:dcf3c92487ca	857	MEMCPY(&sc->sc_dest, ethbroadcast.addr, sizeof(sc->sc_dest));
idinor	0:dcf3c92487ca	858	sc->sc_ac_cookie_len = 0;
idinor	0:dcf3c92487ca	859	#ifdef PPPOE_SERVER
idinor	0:dcf3c92487ca	860	if (sc->sc_hunique) {
idinor	0:dcf3c92487ca	861	mem_free(sc->sc_hunique);
idinor	0:dcf3c92487ca	862	sc->sc_hunique = NULL;
idinor	0:dcf3c92487ca	863	}
idinor	0:dcf3c92487ca	864	sc->sc_hunique_len = 0;
idinor	0:dcf3c92487ca	865	#endif
idinor	0:dcf3c92487ca	866	sc->sc_session = 0;
idinor	0:dcf3c92487ca	867
idinor	0:dcf3c92487ca	868	sc->sc_linkStatusCB(sc->sc_pd, 0); /* notify upper layers */
idinor	0:dcf3c92487ca	869
idinor	0:dcf3c92487ca	870	return err;
idinor	0:dcf3c92487ca	871	}
idinor	0:dcf3c92487ca	872
idinor	0:dcf3c92487ca	873	/* Connection attempt aborted */
idinor	0:dcf3c92487ca	874	static void
idinor	0:dcf3c92487ca	875	pppoe_abort_connect(struct pppoe_softc *sc)
idinor	0:dcf3c92487ca	876	{
idinor	0:dcf3c92487ca	877	printf("%c%c%"U16_F": could not establish connection\n", sc->sc_ethif->name[0], sc->sc_ethif->name[1], sc->sc_ethif->num);
idinor	0:dcf3c92487ca	878	sc->sc_state = PPPOE_STATE_CLOSING;
idinor	0:dcf3c92487ca	879
idinor	0:dcf3c92487ca	880	sc->sc_linkStatusCB(sc->sc_pd, 0); /* notify upper layers */
idinor	0:dcf3c92487ca	881
idinor	0:dcf3c92487ca	882	/* clear connection state */
idinor	0:dcf3c92487ca	883	MEMCPY(&sc->sc_dest, ethbroadcast.addr, sizeof(sc->sc_dest));
idinor	0:dcf3c92487ca	884	sc->sc_state = PPPOE_STATE_INITIAL;
idinor	0:dcf3c92487ca	885	}
idinor	0:dcf3c92487ca	886
idinor	0:dcf3c92487ca	887	/* Send a PADR packet */
idinor	0:dcf3c92487ca	888	static err_t
idinor	0:dcf3c92487ca	889	pppoe_send_padr(struct pppoe_softc *sc)
idinor	0:dcf3c92487ca	890	{
idinor	0:dcf3c92487ca	891	struct pbuf *pb;
idinor	0:dcf3c92487ca	892	u8_t *p;
idinor	0:dcf3c92487ca	893	size_t len;
idinor	0:dcf3c92487ca	894	#ifdef PPPOE_TODO
idinor	0:dcf3c92487ca	895	size_t l1 = 0; /* XXX: gcc */
idinor	0:dcf3c92487ca	896	#endif /* PPPOE_TODO */
idinor	0:dcf3c92487ca	897
idinor	0:dcf3c92487ca	898	if (sc->sc_state != PPPOE_STATE_PADR_SENT) {
idinor	0:dcf3c92487ca	899	return ERR_CONN;
idinor	0:dcf3c92487ca	900	}
idinor	0:dcf3c92487ca	901
idinor	0:dcf3c92487ca	902	len = 2 + 2 + 2 + 2 + sizeof(sc); /* service name, host unique */
idinor	0:dcf3c92487ca	903	#ifdef PPPOE_TODO
idinor	0:dcf3c92487ca	904	if (sc->sc_service_name != NULL) { /* service name tag maybe empty */
idinor	0:dcf3c92487ca	905	l1 = strlen(sc->sc_service_name);
idinor	0:dcf3c92487ca	906	len += l1;
idinor	0:dcf3c92487ca	907	}
idinor	0:dcf3c92487ca	908	#endif /* PPPOE_TODO */
idinor	0:dcf3c92487ca	909	if (sc->sc_ac_cookie_len > 0) {
idinor	0:dcf3c92487ca	910	len += 2 + 2 + sc->sc_ac_cookie_len; /* AC cookie */
idinor	0:dcf3c92487ca	911	}
idinor	0:dcf3c92487ca	912	LWIP_ASSERT("sizeof(struct eth_hdr) + PPPOE_HEADERLEN + len <= 0xffff",
idinor	0:dcf3c92487ca	913	sizeof(struct eth_hdr) + PPPOE_HEADERLEN + len <= 0xffff);
idinor	0:dcf3c92487ca	914	pb = pbuf_alloc(PBUF_LINK, (u16_t)(sizeof(struct eth_hdr) + PPPOE_HEADERLEN + len), PBUF_RAM);
idinor	0:dcf3c92487ca	915	if (!pb) {
idinor	0:dcf3c92487ca	916	return ERR_MEM;
idinor	0:dcf3c92487ca	917	}
idinor	0:dcf3c92487ca	918	LWIP_ASSERT("pb->tot_len == pb->len", pb->tot_len == pb->len);
idinor	0:dcf3c92487ca	919	p = (u8_t*)pb->payload + sizeof (struct eth_hdr);
idinor	0:dcf3c92487ca	920	PPPOE_ADD_HEADER(p, PPPOE_CODE_PADR, 0, len);
idinor	0:dcf3c92487ca	921	PPPOE_ADD_16(p, PPPOE_TAG_SNAME);
idinor	0:dcf3c92487ca	922	#ifdef PPPOE_TODO
idinor	0:dcf3c92487ca	923	if (sc->sc_service_name != NULL) {
idinor	0:dcf3c92487ca	924	PPPOE_ADD_16(p, l1);
idinor	0:dcf3c92487ca	925	MEMCPY(p, sc->sc_service_name, l1);
idinor	0:dcf3c92487ca	926	p += l1;
idinor	0:dcf3c92487ca	927	} else
idinor	0:dcf3c92487ca	928	#endif /* PPPOE_TODO */
idinor	0:dcf3c92487ca	929	{
idinor	0:dcf3c92487ca	930	PPPOE_ADD_16(p, 0);
idinor	0:dcf3c92487ca	931	}
idinor	0:dcf3c92487ca	932	if (sc->sc_ac_cookie_len > 0) {
idinor	0:dcf3c92487ca	933	PPPOE_ADD_16(p, PPPOE_TAG_ACCOOKIE);
idinor	0:dcf3c92487ca	934	PPPOE_ADD_16(p, sc->sc_ac_cookie_len);
idinor	0:dcf3c92487ca	935	MEMCPY(p, sc->sc_ac_cookie, sc->sc_ac_cookie_len);
idinor	0:dcf3c92487ca	936	p += sc->sc_ac_cookie_len;
idinor	0:dcf3c92487ca	937	}
idinor	0:dcf3c92487ca	938	PPPOE_ADD_16(p, PPPOE_TAG_HUNIQUE);
idinor	0:dcf3c92487ca	939	PPPOE_ADD_16(p, sizeof(sc));
idinor	0:dcf3c92487ca	940	MEMCPY(p, &sc, sizeof sc);
idinor	0:dcf3c92487ca	941
idinor	0:dcf3c92487ca	942	return pppoe_output(sc, pb);
idinor	0:dcf3c92487ca	943	}
idinor	0:dcf3c92487ca	944
idinor	0:dcf3c92487ca	945	/* send a PADT packet */
idinor	0:dcf3c92487ca	946	static err_t
idinor	0:dcf3c92487ca	947	pppoe_send_padt(struct netif outgoing_if, u_int session, const u8_t dest)
idinor	0:dcf3c92487ca	948	{
idinor	0:dcf3c92487ca	949	struct pbuf *pb;
idinor	0:dcf3c92487ca	950	struct eth_hdr *ethhdr;
idinor	0:dcf3c92487ca	951	err_t res;
idinor	0:dcf3c92487ca	952	u8_t *p;
idinor	0:dcf3c92487ca	953
idinor	0:dcf3c92487ca	954	pb = pbuf_alloc(PBUF_LINK, sizeof(struct eth_hdr) + PPPOE_HEADERLEN, PBUF_RAM);
idinor	0:dcf3c92487ca	955	if (!pb) {
idinor	0:dcf3c92487ca	956	return ERR_MEM;
idinor	0:dcf3c92487ca	957	}
idinor	0:dcf3c92487ca	958	LWIP_ASSERT("pb->tot_len == pb->len", pb->tot_len == pb->len);
idinor	0:dcf3c92487ca	959
idinor	0:dcf3c92487ca	960	ethhdr = (struct eth_hdr *)pb->payload;
idinor	0:dcf3c92487ca	961	ethhdr->type = PP_HTONS(ETHTYPE_PPPOEDISC);
idinor	0:dcf3c92487ca	962	MEMCPY(ethhdr->dest.addr, dest, sizeof(ethhdr->dest.addr));
idinor	0:dcf3c92487ca	963	MEMCPY(ethhdr->src.addr, ((struct eth_addr *)outgoing_if->hwaddr)->addr, sizeof(ethhdr->src.addr));
idinor	0:dcf3c92487ca	964
idinor	0:dcf3c92487ca	965	p = (u8_t*)(ethhdr + 1);
idinor	0:dcf3c92487ca	966	PPPOE_ADD_HEADER(p, PPPOE_CODE_PADT, session, 0);
idinor	0:dcf3c92487ca	967
idinor	0:dcf3c92487ca	968	res = outgoing_if->linkoutput(outgoing_if, pb);
idinor	0:dcf3c92487ca	969
idinor	0:dcf3c92487ca	970	pbuf_free(pb);
idinor	0:dcf3c92487ca	971
idinor	0:dcf3c92487ca	972	return res;
idinor	0:dcf3c92487ca	973	}
idinor	0:dcf3c92487ca	974
idinor	0:dcf3c92487ca	975	#ifdef PPPOE_SERVER
idinor	0:dcf3c92487ca	976	static err_t
idinor	0:dcf3c92487ca	977	pppoe_send_pado(struct pppoe_softc *sc)
idinor	0:dcf3c92487ca	978	{
idinor	0:dcf3c92487ca	979	struct pbuf *pb;
idinor	0:dcf3c92487ca	980	u8_t *p;
idinor	0:dcf3c92487ca	981	size_t len;
idinor	0:dcf3c92487ca	982
idinor	0:dcf3c92487ca	983	if (sc->sc_state != PPPOE_STATE_PADO_SENT) {
idinor	0:dcf3c92487ca	984	return ERR_CONN;
idinor	0:dcf3c92487ca	985	}
idinor	0:dcf3c92487ca	986
idinor	0:dcf3c92487ca	987	/* calc length */
idinor	0:dcf3c92487ca	988	len = 0;
idinor	0:dcf3c92487ca	989	/* include ac_cookie */
idinor	0:dcf3c92487ca	990	len += 2 + 2 + sizeof(sc);
idinor	0:dcf3c92487ca	991	/* include hunique */
idinor	0:dcf3c92487ca	992	len += 2 + 2 + sc->sc_hunique_len;
idinor	0:dcf3c92487ca	993	pb = pbuf_alloc(PBUF_LINK, sizeof(struct eth_hdr) + PPPOE_HEADERLEN + len, PBUF_RAM);
idinor	0:dcf3c92487ca	994	if (!pb) {
idinor	0:dcf3c92487ca	995	return ERR_MEM;
idinor	0:dcf3c92487ca	996	}
idinor	0:dcf3c92487ca	997	LWIP_ASSERT("pb->tot_len == pb->len", pb->tot_len == pb->len);
idinor	0:dcf3c92487ca	998	p = (u8_t*)pb->payload + sizeof (struct eth_hdr);
idinor	0:dcf3c92487ca	999	PPPOE_ADD_HEADER(p, PPPOE_CODE_PADO, 0, len);
idinor	0:dcf3c92487ca	1000	PPPOE_ADD_16(p, PPPOE_TAG_ACCOOKIE);
idinor	0:dcf3c92487ca	1001	PPPOE_ADD_16(p, sizeof(sc));
idinor	0:dcf3c92487ca	1002	MEMCPY(p, &sc, sizeof(sc));
idinor	0:dcf3c92487ca	1003	p += sizeof(sc);
idinor	0:dcf3c92487ca	1004	PPPOE_ADD_16(p, PPPOE_TAG_HUNIQUE);
idinor	0:dcf3c92487ca	1005	PPPOE_ADD_16(p, sc->sc_hunique_len);
idinor	0:dcf3c92487ca	1006	MEMCPY(p, sc->sc_hunique, sc->sc_hunique_len);
idinor	0:dcf3c92487ca	1007	return pppoe_output(sc, pb);
idinor	0:dcf3c92487ca	1008	}
idinor	0:dcf3c92487ca	1009
idinor	0:dcf3c92487ca	1010	static err_t
idinor	0:dcf3c92487ca	1011	pppoe_send_pads(struct pppoe_softc *sc)
idinor	0:dcf3c92487ca	1012	{
idinor	0:dcf3c92487ca	1013	struct pbuf *pb;
idinor	0:dcf3c92487ca	1014	u8_t *p;
idinor	0:dcf3c92487ca	1015	size_t len, l1 = 0; /* XXX: gcc */
idinor	0:dcf3c92487ca	1016
idinor	0:dcf3c92487ca	1017	if (sc->sc_state != PPPOE_STATE_PADO_SENT) {
idinor	0:dcf3c92487ca	1018	return ERR_CONN;
idinor	0:dcf3c92487ca	1019	}
idinor	0:dcf3c92487ca	1020
idinor	0:dcf3c92487ca	1021	sc->sc_session = mono_time.tv_sec % 0xff + 1;
idinor	0:dcf3c92487ca	1022	/* calc length */
idinor	0:dcf3c92487ca	1023	len = 0;
idinor	0:dcf3c92487ca	1024	/* include hunique */
idinor	0:dcf3c92487ca	1025	len += 2 + 2 + 2 + 2 + sc->sc_hunique_len; /* service name, host unique*/
idinor	0:dcf3c92487ca	1026	if (sc->sc_service_name != NULL) { /* service name tag maybe empty */
idinor	0:dcf3c92487ca	1027	l1 = strlen(sc->sc_service_name);
idinor	0:dcf3c92487ca	1028	len += l1;
idinor	0:dcf3c92487ca	1029	}
idinor	0:dcf3c92487ca	1030	pb = pbuf_alloc(PBUF_LINK, sizeof(struct eth_hdr) + PPPOE_HEADERLEN + len, PBUF_RAM);
idinor	0:dcf3c92487ca	1031	if (!pb) {
idinor	0:dcf3c92487ca	1032	return ERR_MEM;
idinor	0:dcf3c92487ca	1033	}
idinor	0:dcf3c92487ca	1034	LWIP_ASSERT("pb->tot_len == pb->len", pb->tot_len == pb->len);
idinor	0:dcf3c92487ca	1035	p = (u8_t*)pb->payload + sizeof (struct eth_hdr);
idinor	0:dcf3c92487ca	1036	PPPOE_ADD_HEADER(p, PPPOE_CODE_PADS, sc->sc_session, len);
idinor	0:dcf3c92487ca	1037	PPPOE_ADD_16(p, PPPOE_TAG_SNAME);
idinor	0:dcf3c92487ca	1038	if (sc->sc_service_name != NULL) {
idinor	0:dcf3c92487ca	1039	PPPOE_ADD_16(p, l1);
idinor	0:dcf3c92487ca	1040	MEMCPY(p, sc->sc_service_name, l1);
idinor	0:dcf3c92487ca	1041	p += l1;
idinor	0:dcf3c92487ca	1042	} else {
idinor	0:dcf3c92487ca	1043	PPPOE_ADD_16(p, 0);
idinor	0:dcf3c92487ca	1044	}
idinor	0:dcf3c92487ca	1045	PPPOE_ADD_16(p, PPPOE_TAG_HUNIQUE);
idinor	0:dcf3c92487ca	1046	PPPOE_ADD_16(p, sc->sc_hunique_len);
idinor	0:dcf3c92487ca	1047	MEMCPY(p, sc->sc_hunique, sc->sc_hunique_len);
idinor	0:dcf3c92487ca	1048	return pppoe_output(sc, pb);
idinor	0:dcf3c92487ca	1049	}
idinor	0:dcf3c92487ca	1050	#endif
idinor	0:dcf3c92487ca	1051
idinor	0:dcf3c92487ca	1052	err_t
idinor	0:dcf3c92487ca	1053	pppoe_xmit(struct pppoe_softc sc, struct pbuf pb)
idinor	0:dcf3c92487ca	1054	{
idinor	0:dcf3c92487ca	1055	u8_t *p;
idinor	0:dcf3c92487ca	1056	size_t len;
idinor	0:dcf3c92487ca	1057
idinor	0:dcf3c92487ca	1058	/* are we ready to process data yet? */
idinor	0:dcf3c92487ca	1059	if (sc->sc_state < PPPOE_STATE_SESSION) {
idinor	0:dcf3c92487ca	1060	/sppp_flush(&sc->sc_sppp.pp_if);/
idinor	0:dcf3c92487ca	1061	pbuf_free(pb);
idinor	0:dcf3c92487ca	1062	return ERR_CONN;
idinor	0:dcf3c92487ca	1063	}
idinor	0:dcf3c92487ca	1064
idinor	0:dcf3c92487ca	1065	len = pb->tot_len;
idinor	0:dcf3c92487ca	1066
idinor	0:dcf3c92487ca	1067	/* make room for Ethernet header - should not fail */
idinor	0:dcf3c92487ca	1068	if (pbuf_header(pb, sizeof(struct eth_hdr) + PPPOE_HEADERLEN) != 0) {
idinor	0:dcf3c92487ca	1069	/* bail out */
idinor	0:dcf3c92487ca	1070	PPPDEBUG(LOG_ERR, ("pppoe: %c%c%"U16_F": pppoe_xmit: could not allocate room for header\n", sc->sc_ethif->name[0], sc->sc_ethif->name[1], sc->sc_ethif->num));
idinor	0:dcf3c92487ca	1071	LINK_STATS_INC(link.lenerr);
idinor	0:dcf3c92487ca	1072	pbuf_free(pb);
idinor	0:dcf3c92487ca	1073	return ERR_BUF;
idinor	0:dcf3c92487ca	1074	}
idinor	0:dcf3c92487ca	1075
idinor	0:dcf3c92487ca	1076	p = (u8_t*)pb->payload + sizeof(struct eth_hdr);
idinor	0:dcf3c92487ca	1077	PPPOE_ADD_HEADER(p, 0, sc->sc_session, len);
idinor	0:dcf3c92487ca	1078
idinor	0:dcf3c92487ca	1079	return pppoe_output(sc, pb);
idinor	0:dcf3c92487ca	1080	}
idinor	0:dcf3c92487ca	1081
idinor	0:dcf3c92487ca	1082	#if 0 /def PFIL_HOOKS/
idinor	0:dcf3c92487ca	1083	static int
idinor	0:dcf3c92487ca	1084	pppoe_ifattach_hook(void arg, struct pbuf mp, struct netif ifp, int dir)
idinor	0:dcf3c92487ca	1085	{
idinor	0:dcf3c92487ca	1086	struct pppoe_softc *sc;
idinor	0:dcf3c92487ca	1087	int s;
idinor	0:dcf3c92487ca	1088
idinor	0:dcf3c92487ca	1089	if (mp != (struct pbuf **)PFIL_IFNET_DETACH) {
idinor	0:dcf3c92487ca	1090	return 0;
idinor	0:dcf3c92487ca	1091	}
idinor	0:dcf3c92487ca	1092
idinor	0:dcf3c92487ca	1093	LIST_FOREACH(sc, &pppoe_softc_list, sc_list) {
idinor	0:dcf3c92487ca	1094	if (sc->sc_ethif != ifp) {
idinor	0:dcf3c92487ca	1095	continue;
idinor	0:dcf3c92487ca	1096	}
idinor	0:dcf3c92487ca	1097	if (sc->sc_sppp.pp_if.if_flags & IFF_UP) {
idinor	0:dcf3c92487ca	1098	sc->sc_sppp.pp_if.if_flags &= ~(IFF_UP\|IFF_RUNNING);
idinor	0:dcf3c92487ca	1099	printf("%c%c%"U16_F": ethernet interface detached, going down\n",
idinor	0:dcf3c92487ca	1100	sc->sc_ethif->name[0], sc->sc_ethif->name[1], sc->sc_ethif->num);
idinor	0:dcf3c92487ca	1101	}
idinor	0:dcf3c92487ca	1102	sc->sc_ethif = NULL;
idinor	0:dcf3c92487ca	1103	pppoe_clear_softc(sc, "ethernet interface detached");
idinor	0:dcf3c92487ca	1104	}
idinor	0:dcf3c92487ca	1105
idinor	0:dcf3c92487ca	1106	return 0;
idinor	0:dcf3c92487ca	1107	}
idinor	0:dcf3c92487ca	1108	#endif
idinor	0:dcf3c92487ca	1109
idinor	0:dcf3c92487ca	1110	static void
idinor	0:dcf3c92487ca	1111	pppoe_clear_softc(struct pppoe_softc sc, const char message)
idinor	0:dcf3c92487ca	1112	{
idinor	0:dcf3c92487ca	1113	LWIP_UNUSED_ARG(message);
idinor	0:dcf3c92487ca	1114
idinor	0:dcf3c92487ca	1115	/* stop timer */
idinor	0:dcf3c92487ca	1116	sys_untimeout(pppoe_timeout, sc);
idinor	0:dcf3c92487ca	1117	PPPDEBUG(LOG_DEBUG, ("pppoe: %c%c%"U16_F": session 0x%x terminated, %s\n", sc->sc_ethif->name[0], sc->sc_ethif->name[1], sc->sc_ethif->num, sc->sc_session, message));
idinor	0:dcf3c92487ca	1118
idinor	0:dcf3c92487ca	1119	/* fix our state */
idinor	0:dcf3c92487ca	1120	sc->sc_state = PPPOE_STATE_INITIAL;
idinor	0:dcf3c92487ca	1121
idinor	0:dcf3c92487ca	1122	/* notify upper layers */
idinor	0:dcf3c92487ca	1123	sc->sc_linkStatusCB(sc->sc_pd, 0);
idinor	0:dcf3c92487ca	1124
idinor	0:dcf3c92487ca	1125	/* clean up softc */
idinor	0:dcf3c92487ca	1126	MEMCPY(&sc->sc_dest, ethbroadcast.addr, sizeof(sc->sc_dest));
idinor	0:dcf3c92487ca	1127	sc->sc_ac_cookie_len = 0;
idinor	0:dcf3c92487ca	1128	sc->sc_session = 0;
idinor	0:dcf3c92487ca	1129	}
idinor	0:dcf3c92487ca	1130
idinor	0:dcf3c92487ca	1131	#endif /* PPPOE_SUPPORT */
idinor	0:dcf3c92487ca	1132

Repository toolbox

Export to desktop IDE

Repository details

Type:	Library
Created:	20 Jul 2011
Imports:	35
Forks:	0
Commits:	1
Dependents:	1
Dependencies:	0
Followers:	1

lwip/netif/ppp/ppp_oe.c@0:dcf3c92487ca, 2011-07-20 (annotated)

Who changed what in which revision?

Repository toolbox

Repository details

Important Information for this Arm website

Access Warning