AmpereMeter - Example self-announcing webserver which controls …

Users » dirkx » Code » AmpereMeter

Dirk-Willem van Gulik (NXP/mbed) / Mbed 2 deprecated AmpereMeter

Example self-announcing webserver which controls a servo through a smallHTML userinterface.

lwip/netif/ppp/ppp_oe.c@0:a259777c45a3, 2010-08-14 (annotated)

Committer:: dirkx
Date:: Sat Aug 14 15:56:01 2010 +0000
Revision:: 0:a259777c45a3

Who changed what in which revision?

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

Repository toolbox

Export to desktop IDE

Build repository

Repository details

Type:	Program
Mbed OS support:	Mbed 2 deprecated
Created:	14 Aug 2010
Imports:	49
Forks:	0
Commits:	1
Dependents:	0
Dependencies:	2
Followers:	1

lwip/netif/ppp/ppp_oe.c@0:a259777c45a3, 2010-08-14 (annotated)

Who changed what in which revision?

Repository toolbox

Repository details

Important Information for this Arm website

Access Warning