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