User | Revision | Line number | New contents of line |
mbed714 |
0:d616ece2d859
|
1
|
/*****************************************************************************
|
mbed714 |
0:d616ece2d859
|
2
|
* ppp.c - Network Point to Point Protocol program file.
|
mbed714 |
0:d616ece2d859
|
3
|
*
|
mbed714 |
0:d616ece2d859
|
4
|
* Copyright (c) 2003 by Marc Boucher, Services Informatiques (MBSI) inc.
|
mbed714 |
0:d616ece2d859
|
5
|
* portions Copyright (c) 1997 by Global Election Systems Inc.
|
mbed714 |
0:d616ece2d859
|
6
|
*
|
mbed714 |
0:d616ece2d859
|
7
|
* The authors hereby grant permission to use, copy, modify, distribute,
|
mbed714 |
0:d616ece2d859
|
8
|
* and license this software and its documentation for any purpose, provided
|
mbed714 |
0:d616ece2d859
|
9
|
* that existing copyright notices are retained in all copies and that this
|
mbed714 |
0:d616ece2d859
|
10
|
* notice and the following disclaimer are included verbatim in any
|
mbed714 |
0:d616ece2d859
|
11
|
* distributions. No written agreement, license, or royalty fee is required
|
mbed714 |
0:d616ece2d859
|
12
|
* for any of the authorized uses.
|
mbed714 |
0:d616ece2d859
|
13
|
*
|
mbed714 |
0:d616ece2d859
|
14
|
* THIS SOFTWARE IS PROVIDED BY THE CONTRIBUTORS *AS IS* AND ANY EXPRESS OR
|
mbed714 |
0:d616ece2d859
|
15
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
mbed714 |
0:d616ece2d859
|
16
|
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
mbed714 |
0:d616ece2d859
|
17
|
* IN NO EVENT SHALL THE CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
|
mbed714 |
0:d616ece2d859
|
18
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
mbed714 |
0:d616ece2d859
|
19
|
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
mbed714 |
0:d616ece2d859
|
20
|
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
mbed714 |
0:d616ece2d859
|
21
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
mbed714 |
0:d616ece2d859
|
22
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
mbed714 |
0:d616ece2d859
|
23
|
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
mbed714 |
0:d616ece2d859
|
24
|
*
|
mbed714 |
0:d616ece2d859
|
25
|
******************************************************************************
|
mbed714 |
0:d616ece2d859
|
26
|
* REVISION HISTORY
|
mbed714 |
0:d616ece2d859
|
27
|
*
|
mbed714 |
0:d616ece2d859
|
28
|
* 03-01-01 Marc Boucher <marc@mbsi.ca>
|
mbed714 |
0:d616ece2d859
|
29
|
* Ported to lwIP.
|
mbed714 |
0:d616ece2d859
|
30
|
* 97-11-05 Guy Lancaster <lancasterg@acm.org>, Global Election Systems Inc.
|
mbed714 |
0:d616ece2d859
|
31
|
* Original.
|
mbed714 |
0:d616ece2d859
|
32
|
*****************************************************************************/
|
mbed714 |
0:d616ece2d859
|
33
|
|
mbed714 |
0:d616ece2d859
|
34
|
/*
|
mbed714 |
0:d616ece2d859
|
35
|
* ppp_defs.h - PPP definitions.
|
mbed714 |
0:d616ece2d859
|
36
|
*
|
mbed714 |
0:d616ece2d859
|
37
|
* if_pppvar.h - private structures and declarations for PPP.
|
mbed714 |
0:d616ece2d859
|
38
|
*
|
mbed714 |
0:d616ece2d859
|
39
|
* Copyright (c) 1994 The Australian National University.
|
mbed714 |
0:d616ece2d859
|
40
|
* All rights reserved.
|
mbed714 |
0:d616ece2d859
|
41
|
*
|
mbed714 |
0:d616ece2d859
|
42
|
* Permission to use, copy, modify, and distribute this software and its
|
mbed714 |
0:d616ece2d859
|
43
|
* documentation is hereby granted, provided that the above copyright
|
mbed714 |
0:d616ece2d859
|
44
|
* notice appears in all copies. This software is provided without any
|
mbed714 |
0:d616ece2d859
|
45
|
* warranty, express or implied. The Australian National University
|
mbed714 |
0:d616ece2d859
|
46
|
* makes no representations about the suitability of this software for
|
mbed714 |
0:d616ece2d859
|
47
|
* any purpose.
|
mbed714 |
0:d616ece2d859
|
48
|
*
|
mbed714 |
0:d616ece2d859
|
49
|
* IN NO EVENT SHALL THE AUSTRALIAN NATIONAL UNIVERSITY BE LIABLE TO ANY
|
mbed714 |
0:d616ece2d859
|
50
|
* PARTY FOR DIRECT, INDIRECT, SPECIAL, INCIDENTAL, OR CONSEQUENTIAL DAMAGES
|
mbed714 |
0:d616ece2d859
|
51
|
* ARISING OUT OF THE USE OF THIS SOFTWARE AND ITS DOCUMENTATION, EVEN IF
|
mbed714 |
0:d616ece2d859
|
52
|
* THE AUSTRALIAN NATIONAL UNIVERSITY HAVE BEEN ADVISED OF THE POSSIBILITY
|
mbed714 |
0:d616ece2d859
|
53
|
* OF SUCH DAMAGE.
|
mbed714 |
0:d616ece2d859
|
54
|
*
|
mbed714 |
0:d616ece2d859
|
55
|
* THE AUSTRALIAN NATIONAL UNIVERSITY SPECIFICALLY DISCLAIMS ANY WARRANTIES,
|
mbed714 |
0:d616ece2d859
|
56
|
* INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY
|
mbed714 |
0:d616ece2d859
|
57
|
* AND FITNESS FOR A PARTICULAR PURPOSE. THE SOFTWARE PROVIDED HEREUNDER IS
|
mbed714 |
0:d616ece2d859
|
58
|
* ON AN "AS IS" BASIS, AND THE AUSTRALIAN NATIONAL UNIVERSITY HAS NO
|
mbed714 |
0:d616ece2d859
|
59
|
* OBLIGATION TO PROVIDE MAINTENANCE, SUPPORT, UPDATES, ENHANCEMENTS,
|
mbed714 |
0:d616ece2d859
|
60
|
* OR MODIFICATIONS.
|
mbed714 |
0:d616ece2d859
|
61
|
*/
|
mbed714 |
0:d616ece2d859
|
62
|
|
mbed714 |
0:d616ece2d859
|
63
|
/*
|
mbed714 |
0:d616ece2d859
|
64
|
* if_ppp.h - Point-to-Point Protocol definitions.
|
mbed714 |
0:d616ece2d859
|
65
|
*
|
mbed714 |
0:d616ece2d859
|
66
|
* Copyright (c) 1989 Carnegie Mellon University.
|
mbed714 |
0:d616ece2d859
|
67
|
* All rights reserved.
|
mbed714 |
0:d616ece2d859
|
68
|
*
|
mbed714 |
0:d616ece2d859
|
69
|
* Redistribution and use in source and binary forms are permitted
|
mbed714 |
0:d616ece2d859
|
70
|
* provided that the above copyright notice and this paragraph are
|
mbed714 |
0:d616ece2d859
|
71
|
* duplicated in all such forms and that any documentation,
|
mbed714 |
0:d616ece2d859
|
72
|
* advertising materials, and other materials related to such
|
mbed714 |
0:d616ece2d859
|
73
|
* distribution and use acknowledge that the software was developed
|
mbed714 |
0:d616ece2d859
|
74
|
* by Carnegie Mellon University. The name of the
|
mbed714 |
0:d616ece2d859
|
75
|
* University may not be used to endorse or promote products derived
|
mbed714 |
0:d616ece2d859
|
76
|
* from this software without specific prior written permission.
|
mbed714 |
0:d616ece2d859
|
77
|
* THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR
|
mbed714 |
0:d616ece2d859
|
78
|
* IMPLIED WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED
|
mbed714 |
0:d616ece2d859
|
79
|
* WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
|
mbed714 |
0:d616ece2d859
|
80
|
*/
|
mbed714 |
0:d616ece2d859
|
81
|
|
mbed714 |
0:d616ece2d859
|
82
|
#include "lwip/opt.h"
|
mbed714 |
0:d616ece2d859
|
83
|
|
mbed714 |
0:d616ece2d859
|
84
|
#if PPP_SUPPORT /* don't build if not configured for use in lwipopts.h */
|
mbed714 |
0:d616ece2d859
|
85
|
|
mbed714 |
0:d616ece2d859
|
86
|
#include "lwip/ip.h" /* for ip_input() */
|
mbed714 |
0:d616ece2d859
|
87
|
|
mbed714 |
0:d616ece2d859
|
88
|
#include "ppp.h"
|
mbed714 |
0:d616ece2d859
|
89
|
#include "pppdebug.h"
|
mbed714 |
0:d616ece2d859
|
90
|
|
mbed714 |
0:d616ece2d859
|
91
|
#include "randm.h"
|
mbed714 |
0:d616ece2d859
|
92
|
#include "fsm.h"
|
mbed714 |
0:d616ece2d859
|
93
|
#if PAP_SUPPORT
|
mbed714 |
0:d616ece2d859
|
94
|
#include "pap.h"
|
mbed714 |
0:d616ece2d859
|
95
|
#endif /* PAP_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
96
|
#if CHAP_SUPPORT
|
mbed714 |
0:d616ece2d859
|
97
|
#include "chap.h"
|
mbed714 |
0:d616ece2d859
|
98
|
#endif /* CHAP_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
99
|
#include "ipcp.h"
|
mbed714 |
0:d616ece2d859
|
100
|
#include "lcp.h"
|
mbed714 |
0:d616ece2d859
|
101
|
#include "magic.h"
|
mbed714 |
0:d616ece2d859
|
102
|
#include "auth.h"
|
mbed714 |
0:d616ece2d859
|
103
|
#if VJ_SUPPORT
|
mbed714 |
0:d616ece2d859
|
104
|
#include "vj.h"
|
mbed714 |
0:d616ece2d859
|
105
|
#endif /* VJ_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
106
|
#if PPPOE_SUPPORT
|
mbed714 |
0:d616ece2d859
|
107
|
#include "netif/ppp_oe.h"
|
mbed714 |
0:d616ece2d859
|
108
|
#endif /* PPPOE_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
109
|
|
mbed714 |
0:d616ece2d859
|
110
|
#include "lwip/tcpip.h"
|
mbed714 |
0:d616ece2d859
|
111
|
#include "lwip/api.h"
|
mbed714 |
0:d616ece2d859
|
112
|
#include "lwip/snmp.h"
|
mbed714 |
0:d616ece2d859
|
113
|
|
mbed714 |
0:d616ece2d859
|
114
|
#include <string.h>
|
mbed714 |
0:d616ece2d859
|
115
|
|
mbed714 |
0:d616ece2d859
|
116
|
/*************************/
|
mbed714 |
0:d616ece2d859
|
117
|
/*** LOCAL DEFINITIONS ***/
|
mbed714 |
0:d616ece2d859
|
118
|
/*************************/
|
mbed714 |
0:d616ece2d859
|
119
|
|
mbed714 |
0:d616ece2d859
|
120
|
/** PPP_INPROC_MULTITHREADED==1 call pppInput using tcpip_callback().
|
mbed714 |
0:d616ece2d859
|
121
|
* Set this to 0 if pppInProc is called inside tcpip_thread or with NO_SYS==1.
|
mbed714 |
0:d616ece2d859
|
122
|
* Default is 1 for NO_SYS==0 (multithreaded) and 0 for NO_SYS==1 (single-threaded).
|
mbed714 |
0:d616ece2d859
|
123
|
*/
|
mbed714 |
0:d616ece2d859
|
124
|
#ifndef PPP_INPROC_MULTITHREADED
|
mbed714 |
0:d616ece2d859
|
125
|
#define PPP_INPROC_MULTITHREADED (NO_SYS==0)
|
mbed714 |
0:d616ece2d859
|
126
|
#endif
|
mbed714 |
0:d616ece2d859
|
127
|
|
mbed714 |
0:d616ece2d859
|
128
|
/** PPP_INPROC_OWNTHREAD==1: start a dedicated RX thread per PPP session.
|
mbed714 |
0:d616ece2d859
|
129
|
* Default is 0: call pppos_input() for received raw characters, charcater
|
mbed714 |
0:d616ece2d859
|
130
|
* reception is up to the port */
|
mbed714 |
0:d616ece2d859
|
131
|
#ifndef PPP_INPROC_OWNTHREAD
|
mbed714 |
0:d616ece2d859
|
132
|
#define PPP_INPROC_OWNTHREAD PPP_INPROC_MULTITHREADED
|
mbed714 |
0:d616ece2d859
|
133
|
#endif
|
mbed714 |
0:d616ece2d859
|
134
|
|
mbed714 |
0:d616ece2d859
|
135
|
#if PPP_INPROC_OWNTHREAD && !PPP_INPROC_MULTITHREADED
|
mbed714 |
0:d616ece2d859
|
136
|
#error "PPP_INPROC_OWNTHREAD needs PPP_INPROC_MULTITHREADED==1"
|
mbed714 |
0:d616ece2d859
|
137
|
#endif
|
mbed714 |
0:d616ece2d859
|
138
|
|
mbed714 |
0:d616ece2d859
|
139
|
/*
|
mbed714 |
0:d616ece2d859
|
140
|
* The basic PPP frame.
|
mbed714 |
0:d616ece2d859
|
141
|
*/
|
mbed714 |
0:d616ece2d859
|
142
|
#define PPP_ADDRESS(p) (((u_char *)(p))[0])
|
mbed714 |
0:d616ece2d859
|
143
|
#define PPP_CONTROL(p) (((u_char *)(p))[1])
|
mbed714 |
0:d616ece2d859
|
144
|
#define PPP_PROTOCOL(p) ((((u_char *)(p))[2] << 8) + ((u_char *)(p))[3])
|
mbed714 |
0:d616ece2d859
|
145
|
|
mbed714 |
0:d616ece2d859
|
146
|
/* PPP packet parser states. Current state indicates operation yet to be
|
mbed714 |
0:d616ece2d859
|
147
|
* completed. */
|
mbed714 |
0:d616ece2d859
|
148
|
typedef enum {
|
mbed714 |
0:d616ece2d859
|
149
|
PDIDLE = 0, /* Idle state - waiting. */
|
mbed714 |
0:d616ece2d859
|
150
|
PDSTART, /* Process start flag. */
|
mbed714 |
0:d616ece2d859
|
151
|
PDADDRESS, /* Process address field. */
|
mbed714 |
0:d616ece2d859
|
152
|
PDCONTROL, /* Process control field. */
|
mbed714 |
0:d616ece2d859
|
153
|
PDPROTOCOL1, /* Process protocol field 1. */
|
mbed714 |
0:d616ece2d859
|
154
|
PDPROTOCOL2, /* Process protocol field 2. */
|
mbed714 |
0:d616ece2d859
|
155
|
PDDATA /* Process data byte. */
|
mbed714 |
0:d616ece2d859
|
156
|
} PPPDevStates;
|
mbed714 |
0:d616ece2d859
|
157
|
|
mbed714 |
0:d616ece2d859
|
158
|
#define ESCAPE_P(accm, c) ((accm)[(c) >> 3] & pppACCMMask[c & 0x07])
|
mbed714 |
0:d616ece2d859
|
159
|
|
mbed714 |
0:d616ece2d859
|
160
|
/************************/
|
mbed714 |
0:d616ece2d859
|
161
|
/*** LOCAL DATA TYPES ***/
|
mbed714 |
0:d616ece2d859
|
162
|
/************************/
|
mbed714 |
0:d616ece2d859
|
163
|
|
mbed714 |
0:d616ece2d859
|
164
|
/** RX buffer size: this may be configured smaller! */
|
mbed714 |
0:d616ece2d859
|
165
|
#ifndef PPPOS_RX_BUFSIZE
|
mbed714 |
0:d616ece2d859
|
166
|
#define PPPOS_RX_BUFSIZE (PPP_MRU + PPP_HDRLEN)
|
mbed714 |
0:d616ece2d859
|
167
|
#endif
|
mbed714 |
0:d616ece2d859
|
168
|
|
mbed714 |
0:d616ece2d859
|
169
|
typedef struct PPPControlRx_s {
|
mbed714 |
0:d616ece2d859
|
170
|
/** unit number / ppp descriptor */
|
mbed714 |
0:d616ece2d859
|
171
|
int pd;
|
mbed714 |
0:d616ece2d859
|
172
|
/** the rx file descriptor */
|
mbed714 |
0:d616ece2d859
|
173
|
sio_fd_t fd;
|
mbed714 |
0:d616ece2d859
|
174
|
/** receive buffer - encoded data is stored here */
|
mbed714 |
0:d616ece2d859
|
175
|
u_char rxbuf[PPPOS_RX_BUFSIZE];
|
mbed714 |
0:d616ece2d859
|
176
|
|
mbed714 |
0:d616ece2d859
|
177
|
/* The input packet. */
|
mbed714 |
0:d616ece2d859
|
178
|
struct pbuf *inHead, *inTail;
|
mbed714 |
0:d616ece2d859
|
179
|
|
mbed714 |
0:d616ece2d859
|
180
|
#if PPPOS_SUPPORT
|
mbed714 |
0:d616ece2d859
|
181
|
u16_t inProtocol; /* The input protocol code. */
|
mbed714 |
0:d616ece2d859
|
182
|
u16_t inFCS; /* Input Frame Check Sequence value. */
|
mbed714 |
0:d616ece2d859
|
183
|
#endif /* PPPOS_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
184
|
PPPDevStates inState; /* The input process state. */
|
mbed714 |
0:d616ece2d859
|
185
|
char inEscaped; /* Escape next character. */
|
mbed714 |
0:d616ece2d859
|
186
|
ext_accm inACCM; /* Async-Ctl-Char-Map for input. */
|
mbed714 |
0:d616ece2d859
|
187
|
} PPPControlRx;
|
mbed714 |
0:d616ece2d859
|
188
|
|
mbed714 |
0:d616ece2d859
|
189
|
/*
|
mbed714 |
0:d616ece2d859
|
190
|
* PPP interface control block.
|
mbed714 |
0:d616ece2d859
|
191
|
*/
|
mbed714 |
0:d616ece2d859
|
192
|
typedef struct PPPControl_s {
|
mbed714 |
0:d616ece2d859
|
193
|
PPPControlRx rx;
|
mbed714 |
0:d616ece2d859
|
194
|
char openFlag; /* True when in use. */
|
mbed714 |
0:d616ece2d859
|
195
|
#if PPPOE_SUPPORT
|
mbed714 |
0:d616ece2d859
|
196
|
struct netif *ethif;
|
mbed714 |
0:d616ece2d859
|
197
|
struct pppoe_softc *pppoe_sc;
|
mbed714 |
0:d616ece2d859
|
198
|
#endif /* PPPOE_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
199
|
int if_up; /* True when the interface is up. */
|
mbed714 |
0:d616ece2d859
|
200
|
int errCode; /* Code indicating why interface is down. */
|
mbed714 |
0:d616ece2d859
|
201
|
#if PPPOS_SUPPORT
|
mbed714 |
0:d616ece2d859
|
202
|
sio_fd_t fd; /* File device ID of port. */
|
mbed714 |
0:d616ece2d859
|
203
|
#endif /* PPPOS_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
204
|
u16_t mtu; /* Peer's mru */
|
mbed714 |
0:d616ece2d859
|
205
|
int pcomp; /* Does peer accept protocol compression? */
|
mbed714 |
0:d616ece2d859
|
206
|
int accomp; /* Does peer accept addr/ctl compression? */
|
mbed714 |
0:d616ece2d859
|
207
|
u_long lastXMit; /* Time of last transmission. */
|
mbed714 |
0:d616ece2d859
|
208
|
ext_accm outACCM; /* Async-Ctl-Char-Map for output. */
|
mbed714 |
0:d616ece2d859
|
209
|
#if PPPOS_SUPPORT && VJ_SUPPORT
|
mbed714 |
0:d616ece2d859
|
210
|
int vjEnabled; /* Flag indicating VJ compression enabled. */
|
mbed714 |
0:d616ece2d859
|
211
|
struct vjcompress vjComp; /* Van Jacobson compression header. */
|
mbed714 |
0:d616ece2d859
|
212
|
#endif /* PPPOS_SUPPORT && VJ_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
213
|
|
mbed714 |
0:d616ece2d859
|
214
|
struct netif netif;
|
mbed714 |
0:d616ece2d859
|
215
|
|
mbed714 |
0:d616ece2d859
|
216
|
struct ppp_addrs addrs;
|
mbed714 |
0:d616ece2d859
|
217
|
|
mbed714 |
0:d616ece2d859
|
218
|
void (*linkStatusCB)(void *ctx, int errCode, void *arg);
|
mbed714 |
0:d616ece2d859
|
219
|
void *linkStatusCtx;
|
mbed714 |
0:d616ece2d859
|
220
|
|
mbed714 |
0:d616ece2d859
|
221
|
} PPPControl;
|
mbed714 |
0:d616ece2d859
|
222
|
|
mbed714 |
0:d616ece2d859
|
223
|
|
mbed714 |
0:d616ece2d859
|
224
|
/*
|
mbed714 |
0:d616ece2d859
|
225
|
* Ioctl definitions.
|
mbed714 |
0:d616ece2d859
|
226
|
*/
|
mbed714 |
0:d616ece2d859
|
227
|
|
mbed714 |
0:d616ece2d859
|
228
|
struct npioctl {
|
mbed714 |
0:d616ece2d859
|
229
|
int protocol; /* PPP procotol, e.g. PPP_IP */
|
mbed714 |
0:d616ece2d859
|
230
|
enum NPmode mode;
|
mbed714 |
0:d616ece2d859
|
231
|
};
|
mbed714 |
0:d616ece2d859
|
232
|
|
mbed714 |
0:d616ece2d859
|
233
|
|
mbed714 |
0:d616ece2d859
|
234
|
|
mbed714 |
0:d616ece2d859
|
235
|
/***********************************/
|
mbed714 |
0:d616ece2d859
|
236
|
/*** LOCAL FUNCTION DECLARATIONS ***/
|
mbed714 |
0:d616ece2d859
|
237
|
/***********************************/
|
mbed714 |
0:d616ece2d859
|
238
|
#if PPPOS_SUPPORT
|
mbed714 |
0:d616ece2d859
|
239
|
#if PPP_INPROC_OWNTHREAD
|
mbed714 |
0:d616ece2d859
|
240
|
static void pppInputThread(void *arg);
|
mbed714 |
0:d616ece2d859
|
241
|
#endif /* PPP_INPROC_OWNTHREAD */
|
mbed714 |
0:d616ece2d859
|
242
|
static void pppDrop(PPPControlRx *pcrx);
|
mbed714 |
0:d616ece2d859
|
243
|
static void pppInProc(PPPControlRx *pcrx, u_char *s, int l);
|
mbed714 |
0:d616ece2d859
|
244
|
#endif /* PPPOS_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
245
|
|
mbed714 |
0:d616ece2d859
|
246
|
|
mbed714 |
0:d616ece2d859
|
247
|
/******************************/
|
mbed714 |
0:d616ece2d859
|
248
|
/*** PUBLIC DATA STRUCTURES ***/
|
mbed714 |
0:d616ece2d859
|
249
|
/******************************/
|
mbed714 |
0:d616ece2d859
|
250
|
u_long subnetMask;
|
mbed714 |
0:d616ece2d859
|
251
|
|
mbed714 |
0:d616ece2d859
|
252
|
static PPPControl pppControl[NUM_PPP] MEM_POSITION; /* The PPP interface control blocks. */
|
mbed714 |
0:d616ece2d859
|
253
|
|
mbed714 |
0:d616ece2d859
|
254
|
/*
|
mbed714 |
0:d616ece2d859
|
255
|
* PPP Data Link Layer "protocol" table.
|
mbed714 |
0:d616ece2d859
|
256
|
* One entry per supported protocol.
|
mbed714 |
0:d616ece2d859
|
257
|
* The last entry must be NULL.
|
mbed714 |
0:d616ece2d859
|
258
|
*/
|
mbed714 |
0:d616ece2d859
|
259
|
struct protent *ppp_protocols[] = {
|
mbed714 |
0:d616ece2d859
|
260
|
&lcp_protent,
|
mbed714 |
0:d616ece2d859
|
261
|
#if PAP_SUPPORT
|
mbed714 |
0:d616ece2d859
|
262
|
&pap_protent,
|
mbed714 |
0:d616ece2d859
|
263
|
#endif /* PAP_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
264
|
#if CHAP_SUPPORT
|
mbed714 |
0:d616ece2d859
|
265
|
&chap_protent,
|
mbed714 |
0:d616ece2d859
|
266
|
#endif /* CHAP_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
267
|
#if CBCP_SUPPORT
|
mbed714 |
0:d616ece2d859
|
268
|
&cbcp_protent,
|
mbed714 |
0:d616ece2d859
|
269
|
#endif /* CBCP_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
270
|
&ipcp_protent,
|
mbed714 |
0:d616ece2d859
|
271
|
#if CCP_SUPPORT
|
mbed714 |
0:d616ece2d859
|
272
|
&ccp_protent,
|
mbed714 |
0:d616ece2d859
|
273
|
#endif /* CCP_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
274
|
NULL
|
mbed714 |
0:d616ece2d859
|
275
|
};
|
mbed714 |
0:d616ece2d859
|
276
|
|
mbed714 |
0:d616ece2d859
|
277
|
|
mbed714 |
0:d616ece2d859
|
278
|
/*
|
mbed714 |
0:d616ece2d859
|
279
|
* Buffers for outgoing packets. This must be accessed only from the appropriate
|
mbed714 |
0:d616ece2d859
|
280
|
* PPP task so that it doesn't need to be protected to avoid collisions.
|
mbed714 |
0:d616ece2d859
|
281
|
*/
|
mbed714 |
0:d616ece2d859
|
282
|
u_char outpacket_buf[NUM_PPP][PPP_MRU+PPP_HDRLEN] MEM_POSITION;
|
mbed714 |
0:d616ece2d859
|
283
|
|
mbed714 |
0:d616ece2d859
|
284
|
|
mbed714 |
0:d616ece2d859
|
285
|
/*****************************/
|
mbed714 |
0:d616ece2d859
|
286
|
/*** LOCAL DATA STRUCTURES ***/
|
mbed714 |
0:d616ece2d859
|
287
|
/*****************************/
|
mbed714 |
0:d616ece2d859
|
288
|
|
mbed714 |
0:d616ece2d859
|
289
|
#if PPPOS_SUPPORT
|
mbed714 |
0:d616ece2d859
|
290
|
/*
|
mbed714 |
0:d616ece2d859
|
291
|
* FCS lookup table as calculated by genfcstab.
|
mbed714 |
0:d616ece2d859
|
292
|
* @todo: smaller, slower implementation for lower memory footprint?
|
mbed714 |
0:d616ece2d859
|
293
|
*/
|
mbed714 |
0:d616ece2d859
|
294
|
static const u_short fcstab[256] = {
|
mbed714 |
0:d616ece2d859
|
295
|
0x0000, 0x1189, 0x2312, 0x329b, 0x4624, 0x57ad, 0x6536, 0x74bf,
|
mbed714 |
0:d616ece2d859
|
296
|
0x8c48, 0x9dc1, 0xaf5a, 0xbed3, 0xca6c, 0xdbe5, 0xe97e, 0xf8f7,
|
mbed714 |
0:d616ece2d859
|
297
|
0x1081, 0x0108, 0x3393, 0x221a, 0x56a5, 0x472c, 0x75b7, 0x643e,
|
mbed714 |
0:d616ece2d859
|
298
|
0x9cc9, 0x8d40, 0xbfdb, 0xae52, 0xdaed, 0xcb64, 0xf9ff, 0xe876,
|
mbed714 |
0:d616ece2d859
|
299
|
0x2102, 0x308b, 0x0210, 0x1399, 0x6726, 0x76af, 0x4434, 0x55bd,
|
mbed714 |
0:d616ece2d859
|
300
|
0xad4a, 0xbcc3, 0x8e58, 0x9fd1, 0xeb6e, 0xfae7, 0xc87c, 0xd9f5,
|
mbed714 |
0:d616ece2d859
|
301
|
0x3183, 0x200a, 0x1291, 0x0318, 0x77a7, 0x662e, 0x54b5, 0x453c,
|
mbed714 |
0:d616ece2d859
|
302
|
0xbdcb, 0xac42, 0x9ed9, 0x8f50, 0xfbef, 0xea66, 0xd8fd, 0xc974,
|
mbed714 |
0:d616ece2d859
|
303
|
0x4204, 0x538d, 0x6116, 0x709f, 0x0420, 0x15a9, 0x2732, 0x36bb,
|
mbed714 |
0:d616ece2d859
|
304
|
0xce4c, 0xdfc5, 0xed5e, 0xfcd7, 0x8868, 0x99e1, 0xab7a, 0xbaf3,
|
mbed714 |
0:d616ece2d859
|
305
|
0x5285, 0x430c, 0x7197, 0x601e, 0x14a1, 0x0528, 0x37b3, 0x263a,
|
mbed714 |
0:d616ece2d859
|
306
|
0xdecd, 0xcf44, 0xfddf, 0xec56, 0x98e9, 0x8960, 0xbbfb, 0xaa72,
|
mbed714 |
0:d616ece2d859
|
307
|
0x6306, 0x728f, 0x4014, 0x519d, 0x2522, 0x34ab, 0x0630, 0x17b9,
|
mbed714 |
0:d616ece2d859
|
308
|
0xef4e, 0xfec7, 0xcc5c, 0xddd5, 0xa96a, 0xb8e3, 0x8a78, 0x9bf1,
|
mbed714 |
0:d616ece2d859
|
309
|
0x7387, 0x620e, 0x5095, 0x411c, 0x35a3, 0x242a, 0x16b1, 0x0738,
|
mbed714 |
0:d616ece2d859
|
310
|
0xffcf, 0xee46, 0xdcdd, 0xcd54, 0xb9eb, 0xa862, 0x9af9, 0x8b70,
|
mbed714 |
0:d616ece2d859
|
311
|
0x8408, 0x9581, 0xa71a, 0xb693, 0xc22c, 0xd3a5, 0xe13e, 0xf0b7,
|
mbed714 |
0:d616ece2d859
|
312
|
0x0840, 0x19c9, 0x2b52, 0x3adb, 0x4e64, 0x5fed, 0x6d76, 0x7cff,
|
mbed714 |
0:d616ece2d859
|
313
|
0x9489, 0x8500, 0xb79b, 0xa612, 0xd2ad, 0xc324, 0xf1bf, 0xe036,
|
mbed714 |
0:d616ece2d859
|
314
|
0x18c1, 0x0948, 0x3bd3, 0x2a5a, 0x5ee5, 0x4f6c, 0x7df7, 0x6c7e,
|
mbed714 |
0:d616ece2d859
|
315
|
0xa50a, 0xb483, 0x8618, 0x9791, 0xe32e, 0xf2a7, 0xc03c, 0xd1b5,
|
mbed714 |
0:d616ece2d859
|
316
|
0x2942, 0x38cb, 0x0a50, 0x1bd9, 0x6f66, 0x7eef, 0x4c74, 0x5dfd,
|
mbed714 |
0:d616ece2d859
|
317
|
0xb58b, 0xa402, 0x9699, 0x8710, 0xf3af, 0xe226, 0xd0bd, 0xc134,
|
mbed714 |
0:d616ece2d859
|
318
|
0x39c3, 0x284a, 0x1ad1, 0x0b58, 0x7fe7, 0x6e6e, 0x5cf5, 0x4d7c,
|
mbed714 |
0:d616ece2d859
|
319
|
0xc60c, 0xd785, 0xe51e, 0xf497, 0x8028, 0x91a1, 0xa33a, 0xb2b3,
|
mbed714 |
0:d616ece2d859
|
320
|
0x4a44, 0x5bcd, 0x6956, 0x78df, 0x0c60, 0x1de9, 0x2f72, 0x3efb,
|
mbed714 |
0:d616ece2d859
|
321
|
0xd68d, 0xc704, 0xf59f, 0xe416, 0x90a9, 0x8120, 0xb3bb, 0xa232,
|
mbed714 |
0:d616ece2d859
|
322
|
0x5ac5, 0x4b4c, 0x79d7, 0x685e, 0x1ce1, 0x0d68, 0x3ff3, 0x2e7a,
|
mbed714 |
0:d616ece2d859
|
323
|
0xe70e, 0xf687, 0xc41c, 0xd595, 0xa12a, 0xb0a3, 0x8238, 0x93b1,
|
mbed714 |
0:d616ece2d859
|
324
|
0x6b46, 0x7acf, 0x4854, 0x59dd, 0x2d62, 0x3ceb, 0x0e70, 0x1ff9,
|
mbed714 |
0:d616ece2d859
|
325
|
0xf78f, 0xe606, 0xd49d, 0xc514, 0xb1ab, 0xa022, 0x92b9, 0x8330,
|
mbed714 |
0:d616ece2d859
|
326
|
0x7bc7, 0x6a4e, 0x58d5, 0x495c, 0x3de3, 0x2c6a, 0x1ef1, 0x0f78
|
mbed714 |
0:d616ece2d859
|
327
|
};
|
mbed714 |
0:d616ece2d859
|
328
|
|
mbed714 |
0:d616ece2d859
|
329
|
/* PPP's Asynchronous-Control-Character-Map. The mask array is used
|
mbed714 |
0:d616ece2d859
|
330
|
* to select the specific bit for a character. */
|
mbed714 |
0:d616ece2d859
|
331
|
static u_char pppACCMMask[] = {
|
mbed714 |
0:d616ece2d859
|
332
|
0x01,
|
mbed714 |
0:d616ece2d859
|
333
|
0x02,
|
mbed714 |
0:d616ece2d859
|
334
|
0x04,
|
mbed714 |
0:d616ece2d859
|
335
|
0x08,
|
mbed714 |
0:d616ece2d859
|
336
|
0x10,
|
mbed714 |
0:d616ece2d859
|
337
|
0x20,
|
mbed714 |
0:d616ece2d859
|
338
|
0x40,
|
mbed714 |
0:d616ece2d859
|
339
|
0x80
|
mbed714 |
0:d616ece2d859
|
340
|
};
|
mbed714 |
0:d616ece2d859
|
341
|
|
mbed714 |
0:d616ece2d859
|
342
|
/** Wake up the task blocked in reading from serial line (if any) */
|
mbed714 |
0:d616ece2d859
|
343
|
static void
|
mbed714 |
0:d616ece2d859
|
344
|
pppRecvWakeup(int pd)
|
mbed714 |
0:d616ece2d859
|
345
|
{
|
mbed714 |
0:d616ece2d859
|
346
|
PPPDEBUG(LOG_DEBUG, ("pppRecvWakeup: unit %d\n", pd));
|
mbed714 |
0:d616ece2d859
|
347
|
sio_read_abort(pppControl[pd].fd);
|
mbed714 |
0:d616ece2d859
|
348
|
}
|
mbed714 |
0:d616ece2d859
|
349
|
#endif /* PPPOS_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
350
|
|
mbed714 |
0:d616ece2d859
|
351
|
void
|
mbed714 |
0:d616ece2d859
|
352
|
pppLinkTerminated(int pd)
|
mbed714 |
0:d616ece2d859
|
353
|
{
|
mbed714 |
0:d616ece2d859
|
354
|
PPPDEBUG(LOG_DEBUG, ("pppLinkTerminated: unit %d\n", pd));
|
mbed714 |
0:d616ece2d859
|
355
|
|
mbed714 |
0:d616ece2d859
|
356
|
#if PPPOE_SUPPORT
|
mbed714 |
0:d616ece2d859
|
357
|
if (pppControl[pd].ethif) {
|
mbed714 |
0:d616ece2d859
|
358
|
pppoe_disconnect(pppControl[pd].pppoe_sc);
|
mbed714 |
0:d616ece2d859
|
359
|
} else
|
mbed714 |
0:d616ece2d859
|
360
|
#endif /* PPPOE_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
361
|
{
|
mbed714 |
0:d616ece2d859
|
362
|
#if PPPOS_SUPPORT
|
mbed714 |
0:d616ece2d859
|
363
|
PPPControl* pc;
|
mbed714 |
0:d616ece2d859
|
364
|
pppRecvWakeup(pd);
|
mbed714 |
0:d616ece2d859
|
365
|
pc = &pppControl[pd];
|
mbed714 |
0:d616ece2d859
|
366
|
pppDrop(&pc->rx); /* bug fix #17726 */
|
mbed714 |
0:d616ece2d859
|
367
|
|
mbed714 |
0:d616ece2d859
|
368
|
PPPDEBUG(LOG_DEBUG, ("pppLinkTerminated: unit %d: linkStatusCB=%p errCode=%d\n", pd, pc->linkStatusCB, pc->errCode));
|
mbed714 |
0:d616ece2d859
|
369
|
if (pc->linkStatusCB) {
|
mbed714 |
0:d616ece2d859
|
370
|
pc->linkStatusCB(pc->linkStatusCtx, pc->errCode ? pc->errCode : PPPERR_PROTOCOL, NULL);
|
mbed714 |
0:d616ece2d859
|
371
|
}
|
mbed714 |
0:d616ece2d859
|
372
|
|
mbed714 |
0:d616ece2d859
|
373
|
pc->openFlag = 0;/**/
|
mbed714 |
0:d616ece2d859
|
374
|
#endif /* PPPOS_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
375
|
}
|
mbed714 |
0:d616ece2d859
|
376
|
PPPDEBUG(LOG_DEBUG, ("pppLinkTerminated: finished.\n"));
|
mbed714 |
0:d616ece2d859
|
377
|
}
|
mbed714 |
0:d616ece2d859
|
378
|
|
mbed714 |
0:d616ece2d859
|
379
|
void
|
mbed714 |
0:d616ece2d859
|
380
|
pppLinkDown(int pd)
|
mbed714 |
0:d616ece2d859
|
381
|
{
|
mbed714 |
0:d616ece2d859
|
382
|
PPPDEBUG(LOG_DEBUG, ("pppLinkDown: unit %d\n", pd));
|
mbed714 |
0:d616ece2d859
|
383
|
|
mbed714 |
0:d616ece2d859
|
384
|
#if PPPOE_SUPPORT
|
mbed714 |
0:d616ece2d859
|
385
|
if (pppControl[pd].ethif) {
|
mbed714 |
0:d616ece2d859
|
386
|
pppoe_disconnect(pppControl[pd].pppoe_sc);
|
mbed714 |
0:d616ece2d859
|
387
|
} else
|
mbed714 |
0:d616ece2d859
|
388
|
#endif /* PPPOE_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
389
|
{
|
mbed714 |
0:d616ece2d859
|
390
|
#if PPPOS_SUPPORT
|
mbed714 |
0:d616ece2d859
|
391
|
pppRecvWakeup(pd);
|
mbed714 |
0:d616ece2d859
|
392
|
#endif /* PPPOS_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
393
|
}
|
mbed714 |
0:d616ece2d859
|
394
|
}
|
mbed714 |
0:d616ece2d859
|
395
|
|
mbed714 |
0:d616ece2d859
|
396
|
/** Initiate LCP open request */
|
mbed714 |
0:d616ece2d859
|
397
|
static void
|
mbed714 |
0:d616ece2d859
|
398
|
pppStart(int pd)
|
mbed714 |
0:d616ece2d859
|
399
|
{
|
mbed714 |
0:d616ece2d859
|
400
|
PPPDEBUG(LOG_DEBUG, ("pppStart: unit %d\n", pd));
|
mbed714 |
0:d616ece2d859
|
401
|
lcp_lowerup(pd);
|
mbed714 |
0:d616ece2d859
|
402
|
lcp_open(pd); /* Start protocol */
|
mbed714 |
0:d616ece2d859
|
403
|
PPPDEBUG(LOG_DEBUG, ("pppStart: finished\n"));
|
mbed714 |
0:d616ece2d859
|
404
|
}
|
mbed714 |
0:d616ece2d859
|
405
|
|
mbed714 |
0:d616ece2d859
|
406
|
/** LCP close request */
|
mbed714 |
0:d616ece2d859
|
407
|
static void
|
mbed714 |
0:d616ece2d859
|
408
|
pppStop(int pd)
|
mbed714 |
0:d616ece2d859
|
409
|
{
|
mbed714 |
0:d616ece2d859
|
410
|
PPPDEBUG(LOG_DEBUG, ("pppStop: unit %d\n", pd));
|
mbed714 |
0:d616ece2d859
|
411
|
lcp_close(pd, "User request");
|
mbed714 |
0:d616ece2d859
|
412
|
}
|
mbed714 |
0:d616ece2d859
|
413
|
|
mbed714 |
0:d616ece2d859
|
414
|
/** Called when carrier/link is lost */
|
mbed714 |
0:d616ece2d859
|
415
|
static void
|
mbed714 |
0:d616ece2d859
|
416
|
pppHup(int pd)
|
mbed714 |
0:d616ece2d859
|
417
|
{
|
mbed714 |
0:d616ece2d859
|
418
|
PPPDEBUG(LOG_DEBUG, ("pppHupCB: unit %d\n", pd));
|
mbed714 |
0:d616ece2d859
|
419
|
lcp_lowerdown(pd);
|
mbed714 |
0:d616ece2d859
|
420
|
link_terminated(pd);
|
mbed714 |
0:d616ece2d859
|
421
|
}
|
mbed714 |
0:d616ece2d859
|
422
|
|
mbed714 |
0:d616ece2d859
|
423
|
/***********************************/
|
mbed714 |
0:d616ece2d859
|
424
|
/*** PUBLIC FUNCTION DEFINITIONS ***/
|
mbed714 |
0:d616ece2d859
|
425
|
/***********************************/
|
mbed714 |
0:d616ece2d859
|
426
|
/* Initialize the PPP subsystem. */
|
mbed714 |
0:d616ece2d859
|
427
|
|
mbed714 |
0:d616ece2d859
|
428
|
struct ppp_settings ppp_settings;
|
mbed714 |
0:d616ece2d859
|
429
|
|
mbed714 |
0:d616ece2d859
|
430
|
void
|
mbed714 |
0:d616ece2d859
|
431
|
pppInit(void)
|
mbed714 |
0:d616ece2d859
|
432
|
{
|
mbed714 |
0:d616ece2d859
|
433
|
struct protent *protp;
|
mbed714 |
0:d616ece2d859
|
434
|
int i, j;
|
mbed714 |
0:d616ece2d859
|
435
|
|
mbed714 |
0:d616ece2d859
|
436
|
memset(&ppp_settings, 0, sizeof(ppp_settings));
|
mbed714 |
0:d616ece2d859
|
437
|
ppp_settings.usepeerdns = 1;
|
mbed714 |
0:d616ece2d859
|
438
|
pppSetAuth(PPPAUTHTYPE_NONE, NULL, NULL);
|
mbed714 |
0:d616ece2d859
|
439
|
|
mbed714 |
0:d616ece2d859
|
440
|
magicInit();
|
mbed714 |
0:d616ece2d859
|
441
|
|
mbed714 |
0:d616ece2d859
|
442
|
subnetMask = PP_HTONL(0xffffff00);
|
mbed714 |
0:d616ece2d859
|
443
|
|
mbed714 |
0:d616ece2d859
|
444
|
for (i = 0; i < NUM_PPP; i++) {
|
mbed714 |
0:d616ece2d859
|
445
|
/* Initialize each protocol to the standard option set. */
|
mbed714 |
0:d616ece2d859
|
446
|
for (j = 0; (protp = ppp_protocols[j]) != NULL; ++j) {
|
mbed714 |
0:d616ece2d859
|
447
|
(*protp->init)(i);
|
mbed714 |
0:d616ece2d859
|
448
|
}
|
mbed714 |
0:d616ece2d859
|
449
|
}
|
mbed714 |
0:d616ece2d859
|
450
|
}
|
mbed714 |
0:d616ece2d859
|
451
|
|
mbed714 |
0:d616ece2d859
|
452
|
void
|
mbed714 |
0:d616ece2d859
|
453
|
pppSetAuth(enum pppAuthType authType, const char *user, const char *passwd)
|
mbed714 |
0:d616ece2d859
|
454
|
{
|
mbed714 |
0:d616ece2d859
|
455
|
switch(authType) {
|
mbed714 |
0:d616ece2d859
|
456
|
case PPPAUTHTYPE_NONE:
|
mbed714 |
0:d616ece2d859
|
457
|
default:
|
mbed714 |
0:d616ece2d859
|
458
|
#ifdef LWIP_PPP_STRICT_PAP_REJECT
|
mbed714 |
0:d616ece2d859
|
459
|
ppp_settings.refuse_pap = 1;
|
mbed714 |
0:d616ece2d859
|
460
|
#else /* LWIP_PPP_STRICT_PAP_REJECT */
|
mbed714 |
0:d616ece2d859
|
461
|
/* some providers request pap and accept an empty login/pw */
|
mbed714 |
0:d616ece2d859
|
462
|
ppp_settings.refuse_pap = 0;
|
mbed714 |
0:d616ece2d859
|
463
|
#endif /* LWIP_PPP_STRICT_PAP_REJECT */
|
mbed714 |
0:d616ece2d859
|
464
|
ppp_settings.refuse_chap = 1;
|
mbed714 |
0:d616ece2d859
|
465
|
break;
|
mbed714 |
0:d616ece2d859
|
466
|
|
mbed714 |
0:d616ece2d859
|
467
|
case PPPAUTHTYPE_ANY:
|
mbed714 |
0:d616ece2d859
|
468
|
/* Warning: Using PPPAUTHTYPE_ANY might have security consequences.
|
mbed714 |
0:d616ece2d859
|
469
|
* RFC 1994 says:
|
mbed714 |
0:d616ece2d859
|
470
|
*
|
mbed714 |
0:d616ece2d859
|
471
|
* In practice, within or associated with each PPP server, there is a
|
mbed714 |
0:d616ece2d859
|
472
|
* database which associates "user" names with authentication
|
mbed714 |
0:d616ece2d859
|
473
|
* information ("secrets"). It is not anticipated that a particular
|
mbed714 |
0:d616ece2d859
|
474
|
* named user would be authenticated by multiple methods. This would
|
mbed714 |
0:d616ece2d859
|
475
|
* make the user vulnerable to attacks which negotiate the least secure
|
mbed714 |
0:d616ece2d859
|
476
|
* method from among a set (such as PAP rather than CHAP). If the same
|
mbed714 |
0:d616ece2d859
|
477
|
* secret was used, PAP would reveal the secret to be used later with
|
mbed714 |
0:d616ece2d859
|
478
|
* CHAP.
|
mbed714 |
0:d616ece2d859
|
479
|
*
|
mbed714 |
0:d616ece2d859
|
480
|
* Instead, for each user name there should be an indication of exactly
|
mbed714 |
0:d616ece2d859
|
481
|
* one method used to authenticate that user name. If a user needs to
|
mbed714 |
0:d616ece2d859
|
482
|
* make use of different authentication methods under different
|
mbed714 |
0:d616ece2d859
|
483
|
* circumstances, then distinct user names SHOULD be employed, each of
|
mbed714 |
0:d616ece2d859
|
484
|
* which identifies exactly one authentication method.
|
mbed714 |
0:d616ece2d859
|
485
|
*
|
mbed714 |
0:d616ece2d859
|
486
|
*/
|
mbed714 |
0:d616ece2d859
|
487
|
ppp_settings.refuse_pap = 0;
|
mbed714 |
0:d616ece2d859
|
488
|
ppp_settings.refuse_chap = 0;
|
mbed714 |
0:d616ece2d859
|
489
|
break;
|
mbed714 |
0:d616ece2d859
|
490
|
|
mbed714 |
0:d616ece2d859
|
491
|
case PPPAUTHTYPE_PAP:
|
mbed714 |
0:d616ece2d859
|
492
|
ppp_settings.refuse_pap = 0;
|
mbed714 |
0:d616ece2d859
|
493
|
ppp_settings.refuse_chap = 1;
|
mbed714 |
0:d616ece2d859
|
494
|
break;
|
mbed714 |
0:d616ece2d859
|
495
|
|
mbed714 |
0:d616ece2d859
|
496
|
case PPPAUTHTYPE_CHAP:
|
mbed714 |
0:d616ece2d859
|
497
|
ppp_settings.refuse_pap = 1;
|
mbed714 |
0:d616ece2d859
|
498
|
ppp_settings.refuse_chap = 0;
|
mbed714 |
0:d616ece2d859
|
499
|
break;
|
mbed714 |
0:d616ece2d859
|
500
|
}
|
mbed714 |
0:d616ece2d859
|
501
|
|
mbed714 |
0:d616ece2d859
|
502
|
if(user) {
|
mbed714 |
0:d616ece2d859
|
503
|
strncpy(ppp_settings.user, user, sizeof(ppp_settings.user)-1);
|
mbed714 |
0:d616ece2d859
|
504
|
ppp_settings.user[sizeof(ppp_settings.user)-1] = '\0';
|
mbed714 |
0:d616ece2d859
|
505
|
} else {
|
mbed714 |
0:d616ece2d859
|
506
|
ppp_settings.user[0] = '\0';
|
mbed714 |
0:d616ece2d859
|
507
|
}
|
mbed714 |
0:d616ece2d859
|
508
|
|
mbed714 |
0:d616ece2d859
|
509
|
if(passwd) {
|
mbed714 |
0:d616ece2d859
|
510
|
strncpy(ppp_settings.passwd, passwd, sizeof(ppp_settings.passwd)-1);
|
mbed714 |
0:d616ece2d859
|
511
|
ppp_settings.passwd[sizeof(ppp_settings.passwd)-1] = '\0';
|
mbed714 |
0:d616ece2d859
|
512
|
} else {
|
mbed714 |
0:d616ece2d859
|
513
|
ppp_settings.passwd[0] = '\0';
|
mbed714 |
0:d616ece2d859
|
514
|
}
|
mbed714 |
0:d616ece2d859
|
515
|
}
|
mbed714 |
0:d616ece2d859
|
516
|
|
mbed714 |
0:d616ece2d859
|
517
|
#if PPPOS_SUPPORT
|
mbed714 |
0:d616ece2d859
|
518
|
/** Open a new PPP connection using the given I/O device.
|
mbed714 |
0:d616ece2d859
|
519
|
* This initializes the PPP control block but does not
|
mbed714 |
0:d616ece2d859
|
520
|
* attempt to negotiate the LCP session. If this port
|
mbed714 |
0:d616ece2d859
|
521
|
* connects to a modem, the modem connection must be
|
mbed714 |
0:d616ece2d859
|
522
|
* established before calling this.
|
mbed714 |
0:d616ece2d859
|
523
|
* Return a new PPP connection descriptor on success or
|
mbed714 |
0:d616ece2d859
|
524
|
* an error code (negative) on failure.
|
mbed714 |
0:d616ece2d859
|
525
|
*
|
mbed714 |
0:d616ece2d859
|
526
|
* pppOpen() is directly defined to this function.
|
mbed714 |
0:d616ece2d859
|
527
|
*/
|
mbed714 |
0:d616ece2d859
|
528
|
int
|
mbed714 |
0:d616ece2d859
|
529
|
pppOverSerialOpen(sio_fd_t fd, void (*linkStatusCB)(void *ctx, int errCode, void *arg), void *linkStatusCtx)
|
mbed714 |
0:d616ece2d859
|
530
|
{
|
mbed714 |
0:d616ece2d859
|
531
|
PPPControl *pc;
|
mbed714 |
0:d616ece2d859
|
532
|
int pd;
|
mbed714 |
0:d616ece2d859
|
533
|
|
mbed714 |
0:d616ece2d859
|
534
|
if (linkStatusCB == NULL) {
|
mbed714 |
0:d616ece2d859
|
535
|
/* PPP is single-threaded: without a callback,
|
mbed714 |
0:d616ece2d859
|
536
|
* there is no way to know when the link is up. */
|
mbed714 |
0:d616ece2d859
|
537
|
return PPPERR_PARAM;
|
mbed714 |
0:d616ece2d859
|
538
|
}
|
mbed714 |
0:d616ece2d859
|
539
|
|
mbed714 |
0:d616ece2d859
|
540
|
/* Find a free PPP session descriptor. */
|
mbed714 |
0:d616ece2d859
|
541
|
for (pd = 0; pd < NUM_PPP && pppControl[pd].openFlag != 0; pd++);
|
mbed714 |
0:d616ece2d859
|
542
|
|
mbed714 |
0:d616ece2d859
|
543
|
if (pd >= NUM_PPP) {
|
mbed714 |
0:d616ece2d859
|
544
|
pd = PPPERR_OPEN;
|
mbed714 |
0:d616ece2d859
|
545
|
} else {
|
mbed714 |
0:d616ece2d859
|
546
|
pc = &pppControl[pd];
|
mbed714 |
0:d616ece2d859
|
547
|
/* @todo: is this correct or do I overwrite something? */
|
mbed714 |
0:d616ece2d859
|
548
|
memset(pc, 0, sizeof(PPPControl));
|
mbed714 |
0:d616ece2d859
|
549
|
pc->rx.pd = pd;
|
mbed714 |
0:d616ece2d859
|
550
|
pc->rx.fd = fd;
|
mbed714 |
0:d616ece2d859
|
551
|
|
mbed714 |
0:d616ece2d859
|
552
|
pc->openFlag = 1;
|
mbed714 |
0:d616ece2d859
|
553
|
pc->fd = fd;
|
mbed714 |
0:d616ece2d859
|
554
|
|
mbed714 |
0:d616ece2d859
|
555
|
#if VJ_SUPPORT
|
mbed714 |
0:d616ece2d859
|
556
|
vj_compress_init(&pc->vjComp);
|
mbed714 |
0:d616ece2d859
|
557
|
#endif /* VJ_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
558
|
|
mbed714 |
0:d616ece2d859
|
559
|
/*
|
mbed714 |
0:d616ece2d859
|
560
|
* Default the in and out accm so that escape and flag characters
|
mbed714 |
0:d616ece2d859
|
561
|
* are always escaped.
|
mbed714 |
0:d616ece2d859
|
562
|
*/
|
mbed714 |
0:d616ece2d859
|
563
|
pc->rx.inACCM[15] = 0x60; /* no need to protect since RX is not running */
|
mbed714 |
0:d616ece2d859
|
564
|
pc->outACCM[15] = 0x60;
|
mbed714 |
0:d616ece2d859
|
565
|
|
mbed714 |
0:d616ece2d859
|
566
|
pc->linkStatusCB = linkStatusCB;
|
mbed714 |
0:d616ece2d859
|
567
|
pc->linkStatusCtx = linkStatusCtx;
|
mbed714 |
0:d616ece2d859
|
568
|
|
mbed714 |
0:d616ece2d859
|
569
|
/*
|
mbed714 |
0:d616ece2d859
|
570
|
* Start the connection and handle incoming events (packet or timeout).
|
mbed714 |
0:d616ece2d859
|
571
|
*/
|
mbed714 |
0:d616ece2d859
|
572
|
PPPDEBUG(LOG_INFO, ("pppOverSerialOpen: unit %d: Connecting\n", pd));
|
mbed714 |
0:d616ece2d859
|
573
|
pppStart(pd);
|
mbed714 |
0:d616ece2d859
|
574
|
#if PPP_INPROC_OWNTHREAD
|
mbed714 |
0:d616ece2d859
|
575
|
sys_thread_new(PPP_THREAD_NAME, pppInputThread, (void*)&pc->rx, PPP_THREAD_STACKSIZE, PPP_THREAD_PRIO);
|
mbed714 |
0:d616ece2d859
|
576
|
#endif
|
mbed714 |
0:d616ece2d859
|
577
|
}
|
mbed714 |
0:d616ece2d859
|
578
|
|
mbed714 |
0:d616ece2d859
|
579
|
return pd;
|
mbed714 |
0:d616ece2d859
|
580
|
}
|
mbed714 |
0:d616ece2d859
|
581
|
#endif /* PPPOS_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
582
|
|
mbed714 |
0:d616ece2d859
|
583
|
#if PPPOE_SUPPORT
|
mbed714 |
0:d616ece2d859
|
584
|
static void pppOverEthernetLinkStatusCB(int pd, int up);
|
mbed714 |
0:d616ece2d859
|
585
|
|
mbed714 |
0:d616ece2d859
|
586
|
void
|
mbed714 |
0:d616ece2d859
|
587
|
pppOverEthernetClose(int pd)
|
mbed714 |
0:d616ece2d859
|
588
|
{
|
mbed714 |
0:d616ece2d859
|
589
|
PPPControl* pc = &pppControl[pd];
|
mbed714 |
0:d616ece2d859
|
590
|
|
mbed714 |
0:d616ece2d859
|
591
|
/* *TJL* There's no lcp_deinit */
|
mbed714 |
0:d616ece2d859
|
592
|
lcp_close(pd, NULL);
|
mbed714 |
0:d616ece2d859
|
593
|
|
mbed714 |
0:d616ece2d859
|
594
|
pppoe_destroy(&pc->netif);
|
mbed714 |
0:d616ece2d859
|
595
|
}
|
mbed714 |
0:d616ece2d859
|
596
|
|
mbed714 |
0:d616ece2d859
|
597
|
int pppOverEthernetOpen(struct netif *ethif, const char *service_name, const char *concentrator_name, void (*linkStatusCB)(void *ctx, int errCode, void *arg), void *linkStatusCtx)
|
mbed714 |
0:d616ece2d859
|
598
|
{
|
mbed714 |
0:d616ece2d859
|
599
|
PPPControl *pc;
|
mbed714 |
0:d616ece2d859
|
600
|
int pd;
|
mbed714 |
0:d616ece2d859
|
601
|
|
mbed714 |
0:d616ece2d859
|
602
|
LWIP_UNUSED_ARG(service_name);
|
mbed714 |
0:d616ece2d859
|
603
|
LWIP_UNUSED_ARG(concentrator_name);
|
mbed714 |
0:d616ece2d859
|
604
|
|
mbed714 |
0:d616ece2d859
|
605
|
if (linkStatusCB == NULL) {
|
mbed714 |
0:d616ece2d859
|
606
|
/* PPP is single-threaded: without a callback,
|
mbed714 |
0:d616ece2d859
|
607
|
* there is no way to know when the link is up. */
|
mbed714 |
0:d616ece2d859
|
608
|
return PPPERR_PARAM;
|
mbed714 |
0:d616ece2d859
|
609
|
}
|
mbed714 |
0:d616ece2d859
|
610
|
|
mbed714 |
0:d616ece2d859
|
611
|
/* Find a free PPP session descriptor. Critical region? */
|
mbed714 |
0:d616ece2d859
|
612
|
for (pd = 0; pd < NUM_PPP && pppControl[pd].openFlag != 0; pd++);
|
mbed714 |
0:d616ece2d859
|
613
|
if (pd >= NUM_PPP) {
|
mbed714 |
0:d616ece2d859
|
614
|
pd = PPPERR_OPEN;
|
mbed714 |
0:d616ece2d859
|
615
|
} else {
|
mbed714 |
0:d616ece2d859
|
616
|
pc = &pppControl[pd];
|
mbed714 |
0:d616ece2d859
|
617
|
memset(pc, 0, sizeof(PPPControl));
|
mbed714 |
0:d616ece2d859
|
618
|
pc->openFlag = 1;
|
mbed714 |
0:d616ece2d859
|
619
|
pc->ethif = ethif;
|
mbed714 |
0:d616ece2d859
|
620
|
|
mbed714 |
0:d616ece2d859
|
621
|
pc->linkStatusCB = linkStatusCB;
|
mbed714 |
0:d616ece2d859
|
622
|
pc->linkStatusCtx = linkStatusCtx;
|
mbed714 |
0:d616ece2d859
|
623
|
|
mbed714 |
0:d616ece2d859
|
624
|
lcp_wantoptions[pd].mru = PPPOE_MAXMTU;
|
mbed714 |
0:d616ece2d859
|
625
|
lcp_wantoptions[pd].neg_asyncmap = 0;
|
mbed714 |
0:d616ece2d859
|
626
|
lcp_wantoptions[pd].neg_pcompression = 0;
|
mbed714 |
0:d616ece2d859
|
627
|
lcp_wantoptions[pd].neg_accompression = 0;
|
mbed714 |
0:d616ece2d859
|
628
|
|
mbed714 |
0:d616ece2d859
|
629
|
lcp_allowoptions[pd].mru = PPPOE_MAXMTU;
|
mbed714 |
0:d616ece2d859
|
630
|
lcp_allowoptions[pd].neg_asyncmap = 0;
|
mbed714 |
0:d616ece2d859
|
631
|
lcp_allowoptions[pd].neg_pcompression = 0;
|
mbed714 |
0:d616ece2d859
|
632
|
lcp_allowoptions[pd].neg_accompression = 0;
|
mbed714 |
0:d616ece2d859
|
633
|
|
mbed714 |
0:d616ece2d859
|
634
|
if(pppoe_create(ethif, pd, pppOverEthernetLinkStatusCB, &pc->pppoe_sc) != ERR_OK) {
|
mbed714 |
0:d616ece2d859
|
635
|
pc->openFlag = 0;
|
mbed714 |
0:d616ece2d859
|
636
|
return PPPERR_OPEN;
|
mbed714 |
0:d616ece2d859
|
637
|
}
|
mbed714 |
0:d616ece2d859
|
638
|
|
mbed714 |
0:d616ece2d859
|
639
|
pppoe_connect(pc->pppoe_sc);
|
mbed714 |
0:d616ece2d859
|
640
|
}
|
mbed714 |
0:d616ece2d859
|
641
|
|
mbed714 |
0:d616ece2d859
|
642
|
return pd;
|
mbed714 |
0:d616ece2d859
|
643
|
}
|
mbed714 |
0:d616ece2d859
|
644
|
#endif /* PPPOE_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
645
|
|
mbed714 |
0:d616ece2d859
|
646
|
|
mbed714 |
0:d616ece2d859
|
647
|
/* Close a PPP connection and release the descriptor.
|
mbed714 |
0:d616ece2d859
|
648
|
* Any outstanding packets in the queues are dropped.
|
mbed714 |
0:d616ece2d859
|
649
|
* Return 0 on success, an error code on failure. */
|
mbed714 |
0:d616ece2d859
|
650
|
int
|
mbed714 |
0:d616ece2d859
|
651
|
pppClose(int pd)
|
mbed714 |
0:d616ece2d859
|
652
|
{
|
mbed714 |
0:d616ece2d859
|
653
|
PPPControl *pc = &pppControl[pd];
|
mbed714 |
0:d616ece2d859
|
654
|
int st = 0;
|
mbed714 |
0:d616ece2d859
|
655
|
|
mbed714 |
0:d616ece2d859
|
656
|
PPPDEBUG(LOG_DEBUG, ("pppClose() called\n"));
|
mbed714 |
0:d616ece2d859
|
657
|
|
mbed714 |
0:d616ece2d859
|
658
|
/* Disconnect */
|
mbed714 |
0:d616ece2d859
|
659
|
#if PPPOE_SUPPORT
|
mbed714 |
0:d616ece2d859
|
660
|
if(pc->ethif) {
|
mbed714 |
0:d616ece2d859
|
661
|
PPPDEBUG(LOG_DEBUG, ("pppClose: unit %d kill_link -> pppStop\n", pd));
|
mbed714 |
0:d616ece2d859
|
662
|
pc->errCode = PPPERR_USER;
|
mbed714 |
0:d616ece2d859
|
663
|
/* This will leave us at PHASE_DEAD. */
|
mbed714 |
0:d616ece2d859
|
664
|
pppStop(pd);
|
mbed714 |
0:d616ece2d859
|
665
|
} else
|
mbed714 |
0:d616ece2d859
|
666
|
#endif /* PPPOE_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
667
|
{
|
mbed714 |
0:d616ece2d859
|
668
|
#if PPPOS_SUPPORT
|
mbed714 |
0:d616ece2d859
|
669
|
PPPDEBUG(LOG_DEBUG, ("pppClose: unit %d kill_link -> pppStop\n", pd));
|
mbed714 |
0:d616ece2d859
|
670
|
pc->errCode = PPPERR_USER;
|
mbed714 |
0:d616ece2d859
|
671
|
/* This will leave us at PHASE_DEAD. */
|
mbed714 |
0:d616ece2d859
|
672
|
pppStop(pd);
|
mbed714 |
0:d616ece2d859
|
673
|
pppRecvWakeup(pd);
|
mbed714 |
0:d616ece2d859
|
674
|
#endif /* PPPOS_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
675
|
}
|
mbed714 |
0:d616ece2d859
|
676
|
|
mbed714 |
0:d616ece2d859
|
677
|
return st;
|
mbed714 |
0:d616ece2d859
|
678
|
}
|
mbed714 |
0:d616ece2d859
|
679
|
|
mbed714 |
0:d616ece2d859
|
680
|
/* This function is called when carrier is lost on the PPP channel. */
|
mbed714 |
0:d616ece2d859
|
681
|
void
|
mbed714 |
0:d616ece2d859
|
682
|
pppSigHUP(int pd)
|
mbed714 |
0:d616ece2d859
|
683
|
{
|
mbed714 |
0:d616ece2d859
|
684
|
#if PPPOE_SUPPORT
|
mbed714 |
0:d616ece2d859
|
685
|
PPPControl *pc = &pppControl[pd];
|
mbed714 |
0:d616ece2d859
|
686
|
if(pc->ethif) {
|
mbed714 |
0:d616ece2d859
|
687
|
PPPDEBUG(LOG_DEBUG, ("pppSigHUP: unit %d sig_hup -> pppHupCB\n", pd));
|
mbed714 |
0:d616ece2d859
|
688
|
pppHup(pd);
|
mbed714 |
0:d616ece2d859
|
689
|
} else
|
mbed714 |
0:d616ece2d859
|
690
|
#endif /* PPPOE_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
691
|
{
|
mbed714 |
0:d616ece2d859
|
692
|
#if PPPOS_SUPPORT
|
mbed714 |
0:d616ece2d859
|
693
|
PPPDEBUG(LOG_DEBUG, ("pppSigHUP: unit %d sig_hup -> pppHupCB\n", pd));
|
mbed714 |
0:d616ece2d859
|
694
|
pppHup(pd);
|
mbed714 |
0:d616ece2d859
|
695
|
pppRecvWakeup(pd);
|
mbed714 |
0:d616ece2d859
|
696
|
#endif /* PPPOS_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
697
|
}
|
mbed714 |
0:d616ece2d859
|
698
|
}
|
mbed714 |
0:d616ece2d859
|
699
|
|
mbed714 |
0:d616ece2d859
|
700
|
#if PPPOS_SUPPORT
|
mbed714 |
0:d616ece2d859
|
701
|
static void
|
mbed714 |
0:d616ece2d859
|
702
|
nPut(PPPControl *pc, struct pbuf *nb)
|
mbed714 |
0:d616ece2d859
|
703
|
{
|
mbed714 |
0:d616ece2d859
|
704
|
struct pbuf *b;
|
mbed714 |
0:d616ece2d859
|
705
|
int c;
|
mbed714 |
0:d616ece2d859
|
706
|
|
mbed714 |
0:d616ece2d859
|
707
|
for(b = nb; b != NULL; b = b->next) {
|
mbed714 |
0:d616ece2d859
|
708
|
if((c = sio_write(pc->fd, (u8_t *)b->payload, b->len)) != b->len) {
|
mbed714 |
0:d616ece2d859
|
709
|
PPPDEBUG(LOG_WARNING,
|
mbed714 |
0:d616ece2d859
|
710
|
("PPP nPut: incomplete sio_write(fd:%"SZT_F", len:%d, c: 0x%"X8_F") c = %d\n", (size_t)pc->fd, b->len, c, c));
|
mbed714 |
0:d616ece2d859
|
711
|
LINK_STATS_INC(link.err);
|
mbed714 |
0:d616ece2d859
|
712
|
pc->lastXMit = 0; /* prepend PPP_FLAG to next packet */
|
mbed714 |
0:d616ece2d859
|
713
|
snmp_inc_ifoutdiscards(&pc->netif);
|
mbed714 |
0:d616ece2d859
|
714
|
pbuf_free(nb);
|
mbed714 |
0:d616ece2d859
|
715
|
return;
|
mbed714 |
0:d616ece2d859
|
716
|
}
|
mbed714 |
0:d616ece2d859
|
717
|
}
|
mbed714 |
0:d616ece2d859
|
718
|
|
mbed714 |
0:d616ece2d859
|
719
|
snmp_add_ifoutoctets(&pc->netif, nb->tot_len);
|
mbed714 |
0:d616ece2d859
|
720
|
snmp_inc_ifoutucastpkts(&pc->netif);
|
mbed714 |
0:d616ece2d859
|
721
|
pbuf_free(nb);
|
mbed714 |
0:d616ece2d859
|
722
|
LINK_STATS_INC(link.xmit);
|
mbed714 |
0:d616ece2d859
|
723
|
}
|
mbed714 |
0:d616ece2d859
|
724
|
|
mbed714 |
0:d616ece2d859
|
725
|
/*
|
mbed714 |
0:d616ece2d859
|
726
|
* pppAppend - append given character to end of given pbuf. If outACCM
|
mbed714 |
0:d616ece2d859
|
727
|
* is not NULL and the character needs to be escaped, do so.
|
mbed714 |
0:d616ece2d859
|
728
|
* If pbuf is full, append another.
|
mbed714 |
0:d616ece2d859
|
729
|
* Return the current pbuf.
|
mbed714 |
0:d616ece2d859
|
730
|
*/
|
mbed714 |
0:d616ece2d859
|
731
|
static struct pbuf *
|
mbed714 |
0:d616ece2d859
|
732
|
pppAppend(u_char c, struct pbuf *nb, ext_accm *outACCM)
|
mbed714 |
0:d616ece2d859
|
733
|
{
|
mbed714 |
0:d616ece2d859
|
734
|
struct pbuf *tb = nb;
|
mbed714 |
0:d616ece2d859
|
735
|
|
mbed714 |
0:d616ece2d859
|
736
|
/* Make sure there is room for the character and an escape code.
|
mbed714 |
0:d616ece2d859
|
737
|
* Sure we don't quite fill the buffer if the character doesn't
|
mbed714 |
0:d616ece2d859
|
738
|
* get escaped but is one character worth complicating this? */
|
mbed714 |
0:d616ece2d859
|
739
|
/* Note: We assume no packet header. */
|
mbed714 |
0:d616ece2d859
|
740
|
if (nb && (PBUF_POOL_BUFSIZE - nb->len) < 2) {
|
mbed714 |
0:d616ece2d859
|
741
|
tb = pbuf_alloc(PBUF_RAW, 0, PBUF_POOL);
|
mbed714 |
0:d616ece2d859
|
742
|
if (tb) {
|
mbed714 |
0:d616ece2d859
|
743
|
nb->next = tb;
|
mbed714 |
0:d616ece2d859
|
744
|
} else {
|
mbed714 |
0:d616ece2d859
|
745
|
LINK_STATS_INC(link.memerr);
|
mbed714 |
0:d616ece2d859
|
746
|
}
|
mbed714 |
0:d616ece2d859
|
747
|
nb = tb;
|
mbed714 |
0:d616ece2d859
|
748
|
}
|
mbed714 |
0:d616ece2d859
|
749
|
|
mbed714 |
0:d616ece2d859
|
750
|
if (nb) {
|
mbed714 |
0:d616ece2d859
|
751
|
if (outACCM && ESCAPE_P(*outACCM, c)) {
|
mbed714 |
0:d616ece2d859
|
752
|
*((u_char*)nb->payload + nb->len++) = PPP_ESCAPE;
|
mbed714 |
0:d616ece2d859
|
753
|
*((u_char*)nb->payload + nb->len++) = c ^ PPP_TRANS;
|
mbed714 |
0:d616ece2d859
|
754
|
} else {
|
mbed714 |
0:d616ece2d859
|
755
|
*((u_char*)nb->payload + nb->len++) = c;
|
mbed714 |
0:d616ece2d859
|
756
|
}
|
mbed714 |
0:d616ece2d859
|
757
|
}
|
mbed714 |
0:d616ece2d859
|
758
|
|
mbed714 |
0:d616ece2d859
|
759
|
return tb;
|
mbed714 |
0:d616ece2d859
|
760
|
}
|
mbed714 |
0:d616ece2d859
|
761
|
#endif /* PPPOS_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
762
|
|
mbed714 |
0:d616ece2d859
|
763
|
#if PPPOE_SUPPORT
|
mbed714 |
0:d616ece2d859
|
764
|
static err_t
|
mbed714 |
0:d616ece2d859
|
765
|
pppifOutputOverEthernet(int pd, struct pbuf *p)
|
mbed714 |
0:d616ece2d859
|
766
|
{
|
mbed714 |
0:d616ece2d859
|
767
|
PPPControl *pc = &pppControl[pd];
|
mbed714 |
0:d616ece2d859
|
768
|
struct pbuf *pb;
|
mbed714 |
0:d616ece2d859
|
769
|
u_short protocol = PPP_IP;
|
mbed714 |
0:d616ece2d859
|
770
|
int i=0;
|
mbed714 |
0:d616ece2d859
|
771
|
u16_t tot_len;
|
mbed714 |
0:d616ece2d859
|
772
|
|
mbed714 |
0:d616ece2d859
|
773
|
/* @todo: try to use pbuf_header() here! */
|
mbed714 |
0:d616ece2d859
|
774
|
pb = pbuf_alloc(PBUF_LINK, PPPOE_HDRLEN + sizeof(protocol), PBUF_RAM);
|
mbed714 |
0:d616ece2d859
|
775
|
if(!pb) {
|
mbed714 |
0:d616ece2d859
|
776
|
LINK_STATS_INC(link.memerr);
|
mbed714 |
0:d616ece2d859
|
777
|
LINK_STATS_INC(link.proterr);
|
mbed714 |
0:d616ece2d859
|
778
|
snmp_inc_ifoutdiscards(&pc->netif);
|
mbed714 |
0:d616ece2d859
|
779
|
return ERR_MEM;
|
mbed714 |
0:d616ece2d859
|
780
|
}
|
mbed714 |
0:d616ece2d859
|
781
|
|
mbed714 |
0:d616ece2d859
|
782
|
pbuf_header(pb, -(s16_t)PPPOE_HDRLEN);
|
mbed714 |
0:d616ece2d859
|
783
|
|
mbed714 |
0:d616ece2d859
|
784
|
pc->lastXMit = sys_jiffies();
|
mbed714 |
0:d616ece2d859
|
785
|
|
mbed714 |
0:d616ece2d859
|
786
|
if (!pc->pcomp || protocol > 0xFF) {
|
mbed714 |
0:d616ece2d859
|
787
|
*((u_char*)pb->payload + i++) = (protocol >> 8) & 0xFF;
|
mbed714 |
0:d616ece2d859
|
788
|
}
|
mbed714 |
0:d616ece2d859
|
789
|
*((u_char*)pb->payload + i) = protocol & 0xFF;
|
mbed714 |
0:d616ece2d859
|
790
|
|
mbed714 |
0:d616ece2d859
|
791
|
pbuf_chain(pb, p);
|
mbed714 |
0:d616ece2d859
|
792
|
tot_len = pb->tot_len;
|
mbed714 |
0:d616ece2d859
|
793
|
|
mbed714 |
0:d616ece2d859
|
794
|
if(pppoe_xmit(pc->pppoe_sc, pb) != ERR_OK) {
|
mbed714 |
0:d616ece2d859
|
795
|
LINK_STATS_INC(link.err);
|
mbed714 |
0:d616ece2d859
|
796
|
snmp_inc_ifoutdiscards(&pc->netif);
|
mbed714 |
0:d616ece2d859
|
797
|
return PPPERR_DEVICE;
|
mbed714 |
0:d616ece2d859
|
798
|
}
|
mbed714 |
0:d616ece2d859
|
799
|
|
mbed714 |
0:d616ece2d859
|
800
|
snmp_add_ifoutoctets(&pc->netif, tot_len);
|
mbed714 |
0:d616ece2d859
|
801
|
snmp_inc_ifoutucastpkts(&pc->netif);
|
mbed714 |
0:d616ece2d859
|
802
|
LINK_STATS_INC(link.xmit);
|
mbed714 |
0:d616ece2d859
|
803
|
return ERR_OK;
|
mbed714 |
0:d616ece2d859
|
804
|
}
|
mbed714 |
0:d616ece2d859
|
805
|
#endif /* PPPOE_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
806
|
|
mbed714 |
0:d616ece2d859
|
807
|
/* Send a packet on the given connection. */
|
mbed714 |
0:d616ece2d859
|
808
|
static err_t
|
mbed714 |
0:d616ece2d859
|
809
|
pppifOutput(struct netif *netif, struct pbuf *pb, ip_addr_t *ipaddr)
|
mbed714 |
0:d616ece2d859
|
810
|
{
|
mbed714 |
0:d616ece2d859
|
811
|
int pd = (int)(size_t)netif->state;
|
mbed714 |
0:d616ece2d859
|
812
|
PPPControl *pc = &pppControl[pd];
|
mbed714 |
0:d616ece2d859
|
813
|
#if PPPOS_SUPPORT
|
mbed714 |
0:d616ece2d859
|
814
|
u_short protocol = PPP_IP;
|
mbed714 |
0:d616ece2d859
|
815
|
u_int fcsOut = PPP_INITFCS;
|
mbed714 |
0:d616ece2d859
|
816
|
struct pbuf *headMB = NULL, *tailMB = NULL, *p;
|
mbed714 |
0:d616ece2d859
|
817
|
u_char c;
|
mbed714 |
0:d616ece2d859
|
818
|
#endif /* PPPOS_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
819
|
|
mbed714 |
0:d616ece2d859
|
820
|
LWIP_UNUSED_ARG(ipaddr);
|
mbed714 |
0:d616ece2d859
|
821
|
|
mbed714 |
0:d616ece2d859
|
822
|
/* Validate parameters. */
|
mbed714 |
0:d616ece2d859
|
823
|
/* We let any protocol value go through - it can't hurt us
|
mbed714 |
0:d616ece2d859
|
824
|
* and the peer will just drop it if it's not accepting it. */
|
mbed714 |
0:d616ece2d859
|
825
|
if (pd < 0 || pd >= NUM_PPP || !pc->openFlag || !pb) {
|
mbed714 |
0:d616ece2d859
|
826
|
PPPDEBUG(LOG_WARNING, ("pppifOutput[%d]: bad parms prot=%d pb=%p\n",
|
mbed714 |
0:d616ece2d859
|
827
|
pd, PPP_IP, pb));
|
mbed714 |
0:d616ece2d859
|
828
|
LINK_STATS_INC(link.opterr);
|
mbed714 |
0:d616ece2d859
|
829
|
LINK_STATS_INC(link.drop);
|
mbed714 |
0:d616ece2d859
|
830
|
snmp_inc_ifoutdiscards(netif);
|
mbed714 |
0:d616ece2d859
|
831
|
return ERR_ARG;
|
mbed714 |
0:d616ece2d859
|
832
|
}
|
mbed714 |
0:d616ece2d859
|
833
|
|
mbed714 |
0:d616ece2d859
|
834
|
/* Check that the link is up. */
|
mbed714 |
0:d616ece2d859
|
835
|
if (lcp_phase[pd] == PHASE_DEAD) {
|
mbed714 |
0:d616ece2d859
|
836
|
PPPDEBUG(LOG_ERR, ("pppifOutput[%d]: link not up\n", pd));
|
mbed714 |
0:d616ece2d859
|
837
|
LINK_STATS_INC(link.rterr);
|
mbed714 |
0:d616ece2d859
|
838
|
LINK_STATS_INC(link.drop);
|
mbed714 |
0:d616ece2d859
|
839
|
snmp_inc_ifoutdiscards(netif);
|
mbed714 |
0:d616ece2d859
|
840
|
return ERR_RTE;
|
mbed714 |
0:d616ece2d859
|
841
|
}
|
mbed714 |
0:d616ece2d859
|
842
|
|
mbed714 |
0:d616ece2d859
|
843
|
#if PPPOE_SUPPORT
|
mbed714 |
0:d616ece2d859
|
844
|
if(pc->ethif) {
|
mbed714 |
0:d616ece2d859
|
845
|
return pppifOutputOverEthernet(pd, pb);
|
mbed714 |
0:d616ece2d859
|
846
|
}
|
mbed714 |
0:d616ece2d859
|
847
|
#endif /* PPPOE_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
848
|
|
mbed714 |
0:d616ece2d859
|
849
|
#if PPPOS_SUPPORT
|
mbed714 |
0:d616ece2d859
|
850
|
/* Grab an output buffer. */
|
mbed714 |
0:d616ece2d859
|
851
|
headMB = pbuf_alloc(PBUF_RAW, 0, PBUF_POOL);
|
mbed714 |
0:d616ece2d859
|
852
|
if (headMB == NULL) {
|
mbed714 |
0:d616ece2d859
|
853
|
PPPDEBUG(LOG_WARNING, ("pppifOutput[%d]: first alloc fail\n", pd));
|
mbed714 |
0:d616ece2d859
|
854
|
LINK_STATS_INC(link.memerr);
|
mbed714 |
0:d616ece2d859
|
855
|
LINK_STATS_INC(link.drop);
|
mbed714 |
0:d616ece2d859
|
856
|
snmp_inc_ifoutdiscards(netif);
|
mbed714 |
0:d616ece2d859
|
857
|
return ERR_MEM;
|
mbed714 |
0:d616ece2d859
|
858
|
}
|
mbed714 |
0:d616ece2d859
|
859
|
|
mbed714 |
0:d616ece2d859
|
860
|
#if VJ_SUPPORT
|
mbed714 |
0:d616ece2d859
|
861
|
/*
|
mbed714 |
0:d616ece2d859
|
862
|
* Attempt Van Jacobson header compression if VJ is configured and
|
mbed714 |
0:d616ece2d859
|
863
|
* this is an IP packet.
|
mbed714 |
0:d616ece2d859
|
864
|
*/
|
mbed714 |
0:d616ece2d859
|
865
|
if (protocol == PPP_IP && pc->vjEnabled) {
|
mbed714 |
0:d616ece2d859
|
866
|
switch (vj_compress_tcp(&pc->vjComp, pb)) {
|
mbed714 |
0:d616ece2d859
|
867
|
case TYPE_IP:
|
mbed714 |
0:d616ece2d859
|
868
|
/* No change...
|
mbed714 |
0:d616ece2d859
|
869
|
protocol = PPP_IP_PROTOCOL; */
|
mbed714 |
0:d616ece2d859
|
870
|
break;
|
mbed714 |
0:d616ece2d859
|
871
|
case TYPE_COMPRESSED_TCP:
|
mbed714 |
0:d616ece2d859
|
872
|
protocol = PPP_VJC_COMP;
|
mbed714 |
0:d616ece2d859
|
873
|
break;
|
mbed714 |
0:d616ece2d859
|
874
|
case TYPE_UNCOMPRESSED_TCP:
|
mbed714 |
0:d616ece2d859
|
875
|
protocol = PPP_VJC_UNCOMP;
|
mbed714 |
0:d616ece2d859
|
876
|
break;
|
mbed714 |
0:d616ece2d859
|
877
|
default:
|
mbed714 |
0:d616ece2d859
|
878
|
PPPDEBUG(LOG_WARNING, ("pppifOutput[%d]: bad IP packet\n", pd));
|
mbed714 |
0:d616ece2d859
|
879
|
LINK_STATS_INC(link.proterr);
|
mbed714 |
0:d616ece2d859
|
880
|
LINK_STATS_INC(link.drop);
|
mbed714 |
0:d616ece2d859
|
881
|
snmp_inc_ifoutdiscards(netif);
|
mbed714 |
0:d616ece2d859
|
882
|
pbuf_free(headMB);
|
mbed714 |
0:d616ece2d859
|
883
|
return ERR_VAL;
|
mbed714 |
0:d616ece2d859
|
884
|
}
|
mbed714 |
0:d616ece2d859
|
885
|
}
|
mbed714 |
0:d616ece2d859
|
886
|
#endif /* VJ_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
887
|
|
mbed714 |
0:d616ece2d859
|
888
|
tailMB = headMB;
|
mbed714 |
0:d616ece2d859
|
889
|
|
mbed714 |
0:d616ece2d859
|
890
|
/* Build the PPP header. */
|
mbed714 |
0:d616ece2d859
|
891
|
if ((sys_jiffies() - pc->lastXMit) >= PPP_MAXIDLEFLAG) {
|
mbed714 |
0:d616ece2d859
|
892
|
tailMB = pppAppend(PPP_FLAG, tailMB, NULL);
|
mbed714 |
0:d616ece2d859
|
893
|
}
|
mbed714 |
0:d616ece2d859
|
894
|
|
mbed714 |
0:d616ece2d859
|
895
|
pc->lastXMit = sys_jiffies();
|
mbed714 |
0:d616ece2d859
|
896
|
if (!pc->accomp) {
|
mbed714 |
0:d616ece2d859
|
897
|
fcsOut = PPP_FCS(fcsOut, PPP_ALLSTATIONS);
|
mbed714 |
0:d616ece2d859
|
898
|
tailMB = pppAppend(PPP_ALLSTATIONS, tailMB, &pc->outACCM);
|
mbed714 |
0:d616ece2d859
|
899
|
fcsOut = PPP_FCS(fcsOut, PPP_UI);
|
mbed714 |
0:d616ece2d859
|
900
|
tailMB = pppAppend(PPP_UI, tailMB, &pc->outACCM);
|
mbed714 |
0:d616ece2d859
|
901
|
}
|
mbed714 |
0:d616ece2d859
|
902
|
if (!pc->pcomp || protocol > 0xFF) {
|
mbed714 |
0:d616ece2d859
|
903
|
c = (protocol >> 8) & 0xFF;
|
mbed714 |
0:d616ece2d859
|
904
|
fcsOut = PPP_FCS(fcsOut, c);
|
mbed714 |
0:d616ece2d859
|
905
|
tailMB = pppAppend(c, tailMB, &pc->outACCM);
|
mbed714 |
0:d616ece2d859
|
906
|
}
|
mbed714 |
0:d616ece2d859
|
907
|
c = protocol & 0xFF;
|
mbed714 |
0:d616ece2d859
|
908
|
fcsOut = PPP_FCS(fcsOut, c);
|
mbed714 |
0:d616ece2d859
|
909
|
tailMB = pppAppend(c, tailMB, &pc->outACCM);
|
mbed714 |
0:d616ece2d859
|
910
|
|
mbed714 |
0:d616ece2d859
|
911
|
/* Load packet. */
|
mbed714 |
0:d616ece2d859
|
912
|
for(p = pb; p; p = p->next) {
|
mbed714 |
0:d616ece2d859
|
913
|
int n;
|
mbed714 |
0:d616ece2d859
|
914
|
u_char *sPtr;
|
mbed714 |
0:d616ece2d859
|
915
|
|
mbed714 |
0:d616ece2d859
|
916
|
sPtr = (u_char*)p->payload;
|
mbed714 |
0:d616ece2d859
|
917
|
n = p->len;
|
mbed714 |
0:d616ece2d859
|
918
|
while (n-- > 0) {
|
mbed714 |
0:d616ece2d859
|
919
|
c = *sPtr++;
|
mbed714 |
0:d616ece2d859
|
920
|
|
mbed714 |
0:d616ece2d859
|
921
|
/* Update FCS before checking for special characters. */
|
mbed714 |
0:d616ece2d859
|
922
|
fcsOut = PPP_FCS(fcsOut, c);
|
mbed714 |
0:d616ece2d859
|
923
|
|
mbed714 |
0:d616ece2d859
|
924
|
/* Copy to output buffer escaping special characters. */
|
mbed714 |
0:d616ece2d859
|
925
|
tailMB = pppAppend(c, tailMB, &pc->outACCM);
|
mbed714 |
0:d616ece2d859
|
926
|
}
|
mbed714 |
0:d616ece2d859
|
927
|
}
|
mbed714 |
0:d616ece2d859
|
928
|
|
mbed714 |
0:d616ece2d859
|
929
|
/* Add FCS and trailing flag. */
|
mbed714 |
0:d616ece2d859
|
930
|
c = ~fcsOut & 0xFF;
|
mbed714 |
0:d616ece2d859
|
931
|
tailMB = pppAppend(c, tailMB, &pc->outACCM);
|
mbed714 |
0:d616ece2d859
|
932
|
c = (~fcsOut >> 8) & 0xFF;
|
mbed714 |
0:d616ece2d859
|
933
|
tailMB = pppAppend(c, tailMB, &pc->outACCM);
|
mbed714 |
0:d616ece2d859
|
934
|
tailMB = pppAppend(PPP_FLAG, tailMB, NULL);
|
mbed714 |
0:d616ece2d859
|
935
|
|
mbed714 |
0:d616ece2d859
|
936
|
/* If we failed to complete the packet, throw it away. */
|
mbed714 |
0:d616ece2d859
|
937
|
if (!tailMB) {
|
mbed714 |
0:d616ece2d859
|
938
|
PPPDEBUG(LOG_WARNING,
|
mbed714 |
0:d616ece2d859
|
939
|
("pppifOutput[%d]: Alloc err - dropping proto=%d\n",
|
mbed714 |
0:d616ece2d859
|
940
|
pd, protocol));
|
mbed714 |
0:d616ece2d859
|
941
|
pbuf_free(headMB);
|
mbed714 |
0:d616ece2d859
|
942
|
LINK_STATS_INC(link.memerr);
|
mbed714 |
0:d616ece2d859
|
943
|
LINK_STATS_INC(link.drop);
|
mbed714 |
0:d616ece2d859
|
944
|
snmp_inc_ifoutdiscards(netif);
|
mbed714 |
0:d616ece2d859
|
945
|
return ERR_MEM;
|
mbed714 |
0:d616ece2d859
|
946
|
}
|
mbed714 |
0:d616ece2d859
|
947
|
|
mbed714 |
0:d616ece2d859
|
948
|
/* Send it. */
|
mbed714 |
0:d616ece2d859
|
949
|
PPPDEBUG(LOG_INFO, ("pppifOutput[%d]: proto=0x%"X16_F"\n", pd, protocol));
|
mbed714 |
0:d616ece2d859
|
950
|
|
mbed714 |
0:d616ece2d859
|
951
|
nPut(pc, headMB);
|
mbed714 |
0:d616ece2d859
|
952
|
#endif /* PPPOS_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
953
|
|
mbed714 |
0:d616ece2d859
|
954
|
return ERR_OK;
|
mbed714 |
0:d616ece2d859
|
955
|
}
|
mbed714 |
0:d616ece2d859
|
956
|
|
mbed714 |
0:d616ece2d859
|
957
|
/* Get and set parameters for the given connection.
|
mbed714 |
0:d616ece2d859
|
958
|
* Return 0 on success, an error code on failure. */
|
mbed714 |
0:d616ece2d859
|
959
|
int
|
mbed714 |
0:d616ece2d859
|
960
|
pppIOCtl(int pd, int cmd, void *arg)
|
mbed714 |
0:d616ece2d859
|
961
|
{
|
mbed714 |
0:d616ece2d859
|
962
|
PPPControl *pc = &pppControl[pd];
|
mbed714 |
0:d616ece2d859
|
963
|
int st = 0;
|
mbed714 |
0:d616ece2d859
|
964
|
|
mbed714 |
0:d616ece2d859
|
965
|
if (pd < 0 || pd >= NUM_PPP) {
|
mbed714 |
0:d616ece2d859
|
966
|
st = PPPERR_PARAM;
|
mbed714 |
0:d616ece2d859
|
967
|
} else {
|
mbed714 |
0:d616ece2d859
|
968
|
switch(cmd) {
|
mbed714 |
0:d616ece2d859
|
969
|
case PPPCTLG_UPSTATUS: /* Get the PPP up status. */
|
mbed714 |
0:d616ece2d859
|
970
|
if (arg) {
|
mbed714 |
0:d616ece2d859
|
971
|
*(int *)arg = (int)(pc->if_up);
|
mbed714 |
0:d616ece2d859
|
972
|
} else {
|
mbed714 |
0:d616ece2d859
|
973
|
st = PPPERR_PARAM;
|
mbed714 |
0:d616ece2d859
|
974
|
}
|
mbed714 |
0:d616ece2d859
|
975
|
break;
|
mbed714 |
0:d616ece2d859
|
976
|
case PPPCTLS_ERRCODE: /* Set the PPP error code. */
|
mbed714 |
0:d616ece2d859
|
977
|
if (arg) {
|
mbed714 |
0:d616ece2d859
|
978
|
pc->errCode = *(int *)arg;
|
mbed714 |
0:d616ece2d859
|
979
|
} else {
|
mbed714 |
0:d616ece2d859
|
980
|
st = PPPERR_PARAM;
|
mbed714 |
0:d616ece2d859
|
981
|
}
|
mbed714 |
0:d616ece2d859
|
982
|
break;
|
mbed714 |
0:d616ece2d859
|
983
|
case PPPCTLG_ERRCODE: /* Get the PPP error code. */
|
mbed714 |
0:d616ece2d859
|
984
|
if (arg) {
|
mbed714 |
0:d616ece2d859
|
985
|
*(int *)arg = (int)(pc->errCode);
|
mbed714 |
0:d616ece2d859
|
986
|
} else {
|
mbed714 |
0:d616ece2d859
|
987
|
st = PPPERR_PARAM;
|
mbed714 |
0:d616ece2d859
|
988
|
}
|
mbed714 |
0:d616ece2d859
|
989
|
break;
|
mbed714 |
0:d616ece2d859
|
990
|
#if PPPOS_SUPPORT
|
mbed714 |
0:d616ece2d859
|
991
|
case PPPCTLG_FD: /* Get the fd associated with the ppp */
|
mbed714 |
0:d616ece2d859
|
992
|
if (arg) {
|
mbed714 |
0:d616ece2d859
|
993
|
*(sio_fd_t *)arg = pc->fd;
|
mbed714 |
0:d616ece2d859
|
994
|
} else {
|
mbed714 |
0:d616ece2d859
|
995
|
st = PPPERR_PARAM;
|
mbed714 |
0:d616ece2d859
|
996
|
}
|
mbed714 |
0:d616ece2d859
|
997
|
break;
|
mbed714 |
0:d616ece2d859
|
998
|
#endif /* PPPOS_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
999
|
default:
|
mbed714 |
0:d616ece2d859
|
1000
|
st = PPPERR_PARAM;
|
mbed714 |
0:d616ece2d859
|
1001
|
break;
|
mbed714 |
0:d616ece2d859
|
1002
|
}
|
mbed714 |
0:d616ece2d859
|
1003
|
}
|
mbed714 |
0:d616ece2d859
|
1004
|
|
mbed714 |
0:d616ece2d859
|
1005
|
return st;
|
mbed714 |
0:d616ece2d859
|
1006
|
}
|
mbed714 |
0:d616ece2d859
|
1007
|
|
mbed714 |
0:d616ece2d859
|
1008
|
/*
|
mbed714 |
0:d616ece2d859
|
1009
|
* Return the Maximum Transmission Unit for the given PPP connection.
|
mbed714 |
0:d616ece2d859
|
1010
|
*/
|
mbed714 |
0:d616ece2d859
|
1011
|
u_short
|
mbed714 |
0:d616ece2d859
|
1012
|
pppMTU(int pd)
|
mbed714 |
0:d616ece2d859
|
1013
|
{
|
mbed714 |
0:d616ece2d859
|
1014
|
PPPControl *pc = &pppControl[pd];
|
mbed714 |
0:d616ece2d859
|
1015
|
u_short st;
|
mbed714 |
0:d616ece2d859
|
1016
|
|
mbed714 |
0:d616ece2d859
|
1017
|
/* Validate parameters. */
|
mbed714 |
0:d616ece2d859
|
1018
|
if (pd < 0 || pd >= NUM_PPP || !pc->openFlag) {
|
mbed714 |
0:d616ece2d859
|
1019
|
st = 0;
|
mbed714 |
0:d616ece2d859
|
1020
|
} else {
|
mbed714 |
0:d616ece2d859
|
1021
|
st = pc->mtu;
|
mbed714 |
0:d616ece2d859
|
1022
|
}
|
mbed714 |
0:d616ece2d859
|
1023
|
|
mbed714 |
0:d616ece2d859
|
1024
|
return st;
|
mbed714 |
0:d616ece2d859
|
1025
|
}
|
mbed714 |
0:d616ece2d859
|
1026
|
|
mbed714 |
0:d616ece2d859
|
1027
|
#if PPPOE_SUPPORT
|
mbed714 |
0:d616ece2d859
|
1028
|
int
|
mbed714 |
0:d616ece2d859
|
1029
|
pppWriteOverEthernet(int pd, const u_char *s, int n)
|
mbed714 |
0:d616ece2d859
|
1030
|
{
|
mbed714 |
0:d616ece2d859
|
1031
|
PPPControl *pc = &pppControl[pd];
|
mbed714 |
0:d616ece2d859
|
1032
|
struct pbuf *pb;
|
mbed714 |
0:d616ece2d859
|
1033
|
|
mbed714 |
0:d616ece2d859
|
1034
|
/* skip address & flags */
|
mbed714 |
0:d616ece2d859
|
1035
|
s += 2;
|
mbed714 |
0:d616ece2d859
|
1036
|
n -= 2;
|
mbed714 |
0:d616ece2d859
|
1037
|
|
mbed714 |
0:d616ece2d859
|
1038
|
LWIP_ASSERT("PPPOE_HDRLEN + n <= 0xffff", PPPOE_HDRLEN + n <= 0xffff);
|
mbed714 |
0:d616ece2d859
|
1039
|
pb = pbuf_alloc(PBUF_LINK, (u16_t)(PPPOE_HDRLEN + n), PBUF_RAM);
|
mbed714 |
0:d616ece2d859
|
1040
|
if(!pb) {
|
mbed714 |
0:d616ece2d859
|
1041
|
LINK_STATS_INC(link.memerr);
|
mbed714 |
0:d616ece2d859
|
1042
|
LINK_STATS_INC(link.proterr);
|
mbed714 |
0:d616ece2d859
|
1043
|
snmp_inc_ifoutdiscards(&pc->netif);
|
mbed714 |
0:d616ece2d859
|
1044
|
return PPPERR_ALLOC;
|
mbed714 |
0:d616ece2d859
|
1045
|
}
|
mbed714 |
0:d616ece2d859
|
1046
|
|
mbed714 |
0:d616ece2d859
|
1047
|
pbuf_header(pb, -(s16_t)PPPOE_HDRLEN);
|
mbed714 |
0:d616ece2d859
|
1048
|
|
mbed714 |
0:d616ece2d859
|
1049
|
pc->lastXMit = sys_jiffies();
|
mbed714 |
0:d616ece2d859
|
1050
|
|
mbed714 |
0:d616ece2d859
|
1051
|
MEMCPY(pb->payload, s, n);
|
mbed714 |
0:d616ece2d859
|
1052
|
|
mbed714 |
0:d616ece2d859
|
1053
|
if(pppoe_xmit(pc->pppoe_sc, pb) != ERR_OK) {
|
mbed714 |
0:d616ece2d859
|
1054
|
LINK_STATS_INC(link.err);
|
mbed714 |
0:d616ece2d859
|
1055
|
snmp_inc_ifoutdiscards(&pc->netif);
|
mbed714 |
0:d616ece2d859
|
1056
|
return PPPERR_DEVICE;
|
mbed714 |
0:d616ece2d859
|
1057
|
}
|
mbed714 |
0:d616ece2d859
|
1058
|
|
mbed714 |
0:d616ece2d859
|
1059
|
snmp_add_ifoutoctets(&pc->netif, (u16_t)n);
|
mbed714 |
0:d616ece2d859
|
1060
|
snmp_inc_ifoutucastpkts(&pc->netif);
|
mbed714 |
0:d616ece2d859
|
1061
|
LINK_STATS_INC(link.xmit);
|
mbed714 |
0:d616ece2d859
|
1062
|
return PPPERR_NONE;
|
mbed714 |
0:d616ece2d859
|
1063
|
}
|
mbed714 |
0:d616ece2d859
|
1064
|
#endif /* PPPOE_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
1065
|
|
mbed714 |
0:d616ece2d859
|
1066
|
/*
|
mbed714 |
0:d616ece2d859
|
1067
|
* Write n characters to a ppp link.
|
mbed714 |
0:d616ece2d859
|
1068
|
* RETURN: >= 0 Number of characters written
|
mbed714 |
0:d616ece2d859
|
1069
|
* -1 Failed to write to device
|
mbed714 |
0:d616ece2d859
|
1070
|
*/
|
mbed714 |
0:d616ece2d859
|
1071
|
int
|
mbed714 |
0:d616ece2d859
|
1072
|
pppWrite(int pd, const u_char *s, int n)
|
mbed714 |
0:d616ece2d859
|
1073
|
{
|
mbed714 |
0:d616ece2d859
|
1074
|
PPPControl *pc = &pppControl[pd];
|
mbed714 |
0:d616ece2d859
|
1075
|
#if PPPOS_SUPPORT
|
mbed714 |
0:d616ece2d859
|
1076
|
u_char c;
|
mbed714 |
0:d616ece2d859
|
1077
|
u_int fcsOut;
|
mbed714 |
0:d616ece2d859
|
1078
|
struct pbuf *headMB, *tailMB;
|
mbed714 |
0:d616ece2d859
|
1079
|
#endif /* PPPOS_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
1080
|
|
mbed714 |
0:d616ece2d859
|
1081
|
#if PPPOE_SUPPORT
|
mbed714 |
0:d616ece2d859
|
1082
|
if(pc->ethif) {
|
mbed714 |
0:d616ece2d859
|
1083
|
return pppWriteOverEthernet(pd, s, n);
|
mbed714 |
0:d616ece2d859
|
1084
|
}
|
mbed714 |
0:d616ece2d859
|
1085
|
#endif /* PPPOE_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
1086
|
|
mbed714 |
0:d616ece2d859
|
1087
|
#if PPPOS_SUPPORT
|
mbed714 |
0:d616ece2d859
|
1088
|
headMB = pbuf_alloc(PBUF_RAW, 0, PBUF_POOL);
|
mbed714 |
0:d616ece2d859
|
1089
|
if (headMB == NULL) {
|
mbed714 |
0:d616ece2d859
|
1090
|
LINK_STATS_INC(link.memerr);
|
mbed714 |
0:d616ece2d859
|
1091
|
LINK_STATS_INC(link.proterr);
|
mbed714 |
0:d616ece2d859
|
1092
|
snmp_inc_ifoutdiscards(&pc->netif);
|
mbed714 |
0:d616ece2d859
|
1093
|
return PPPERR_ALLOC;
|
mbed714 |
0:d616ece2d859
|
1094
|
}
|
mbed714 |
0:d616ece2d859
|
1095
|
|
mbed714 |
0:d616ece2d859
|
1096
|
tailMB = headMB;
|
mbed714 |
0:d616ece2d859
|
1097
|
|
mbed714 |
0:d616ece2d859
|
1098
|
/* If the link has been idle, we'll send a fresh flag character to
|
mbed714 |
0:d616ece2d859
|
1099
|
* flush any noise. */
|
mbed714 |
0:d616ece2d859
|
1100
|
if ((sys_jiffies() - pc->lastXMit) >= PPP_MAXIDLEFLAG) {
|
mbed714 |
0:d616ece2d859
|
1101
|
tailMB = pppAppend(PPP_FLAG, tailMB, NULL);
|
mbed714 |
0:d616ece2d859
|
1102
|
}
|
mbed714 |
0:d616ece2d859
|
1103
|
pc->lastXMit = sys_jiffies();
|
mbed714 |
0:d616ece2d859
|
1104
|
|
mbed714 |
0:d616ece2d859
|
1105
|
fcsOut = PPP_INITFCS;
|
mbed714 |
0:d616ece2d859
|
1106
|
/* Load output buffer. */
|
mbed714 |
0:d616ece2d859
|
1107
|
while (n-- > 0) {
|
mbed714 |
0:d616ece2d859
|
1108
|
c = *s++;
|
mbed714 |
0:d616ece2d859
|
1109
|
|
mbed714 |
0:d616ece2d859
|
1110
|
/* Update FCS before checking for special characters. */
|
mbed714 |
0:d616ece2d859
|
1111
|
fcsOut = PPP_FCS(fcsOut, c);
|
mbed714 |
0:d616ece2d859
|
1112
|
|
mbed714 |
0:d616ece2d859
|
1113
|
/* Copy to output buffer escaping special characters. */
|
mbed714 |
0:d616ece2d859
|
1114
|
tailMB = pppAppend(c, tailMB, &pc->outACCM);
|
mbed714 |
0:d616ece2d859
|
1115
|
}
|
mbed714 |
0:d616ece2d859
|
1116
|
|
mbed714 |
0:d616ece2d859
|
1117
|
/* Add FCS and trailing flag. */
|
mbed714 |
0:d616ece2d859
|
1118
|
c = ~fcsOut & 0xFF;
|
mbed714 |
0:d616ece2d859
|
1119
|
tailMB = pppAppend(c, tailMB, &pc->outACCM);
|
mbed714 |
0:d616ece2d859
|
1120
|
c = (~fcsOut >> 8) & 0xFF;
|
mbed714 |
0:d616ece2d859
|
1121
|
tailMB = pppAppend(c, tailMB, &pc->outACCM);
|
mbed714 |
0:d616ece2d859
|
1122
|
tailMB = pppAppend(PPP_FLAG, tailMB, NULL);
|
mbed714 |
0:d616ece2d859
|
1123
|
|
mbed714 |
0:d616ece2d859
|
1124
|
/* If we failed to complete the packet, throw it away.
|
mbed714 |
0:d616ece2d859
|
1125
|
* Otherwise send it. */
|
mbed714 |
0:d616ece2d859
|
1126
|
if (!tailMB) {
|
mbed714 |
0:d616ece2d859
|
1127
|
PPPDEBUG(LOG_WARNING,
|
mbed714 |
0:d616ece2d859
|
1128
|
("pppWrite[%d]: Alloc err - dropping pbuf len=%d\n", pd, headMB->len));
|
mbed714 |
0:d616ece2d859
|
1129
|
/*"pppWrite[%d]: Alloc err - dropping %d:%.*H", pd, headMB->len, LWIP_MIN(headMB->len * 2, 40), headMB->payload)); */
|
mbed714 |
0:d616ece2d859
|
1130
|
pbuf_free(headMB);
|
mbed714 |
0:d616ece2d859
|
1131
|
LINK_STATS_INC(link.memerr);
|
mbed714 |
0:d616ece2d859
|
1132
|
LINK_STATS_INC(link.proterr);
|
mbed714 |
0:d616ece2d859
|
1133
|
snmp_inc_ifoutdiscards(&pc->netif);
|
mbed714 |
0:d616ece2d859
|
1134
|
return PPPERR_ALLOC;
|
mbed714 |
0:d616ece2d859
|
1135
|
}
|
mbed714 |
0:d616ece2d859
|
1136
|
|
mbed714 |
0:d616ece2d859
|
1137
|
PPPDEBUG(LOG_INFO, ("pppWrite[%d]: len=%d\n", pd, headMB->len));
|
mbed714 |
0:d616ece2d859
|
1138
|
/* "pppWrite[%d]: %d:%.*H", pd, headMB->len, LWIP_MIN(headMB->len * 2, 40), headMB->payload)); */
|
mbed714 |
0:d616ece2d859
|
1139
|
nPut(pc, headMB);
|
mbed714 |
0:d616ece2d859
|
1140
|
#endif /* PPPOS_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
1141
|
|
mbed714 |
0:d616ece2d859
|
1142
|
return PPPERR_NONE;
|
mbed714 |
0:d616ece2d859
|
1143
|
}
|
mbed714 |
0:d616ece2d859
|
1144
|
|
mbed714 |
0:d616ece2d859
|
1145
|
/*
|
mbed714 |
0:d616ece2d859
|
1146
|
* ppp_send_config - configure the transmit characteristics of
|
mbed714 |
0:d616ece2d859
|
1147
|
* the ppp interface.
|
mbed714 |
0:d616ece2d859
|
1148
|
*/
|
mbed714 |
0:d616ece2d859
|
1149
|
void
|
mbed714 |
0:d616ece2d859
|
1150
|
ppp_send_config( int unit, u16_t mtu, u32_t asyncmap, int pcomp, int accomp)
|
mbed714 |
0:d616ece2d859
|
1151
|
{
|
mbed714 |
0:d616ece2d859
|
1152
|
PPPControl *pc = &pppControl[unit];
|
mbed714 |
0:d616ece2d859
|
1153
|
int i;
|
mbed714 |
0:d616ece2d859
|
1154
|
|
mbed714 |
0:d616ece2d859
|
1155
|
pc->mtu = mtu;
|
mbed714 |
0:d616ece2d859
|
1156
|
pc->pcomp = pcomp;
|
mbed714 |
0:d616ece2d859
|
1157
|
pc->accomp = accomp;
|
mbed714 |
0:d616ece2d859
|
1158
|
|
mbed714 |
0:d616ece2d859
|
1159
|
/* Load the ACCM bits for the 32 control codes. */
|
mbed714 |
0:d616ece2d859
|
1160
|
for (i = 0; i < 32/8; i++) {
|
mbed714 |
0:d616ece2d859
|
1161
|
pc->outACCM[i] = (u_char)((asyncmap >> (8 * i)) & 0xFF);
|
mbed714 |
0:d616ece2d859
|
1162
|
}
|
mbed714 |
0:d616ece2d859
|
1163
|
PPPDEBUG(LOG_INFO, ("ppp_send_config[%d]: outACCM=%X %X %X %X\n",
|
mbed714 |
0:d616ece2d859
|
1164
|
unit,
|
mbed714 |
0:d616ece2d859
|
1165
|
pc->outACCM[0], pc->outACCM[1], pc->outACCM[2], pc->outACCM[3]));
|
mbed714 |
0:d616ece2d859
|
1166
|
}
|
mbed714 |
0:d616ece2d859
|
1167
|
|
mbed714 |
0:d616ece2d859
|
1168
|
|
mbed714 |
0:d616ece2d859
|
1169
|
/*
|
mbed714 |
0:d616ece2d859
|
1170
|
* ppp_set_xaccm - set the extended transmit ACCM for the interface.
|
mbed714 |
0:d616ece2d859
|
1171
|
*/
|
mbed714 |
0:d616ece2d859
|
1172
|
void
|
mbed714 |
0:d616ece2d859
|
1173
|
ppp_set_xaccm(int unit, ext_accm *accm)
|
mbed714 |
0:d616ece2d859
|
1174
|
{
|
mbed714 |
0:d616ece2d859
|
1175
|
SMEMCPY(pppControl[unit].outACCM, accm, sizeof(ext_accm));
|
mbed714 |
0:d616ece2d859
|
1176
|
PPPDEBUG(LOG_INFO, ("ppp_set_xaccm[%d]: outACCM=%X %X %X %X\n",
|
mbed714 |
0:d616ece2d859
|
1177
|
unit,
|
mbed714 |
0:d616ece2d859
|
1178
|
pppControl[unit].outACCM[0],
|
mbed714 |
0:d616ece2d859
|
1179
|
pppControl[unit].outACCM[1],
|
mbed714 |
0:d616ece2d859
|
1180
|
pppControl[unit].outACCM[2],
|
mbed714 |
0:d616ece2d859
|
1181
|
pppControl[unit].outACCM[3]));
|
mbed714 |
0:d616ece2d859
|
1182
|
}
|
mbed714 |
0:d616ece2d859
|
1183
|
|
mbed714 |
0:d616ece2d859
|
1184
|
|
mbed714 |
0:d616ece2d859
|
1185
|
/*
|
mbed714 |
0:d616ece2d859
|
1186
|
* ppp_recv_config - configure the receive-side characteristics of
|
mbed714 |
0:d616ece2d859
|
1187
|
* the ppp interface.
|
mbed714 |
0:d616ece2d859
|
1188
|
*/
|
mbed714 |
0:d616ece2d859
|
1189
|
void
|
mbed714 |
0:d616ece2d859
|
1190
|
ppp_recv_config( int unit, int mru, u32_t asyncmap, int pcomp, int accomp)
|
mbed714 |
0:d616ece2d859
|
1191
|
{
|
mbed714 |
0:d616ece2d859
|
1192
|
PPPControl *pc = &pppControl[unit];
|
mbed714 |
0:d616ece2d859
|
1193
|
int i;
|
mbed714 |
0:d616ece2d859
|
1194
|
SYS_ARCH_DECL_PROTECT(lev);
|
mbed714 |
0:d616ece2d859
|
1195
|
|
mbed714 |
0:d616ece2d859
|
1196
|
LWIP_UNUSED_ARG(accomp);
|
mbed714 |
0:d616ece2d859
|
1197
|
LWIP_UNUSED_ARG(pcomp);
|
mbed714 |
0:d616ece2d859
|
1198
|
LWIP_UNUSED_ARG(mru);
|
mbed714 |
0:d616ece2d859
|
1199
|
|
mbed714 |
0:d616ece2d859
|
1200
|
/* Load the ACCM bits for the 32 control codes. */
|
mbed714 |
0:d616ece2d859
|
1201
|
SYS_ARCH_PROTECT(lev);
|
mbed714 |
0:d616ece2d859
|
1202
|
for (i = 0; i < 32 / 8; i++) {
|
mbed714 |
0:d616ece2d859
|
1203
|
/* @todo: does this work? ext_accm has been modified from pppd! */
|
mbed714 |
0:d616ece2d859
|
1204
|
pc->rx.inACCM[i] = (u_char)(asyncmap >> (i * 8));
|
mbed714 |
0:d616ece2d859
|
1205
|
}
|
mbed714 |
0:d616ece2d859
|
1206
|
SYS_ARCH_UNPROTECT(lev);
|
mbed714 |
0:d616ece2d859
|
1207
|
PPPDEBUG(LOG_INFO, ("ppp_recv_config[%d]: inACCM=%X %X %X %X\n",
|
mbed714 |
0:d616ece2d859
|
1208
|
unit,
|
mbed714 |
0:d616ece2d859
|
1209
|
pc->rx.inACCM[0], pc->rx.inACCM[1], pc->rx.inACCM[2], pc->rx.inACCM[3]));
|
mbed714 |
0:d616ece2d859
|
1210
|
}
|
mbed714 |
0:d616ece2d859
|
1211
|
|
mbed714 |
0:d616ece2d859
|
1212
|
#if 0
|
mbed714 |
0:d616ece2d859
|
1213
|
/*
|
mbed714 |
0:d616ece2d859
|
1214
|
* ccp_test - ask kernel whether a given compression method
|
mbed714 |
0:d616ece2d859
|
1215
|
* is acceptable for use. Returns 1 if the method and parameters
|
mbed714 |
0:d616ece2d859
|
1216
|
* are OK, 0 if the method is known but the parameters are not OK
|
mbed714 |
0:d616ece2d859
|
1217
|
* (e.g. code size should be reduced), or -1 if the method is unknown.
|
mbed714 |
0:d616ece2d859
|
1218
|
*/
|
mbed714 |
0:d616ece2d859
|
1219
|
int
|
mbed714 |
0:d616ece2d859
|
1220
|
ccp_test( int unit, int opt_len, int for_transmit, u_char *opt_ptr)
|
mbed714 |
0:d616ece2d859
|
1221
|
{
|
mbed714 |
0:d616ece2d859
|
1222
|
return 0; /* XXX Currently no compression. */
|
mbed714 |
0:d616ece2d859
|
1223
|
}
|
mbed714 |
0:d616ece2d859
|
1224
|
|
mbed714 |
0:d616ece2d859
|
1225
|
/*
|
mbed714 |
0:d616ece2d859
|
1226
|
* ccp_flags_set - inform kernel about the current state of CCP.
|
mbed714 |
0:d616ece2d859
|
1227
|
*/
|
mbed714 |
0:d616ece2d859
|
1228
|
void
|
mbed714 |
0:d616ece2d859
|
1229
|
ccp_flags_set(int unit, int isopen, int isup)
|
mbed714 |
0:d616ece2d859
|
1230
|
{
|
mbed714 |
0:d616ece2d859
|
1231
|
/* XXX */
|
mbed714 |
0:d616ece2d859
|
1232
|
}
|
mbed714 |
0:d616ece2d859
|
1233
|
|
mbed714 |
0:d616ece2d859
|
1234
|
/*
|
mbed714 |
0:d616ece2d859
|
1235
|
* ccp_fatal_error - returns 1 if decompression was disabled as a
|
mbed714 |
0:d616ece2d859
|
1236
|
* result of an error detected after decompression of a packet,
|
mbed714 |
0:d616ece2d859
|
1237
|
* 0 otherwise. This is necessary because of patent nonsense.
|
mbed714 |
0:d616ece2d859
|
1238
|
*/
|
mbed714 |
0:d616ece2d859
|
1239
|
int
|
mbed714 |
0:d616ece2d859
|
1240
|
ccp_fatal_error(int unit)
|
mbed714 |
0:d616ece2d859
|
1241
|
{
|
mbed714 |
0:d616ece2d859
|
1242
|
/* XXX */
|
mbed714 |
0:d616ece2d859
|
1243
|
return 0;
|
mbed714 |
0:d616ece2d859
|
1244
|
}
|
mbed714 |
0:d616ece2d859
|
1245
|
#endif
|
mbed714 |
0:d616ece2d859
|
1246
|
|
mbed714 |
0:d616ece2d859
|
1247
|
/*
|
mbed714 |
0:d616ece2d859
|
1248
|
* get_idle_time - return how long the link has been idle.
|
mbed714 |
0:d616ece2d859
|
1249
|
*/
|
mbed714 |
0:d616ece2d859
|
1250
|
int
|
mbed714 |
0:d616ece2d859
|
1251
|
get_idle_time(int u, struct ppp_idle *ip)
|
mbed714 |
0:d616ece2d859
|
1252
|
{
|
mbed714 |
0:d616ece2d859
|
1253
|
/* XXX */
|
mbed714 |
0:d616ece2d859
|
1254
|
LWIP_UNUSED_ARG(u);
|
mbed714 |
0:d616ece2d859
|
1255
|
LWIP_UNUSED_ARG(ip);
|
mbed714 |
0:d616ece2d859
|
1256
|
|
mbed714 |
0:d616ece2d859
|
1257
|
return 0;
|
mbed714 |
0:d616ece2d859
|
1258
|
}
|
mbed714 |
0:d616ece2d859
|
1259
|
|
mbed714 |
0:d616ece2d859
|
1260
|
|
mbed714 |
0:d616ece2d859
|
1261
|
/*
|
mbed714 |
0:d616ece2d859
|
1262
|
* Return user specified netmask, modified by any mask we might determine
|
mbed714 |
0:d616ece2d859
|
1263
|
* for address `addr' (in network byte order).
|
mbed714 |
0:d616ece2d859
|
1264
|
* Here we scan through the system's list of interfaces, looking for
|
mbed714 |
0:d616ece2d859
|
1265
|
* any non-point-to-point interfaces which might appear to be on the same
|
mbed714 |
0:d616ece2d859
|
1266
|
* network as `addr'. If we find any, we OR in their netmask to the
|
mbed714 |
0:d616ece2d859
|
1267
|
* user-specified netmask.
|
mbed714 |
0:d616ece2d859
|
1268
|
*/
|
mbed714 |
0:d616ece2d859
|
1269
|
u32_t
|
mbed714 |
0:d616ece2d859
|
1270
|
GetMask(u32_t addr)
|
mbed714 |
0:d616ece2d859
|
1271
|
{
|
mbed714 |
0:d616ece2d859
|
1272
|
u32_t mask, nmask;
|
mbed714 |
0:d616ece2d859
|
1273
|
|
mbed714 |
0:d616ece2d859
|
1274
|
htonl(addr);
|
mbed714 |
0:d616ece2d859
|
1275
|
if (IP_CLASSA(addr)) { /* determine network mask for address class */
|
mbed714 |
0:d616ece2d859
|
1276
|
nmask = IP_CLASSA_NET;
|
mbed714 |
0:d616ece2d859
|
1277
|
} else if (IP_CLASSB(addr)) {
|
mbed714 |
0:d616ece2d859
|
1278
|
nmask = IP_CLASSB_NET;
|
mbed714 |
0:d616ece2d859
|
1279
|
} else {
|
mbed714 |
0:d616ece2d859
|
1280
|
nmask = IP_CLASSC_NET;
|
mbed714 |
0:d616ece2d859
|
1281
|
}
|
mbed714 |
0:d616ece2d859
|
1282
|
|
mbed714 |
0:d616ece2d859
|
1283
|
/* class D nets are disallowed by bad_ip_adrs */
|
mbed714 |
0:d616ece2d859
|
1284
|
mask = subnetMask | htonl(nmask);
|
mbed714 |
0:d616ece2d859
|
1285
|
|
mbed714 |
0:d616ece2d859
|
1286
|
/* XXX
|
mbed714 |
0:d616ece2d859
|
1287
|
* Scan through the system's network interfaces.
|
mbed714 |
0:d616ece2d859
|
1288
|
* Get each netmask and OR them into our mask.
|
mbed714 |
0:d616ece2d859
|
1289
|
*/
|
mbed714 |
0:d616ece2d859
|
1290
|
|
mbed714 |
0:d616ece2d859
|
1291
|
return mask;
|
mbed714 |
0:d616ece2d859
|
1292
|
}
|
mbed714 |
0:d616ece2d859
|
1293
|
|
mbed714 |
0:d616ece2d859
|
1294
|
/*
|
mbed714 |
0:d616ece2d859
|
1295
|
* sifvjcomp - config tcp header compression
|
mbed714 |
0:d616ece2d859
|
1296
|
*/
|
mbed714 |
0:d616ece2d859
|
1297
|
int
|
mbed714 |
0:d616ece2d859
|
1298
|
sifvjcomp(int pd, int vjcomp, u8_t cidcomp, u8_t maxcid)
|
mbed714 |
0:d616ece2d859
|
1299
|
{
|
mbed714 |
0:d616ece2d859
|
1300
|
#if PPPOS_SUPPORT && VJ_SUPPORT
|
mbed714 |
0:d616ece2d859
|
1301
|
PPPControl *pc = &pppControl[pd];
|
mbed714 |
0:d616ece2d859
|
1302
|
|
mbed714 |
0:d616ece2d859
|
1303
|
pc->vjEnabled = vjcomp;
|
mbed714 |
0:d616ece2d859
|
1304
|
pc->vjComp.compressSlot = cidcomp;
|
mbed714 |
0:d616ece2d859
|
1305
|
pc->vjComp.maxSlotIndex = maxcid;
|
mbed714 |
0:d616ece2d859
|
1306
|
PPPDEBUG(LOG_INFO, ("sifvjcomp: VJ compress enable=%d slot=%d max slot=%d\n",
|
mbed714 |
0:d616ece2d859
|
1307
|
vjcomp, cidcomp, maxcid));
|
mbed714 |
0:d616ece2d859
|
1308
|
#else /* PPPOS_SUPPORT && VJ_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
1309
|
LWIP_UNUSED_ARG(pd);
|
mbed714 |
0:d616ece2d859
|
1310
|
LWIP_UNUSED_ARG(vjcomp);
|
mbed714 |
0:d616ece2d859
|
1311
|
LWIP_UNUSED_ARG(cidcomp);
|
mbed714 |
0:d616ece2d859
|
1312
|
LWIP_UNUSED_ARG(maxcid);
|
mbed714 |
0:d616ece2d859
|
1313
|
#endif /* PPPOS_SUPPORT && VJ_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
1314
|
|
mbed714 |
0:d616ece2d859
|
1315
|
return 0;
|
mbed714 |
0:d616ece2d859
|
1316
|
}
|
mbed714 |
0:d616ece2d859
|
1317
|
|
mbed714 |
0:d616ece2d859
|
1318
|
/*
|
mbed714 |
0:d616ece2d859
|
1319
|
* pppifNetifInit - netif init callback
|
mbed714 |
0:d616ece2d859
|
1320
|
*/
|
mbed714 |
0:d616ece2d859
|
1321
|
static err_t
|
mbed714 |
0:d616ece2d859
|
1322
|
pppifNetifInit(struct netif *netif)
|
mbed714 |
0:d616ece2d859
|
1323
|
{
|
mbed714 |
0:d616ece2d859
|
1324
|
netif->name[0] = 'p';
|
mbed714 |
0:d616ece2d859
|
1325
|
netif->name[1] = 'p';
|
mbed714 |
0:d616ece2d859
|
1326
|
netif->output = pppifOutput;
|
mbed714 |
0:d616ece2d859
|
1327
|
netif->mtu = pppMTU((int)(size_t)netif->state);
|
mbed714 |
0:d616ece2d859
|
1328
|
netif->flags = NETIF_FLAG_POINTTOPOINT | NETIF_FLAG_LINK_UP;
|
mbed714 |
0:d616ece2d859
|
1329
|
#if LWIP_NETIF_HOSTNAME
|
mbed714 |
0:d616ece2d859
|
1330
|
/* @todo: Initialize interface hostname */
|
mbed714 |
0:d616ece2d859
|
1331
|
/* netif_set_hostname(netif, "lwip"); */
|
mbed714 |
0:d616ece2d859
|
1332
|
#endif /* LWIP_NETIF_HOSTNAME */
|
mbed714 |
0:d616ece2d859
|
1333
|
return ERR_OK;
|
mbed714 |
0:d616ece2d859
|
1334
|
}
|
mbed714 |
0:d616ece2d859
|
1335
|
|
mbed714 |
0:d616ece2d859
|
1336
|
|
mbed714 |
0:d616ece2d859
|
1337
|
/*
|
mbed714 |
0:d616ece2d859
|
1338
|
* sifup - Config the interface up and enable IP packets to pass.
|
mbed714 |
0:d616ece2d859
|
1339
|
*/
|
mbed714 |
0:d616ece2d859
|
1340
|
int
|
mbed714 |
0:d616ece2d859
|
1341
|
sifup(int pd)
|
mbed714 |
0:d616ece2d859
|
1342
|
{
|
mbed714 |
0:d616ece2d859
|
1343
|
PPPControl *pc = &pppControl[pd];
|
mbed714 |
0:d616ece2d859
|
1344
|
int st = 1;
|
mbed714 |
0:d616ece2d859
|
1345
|
|
mbed714 |
0:d616ece2d859
|
1346
|
if (pd < 0 || pd >= NUM_PPP || !pc->openFlag) {
|
mbed714 |
0:d616ece2d859
|
1347
|
st = 0;
|
mbed714 |
0:d616ece2d859
|
1348
|
PPPDEBUG(LOG_WARNING, ("sifup[%d]: bad parms\n", pd));
|
mbed714 |
0:d616ece2d859
|
1349
|
} else {
|
mbed714 |
0:d616ece2d859
|
1350
|
netif_remove(&pc->netif);
|
mbed714 |
0:d616ece2d859
|
1351
|
if (netif_add(&pc->netif, &pc->addrs.our_ipaddr, &pc->addrs.netmask,
|
mbed714 |
0:d616ece2d859
|
1352
|
&pc->addrs.his_ipaddr, (void *)(size_t)pd, pppifNetifInit, ip_input)) {
|
mbed714 |
0:d616ece2d859
|
1353
|
netif_set_up(&pc->netif);
|
mbed714 |
0:d616ece2d859
|
1354
|
pc->if_up = 1;
|
mbed714 |
0:d616ece2d859
|
1355
|
pc->errCode = PPPERR_NONE;
|
mbed714 |
0:d616ece2d859
|
1356
|
|
mbed714 |
0:d616ece2d859
|
1357
|
PPPDEBUG(LOG_DEBUG, ("sifup: unit %d: linkStatusCB=%p errCode=%d\n", pd, pc->linkStatusCB, pc->errCode));
|
mbed714 |
0:d616ece2d859
|
1358
|
if (pc->linkStatusCB) {
|
mbed714 |
0:d616ece2d859
|
1359
|
pc->linkStatusCB(pc->linkStatusCtx, pc->errCode, &pc->addrs);
|
mbed714 |
0:d616ece2d859
|
1360
|
}
|
mbed714 |
0:d616ece2d859
|
1361
|
} else {
|
mbed714 |
0:d616ece2d859
|
1362
|
st = 0;
|
mbed714 |
0:d616ece2d859
|
1363
|
PPPDEBUG(LOG_ERR, ("sifup[%d]: netif_add failed\n", pd));
|
mbed714 |
0:d616ece2d859
|
1364
|
}
|
mbed714 |
0:d616ece2d859
|
1365
|
}
|
mbed714 |
0:d616ece2d859
|
1366
|
|
mbed714 |
0:d616ece2d859
|
1367
|
return st;
|
mbed714 |
0:d616ece2d859
|
1368
|
}
|
mbed714 |
0:d616ece2d859
|
1369
|
|
mbed714 |
0:d616ece2d859
|
1370
|
/*
|
mbed714 |
0:d616ece2d859
|
1371
|
* sifnpmode - Set the mode for handling packets for a given NP.
|
mbed714 |
0:d616ece2d859
|
1372
|
*/
|
mbed714 |
0:d616ece2d859
|
1373
|
int
|
mbed714 |
0:d616ece2d859
|
1374
|
sifnpmode(int u, int proto, enum NPmode mode)
|
mbed714 |
0:d616ece2d859
|
1375
|
{
|
mbed714 |
0:d616ece2d859
|
1376
|
LWIP_UNUSED_ARG(u);
|
mbed714 |
0:d616ece2d859
|
1377
|
LWIP_UNUSED_ARG(proto);
|
mbed714 |
0:d616ece2d859
|
1378
|
LWIP_UNUSED_ARG(mode);
|
mbed714 |
0:d616ece2d859
|
1379
|
return 0;
|
mbed714 |
0:d616ece2d859
|
1380
|
}
|
mbed714 |
0:d616ece2d859
|
1381
|
|
mbed714 |
0:d616ece2d859
|
1382
|
/*
|
mbed714 |
0:d616ece2d859
|
1383
|
* sifdown - Config the interface down and disable IP.
|
mbed714 |
0:d616ece2d859
|
1384
|
*/
|
mbed714 |
0:d616ece2d859
|
1385
|
int
|
mbed714 |
0:d616ece2d859
|
1386
|
sifdown(int pd)
|
mbed714 |
0:d616ece2d859
|
1387
|
{
|
mbed714 |
0:d616ece2d859
|
1388
|
PPPControl *pc = &pppControl[pd];
|
mbed714 |
0:d616ece2d859
|
1389
|
int st = 1;
|
mbed714 |
0:d616ece2d859
|
1390
|
|
mbed714 |
0:d616ece2d859
|
1391
|
if (pd < 0 || pd >= NUM_PPP || !pc->openFlag) {
|
mbed714 |
0:d616ece2d859
|
1392
|
st = 0;
|
mbed714 |
0:d616ece2d859
|
1393
|
PPPDEBUG(LOG_WARNING, ("sifdown[%d]: bad parms\n", pd));
|
mbed714 |
0:d616ece2d859
|
1394
|
} else {
|
mbed714 |
0:d616ece2d859
|
1395
|
pc->if_up = 0;
|
mbed714 |
0:d616ece2d859
|
1396
|
/* make sure the netif status callback is called */
|
mbed714 |
0:d616ece2d859
|
1397
|
netif_set_down(&pc->netif);
|
mbed714 |
0:d616ece2d859
|
1398
|
netif_remove(&pc->netif);
|
mbed714 |
0:d616ece2d859
|
1399
|
PPPDEBUG(LOG_DEBUG, ("sifdown: unit %d: linkStatusCB=%p errCode=%d\n", pd, pc->linkStatusCB, pc->errCode));
|
mbed714 |
0:d616ece2d859
|
1400
|
if (pc->linkStatusCB) {
|
mbed714 |
0:d616ece2d859
|
1401
|
pc->linkStatusCB(pc->linkStatusCtx, PPPERR_CONNECT, NULL);
|
mbed714 |
0:d616ece2d859
|
1402
|
}
|
mbed714 |
0:d616ece2d859
|
1403
|
}
|
mbed714 |
0:d616ece2d859
|
1404
|
return st;
|
mbed714 |
0:d616ece2d859
|
1405
|
}
|
mbed714 |
0:d616ece2d859
|
1406
|
|
mbed714 |
0:d616ece2d859
|
1407
|
/**
|
mbed714 |
0:d616ece2d859
|
1408
|
* sifaddr - Config the interface IP addresses and netmask.
|
mbed714 |
0:d616ece2d859
|
1409
|
* @param pd Interface unit ???
|
mbed714 |
0:d616ece2d859
|
1410
|
* @param o Our IP address ???
|
mbed714 |
0:d616ece2d859
|
1411
|
* @param h His IP address ???
|
mbed714 |
0:d616ece2d859
|
1412
|
* @param m IP subnet mask ???
|
mbed714 |
0:d616ece2d859
|
1413
|
* @param ns1 Primary DNS
|
mbed714 |
0:d616ece2d859
|
1414
|
* @param ns2 Secondary DNS
|
mbed714 |
0:d616ece2d859
|
1415
|
*/
|
mbed714 |
0:d616ece2d859
|
1416
|
int
|
mbed714 |
0:d616ece2d859
|
1417
|
sifaddr( int pd, u32_t o, u32_t h, u32_t m, u32_t ns1, u32_t ns2)
|
mbed714 |
0:d616ece2d859
|
1418
|
{
|
mbed714 |
0:d616ece2d859
|
1419
|
PPPControl *pc = &pppControl[pd];
|
mbed714 |
0:d616ece2d859
|
1420
|
int st = 1;
|
mbed714 |
0:d616ece2d859
|
1421
|
|
mbed714 |
0:d616ece2d859
|
1422
|
if (pd < 0 || pd >= NUM_PPP || !pc->openFlag) {
|
mbed714 |
0:d616ece2d859
|
1423
|
st = 0;
|
mbed714 |
0:d616ece2d859
|
1424
|
PPPDEBUG(LOG_WARNING, ("sifup[%d]: bad parms\n", pd));
|
mbed714 |
0:d616ece2d859
|
1425
|
} else {
|
mbed714 |
0:d616ece2d859
|
1426
|
SMEMCPY(&pc->addrs.our_ipaddr, &o, sizeof(o));
|
mbed714 |
0:d616ece2d859
|
1427
|
SMEMCPY(&pc->addrs.his_ipaddr, &h, sizeof(h));
|
mbed714 |
0:d616ece2d859
|
1428
|
SMEMCPY(&pc->addrs.netmask, &m, sizeof(m));
|
mbed714 |
0:d616ece2d859
|
1429
|
SMEMCPY(&pc->addrs.dns1, &ns1, sizeof(ns1));
|
mbed714 |
0:d616ece2d859
|
1430
|
SMEMCPY(&pc->addrs.dns2, &ns2, sizeof(ns2));
|
mbed714 |
0:d616ece2d859
|
1431
|
}
|
mbed714 |
0:d616ece2d859
|
1432
|
return st;
|
mbed714 |
0:d616ece2d859
|
1433
|
}
|
mbed714 |
0:d616ece2d859
|
1434
|
|
mbed714 |
0:d616ece2d859
|
1435
|
/**
|
mbed714 |
0:d616ece2d859
|
1436
|
* cifaddr - Clear the interface IP addresses, and delete routes
|
mbed714 |
0:d616ece2d859
|
1437
|
* through the interface if possible.
|
mbed714 |
0:d616ece2d859
|
1438
|
* @param pd Interface unit ???
|
mbed714 |
0:d616ece2d859
|
1439
|
* @param o Our IP address ???
|
mbed714 |
0:d616ece2d859
|
1440
|
* @param h IP broadcast address ???
|
mbed714 |
0:d616ece2d859
|
1441
|
*/
|
mbed714 |
0:d616ece2d859
|
1442
|
int
|
mbed714 |
0:d616ece2d859
|
1443
|
cifaddr( int pd, u32_t o, u32_t h)
|
mbed714 |
0:d616ece2d859
|
1444
|
{
|
mbed714 |
0:d616ece2d859
|
1445
|
PPPControl *pc = &pppControl[pd];
|
mbed714 |
0:d616ece2d859
|
1446
|
int st = 1;
|
mbed714 |
0:d616ece2d859
|
1447
|
|
mbed714 |
0:d616ece2d859
|
1448
|
LWIP_UNUSED_ARG(o);
|
mbed714 |
0:d616ece2d859
|
1449
|
LWIP_UNUSED_ARG(h);
|
mbed714 |
0:d616ece2d859
|
1450
|
if (pd < 0 || pd >= NUM_PPP || !pc->openFlag) {
|
mbed714 |
0:d616ece2d859
|
1451
|
st = 0;
|
mbed714 |
0:d616ece2d859
|
1452
|
PPPDEBUG(LOG_WARNING, ("sifup[%d]: bad parms\n", pd));
|
mbed714 |
0:d616ece2d859
|
1453
|
} else {
|
mbed714 |
0:d616ece2d859
|
1454
|
IP4_ADDR(&pc->addrs.our_ipaddr, 0,0,0,0);
|
mbed714 |
0:d616ece2d859
|
1455
|
IP4_ADDR(&pc->addrs.his_ipaddr, 0,0,0,0);
|
mbed714 |
0:d616ece2d859
|
1456
|
IP4_ADDR(&pc->addrs.netmask, 255,255,255,0);
|
mbed714 |
0:d616ece2d859
|
1457
|
IP4_ADDR(&pc->addrs.dns1, 0,0,0,0);
|
mbed714 |
0:d616ece2d859
|
1458
|
IP4_ADDR(&pc->addrs.dns2, 0,0,0,0);
|
mbed714 |
0:d616ece2d859
|
1459
|
}
|
mbed714 |
0:d616ece2d859
|
1460
|
return st;
|
mbed714 |
0:d616ece2d859
|
1461
|
}
|
mbed714 |
0:d616ece2d859
|
1462
|
|
mbed714 |
0:d616ece2d859
|
1463
|
/*
|
mbed714 |
0:d616ece2d859
|
1464
|
* sifdefaultroute - assign a default route through the address given.
|
mbed714 |
0:d616ece2d859
|
1465
|
*/
|
mbed714 |
0:d616ece2d859
|
1466
|
int
|
mbed714 |
0:d616ece2d859
|
1467
|
sifdefaultroute(int pd, u32_t l, u32_t g)
|
mbed714 |
0:d616ece2d859
|
1468
|
{
|
mbed714 |
0:d616ece2d859
|
1469
|
PPPControl *pc = &pppControl[pd];
|
mbed714 |
0:d616ece2d859
|
1470
|
int st = 1;
|
mbed714 |
0:d616ece2d859
|
1471
|
|
mbed714 |
0:d616ece2d859
|
1472
|
LWIP_UNUSED_ARG(l);
|
mbed714 |
0:d616ece2d859
|
1473
|
LWIP_UNUSED_ARG(g);
|
mbed714 |
0:d616ece2d859
|
1474
|
|
mbed714 |
0:d616ece2d859
|
1475
|
if (pd < 0 || pd >= NUM_PPP || !pc->openFlag) {
|
mbed714 |
0:d616ece2d859
|
1476
|
st = 0;
|
mbed714 |
0:d616ece2d859
|
1477
|
PPPDEBUG(LOG_WARNING, ("sifup[%d]: bad parms\n", pd));
|
mbed714 |
0:d616ece2d859
|
1478
|
} else {
|
mbed714 |
0:d616ece2d859
|
1479
|
netif_set_default(&pc->netif);
|
mbed714 |
0:d616ece2d859
|
1480
|
}
|
mbed714 |
0:d616ece2d859
|
1481
|
|
mbed714 |
0:d616ece2d859
|
1482
|
/* TODO: check how PPP handled the netMask, previously not set by ipSetDefault */
|
mbed714 |
0:d616ece2d859
|
1483
|
|
mbed714 |
0:d616ece2d859
|
1484
|
return st;
|
mbed714 |
0:d616ece2d859
|
1485
|
}
|
mbed714 |
0:d616ece2d859
|
1486
|
|
mbed714 |
0:d616ece2d859
|
1487
|
/*
|
mbed714 |
0:d616ece2d859
|
1488
|
* cifdefaultroute - delete a default route through the address given.
|
mbed714 |
0:d616ece2d859
|
1489
|
*/
|
mbed714 |
0:d616ece2d859
|
1490
|
int
|
mbed714 |
0:d616ece2d859
|
1491
|
cifdefaultroute(int pd, u32_t l, u32_t g)
|
mbed714 |
0:d616ece2d859
|
1492
|
{
|
mbed714 |
0:d616ece2d859
|
1493
|
PPPControl *pc = &pppControl[pd];
|
mbed714 |
0:d616ece2d859
|
1494
|
int st = 1;
|
mbed714 |
0:d616ece2d859
|
1495
|
|
mbed714 |
0:d616ece2d859
|
1496
|
LWIP_UNUSED_ARG(l);
|
mbed714 |
0:d616ece2d859
|
1497
|
LWIP_UNUSED_ARG(g);
|
mbed714 |
0:d616ece2d859
|
1498
|
|
mbed714 |
0:d616ece2d859
|
1499
|
if (pd < 0 || pd >= NUM_PPP || !pc->openFlag) {
|
mbed714 |
0:d616ece2d859
|
1500
|
st = 0;
|
mbed714 |
0:d616ece2d859
|
1501
|
PPPDEBUG(LOG_WARNING, ("sifup[%d]: bad parms\n", pd));
|
mbed714 |
0:d616ece2d859
|
1502
|
} else {
|
mbed714 |
0:d616ece2d859
|
1503
|
netif_set_default(NULL);
|
mbed714 |
0:d616ece2d859
|
1504
|
}
|
mbed714 |
0:d616ece2d859
|
1505
|
|
mbed714 |
0:d616ece2d859
|
1506
|
return st;
|
mbed714 |
0:d616ece2d859
|
1507
|
}
|
mbed714 |
0:d616ece2d859
|
1508
|
|
mbed714 |
0:d616ece2d859
|
1509
|
/**********************************/
|
mbed714 |
0:d616ece2d859
|
1510
|
/*** LOCAL FUNCTION DEFINITIONS ***/
|
mbed714 |
0:d616ece2d859
|
1511
|
/**********************************/
|
mbed714 |
0:d616ece2d859
|
1512
|
|
mbed714 |
0:d616ece2d859
|
1513
|
#if PPPOS_SUPPORT && PPP_INPROC_OWNTHREAD
|
mbed714 |
0:d616ece2d859
|
1514
|
/* The main PPP process function. This implements the state machine according
|
mbed714 |
0:d616ece2d859
|
1515
|
* to section 4 of RFC 1661: The Point-To-Point Protocol. */
|
mbed714 |
0:d616ece2d859
|
1516
|
static void
|
mbed714 |
0:d616ece2d859
|
1517
|
pppInputThread(void *arg)
|
mbed714 |
0:d616ece2d859
|
1518
|
{
|
mbed714 |
0:d616ece2d859
|
1519
|
int count;
|
mbed714 |
0:d616ece2d859
|
1520
|
PPPControlRx *pcrx = arg;
|
mbed714 |
0:d616ece2d859
|
1521
|
|
mbed714 |
0:d616ece2d859
|
1522
|
while (lcp_phase[pcrx->pd] != PHASE_DEAD) {
|
mbed714 |
0:d616ece2d859
|
1523
|
count = sio_read(pcrx->fd, pcrx->rxbuf, PPPOS_RX_BUFSIZE);
|
mbed714 |
0:d616ece2d859
|
1524
|
if(count > 0) {
|
mbed714 |
0:d616ece2d859
|
1525
|
pppInProc(pcrx, pcrx->rxbuf, count);
|
mbed714 |
0:d616ece2d859
|
1526
|
} else {
|
mbed714 |
0:d616ece2d859
|
1527
|
/* nothing received, give other tasks a chance to run */
|
mbed714 |
0:d616ece2d859
|
1528
|
sys_msleep(1);
|
mbed714 |
0:d616ece2d859
|
1529
|
}
|
mbed714 |
0:d616ece2d859
|
1530
|
}
|
mbed714 |
0:d616ece2d859
|
1531
|
}
|
mbed714 |
0:d616ece2d859
|
1532
|
#endif /* PPPOS_SUPPORT && PPP_INPROC_OWNTHREAD */
|
mbed714 |
0:d616ece2d859
|
1533
|
|
mbed714 |
0:d616ece2d859
|
1534
|
#if PPPOE_SUPPORT
|
mbed714 |
0:d616ece2d859
|
1535
|
|
mbed714 |
0:d616ece2d859
|
1536
|
void
|
mbed714 |
0:d616ece2d859
|
1537
|
pppOverEthernetInitFailed(int pd)
|
mbed714 |
0:d616ece2d859
|
1538
|
{
|
mbed714 |
0:d616ece2d859
|
1539
|
PPPControl* pc;
|
mbed714 |
0:d616ece2d859
|
1540
|
|
mbed714 |
0:d616ece2d859
|
1541
|
pppHup(pd);
|
mbed714 |
0:d616ece2d859
|
1542
|
pppStop(pd);
|
mbed714 |
0:d616ece2d859
|
1543
|
|
mbed714 |
0:d616ece2d859
|
1544
|
pc = &pppControl[pd];
|
mbed714 |
0:d616ece2d859
|
1545
|
pppoe_destroy(&pc->netif);
|
mbed714 |
0:d616ece2d859
|
1546
|
pc->openFlag = 0;
|
mbed714 |
0:d616ece2d859
|
1547
|
|
mbed714 |
0:d616ece2d859
|
1548
|
if(pc->linkStatusCB) {
|
mbed714 |
0:d616ece2d859
|
1549
|
pc->linkStatusCB(pc->linkStatusCtx, pc->errCode ? pc->errCode : PPPERR_PROTOCOL, NULL);
|
mbed714 |
0:d616ece2d859
|
1550
|
}
|
mbed714 |
0:d616ece2d859
|
1551
|
}
|
mbed714 |
0:d616ece2d859
|
1552
|
|
mbed714 |
0:d616ece2d859
|
1553
|
static void
|
mbed714 |
0:d616ece2d859
|
1554
|
pppOverEthernetLinkStatusCB(int pd, int up)
|
mbed714 |
0:d616ece2d859
|
1555
|
{
|
mbed714 |
0:d616ece2d859
|
1556
|
if(up) {
|
mbed714 |
0:d616ece2d859
|
1557
|
PPPDEBUG(LOG_INFO, ("pppOverEthernetLinkStatusCB: unit %d: Connecting\n", pd));
|
mbed714 |
0:d616ece2d859
|
1558
|
pppStart(pd);
|
mbed714 |
0:d616ece2d859
|
1559
|
} else {
|
mbed714 |
0:d616ece2d859
|
1560
|
pppOverEthernetInitFailed(pd);
|
mbed714 |
0:d616ece2d859
|
1561
|
}
|
mbed714 |
0:d616ece2d859
|
1562
|
}
|
mbed714 |
0:d616ece2d859
|
1563
|
#endif /* PPPOE_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
1564
|
|
mbed714 |
0:d616ece2d859
|
1565
|
struct pbuf *
|
mbed714 |
0:d616ece2d859
|
1566
|
pppSingleBuf(struct pbuf *p)
|
mbed714 |
0:d616ece2d859
|
1567
|
{
|
mbed714 |
0:d616ece2d859
|
1568
|
struct pbuf *q, *b;
|
mbed714 |
0:d616ece2d859
|
1569
|
u_char *pl;
|
mbed714 |
0:d616ece2d859
|
1570
|
|
mbed714 |
0:d616ece2d859
|
1571
|
if(p->tot_len == p->len) {
|
mbed714 |
0:d616ece2d859
|
1572
|
return p;
|
mbed714 |
0:d616ece2d859
|
1573
|
}
|
mbed714 |
0:d616ece2d859
|
1574
|
|
mbed714 |
0:d616ece2d859
|
1575
|
q = pbuf_alloc(PBUF_RAW, p->tot_len, PBUF_RAM);
|
mbed714 |
0:d616ece2d859
|
1576
|
if(!q) {
|
mbed714 |
0:d616ece2d859
|
1577
|
PPPDEBUG(LOG_ERR,
|
mbed714 |
0:d616ece2d859
|
1578
|
("pppSingleBuf: unable to alloc new buf (%d)\n", p->tot_len));
|
mbed714 |
0:d616ece2d859
|
1579
|
return p; /* live dangerously */
|
mbed714 |
0:d616ece2d859
|
1580
|
}
|
mbed714 |
0:d616ece2d859
|
1581
|
|
mbed714 |
0:d616ece2d859
|
1582
|
for(b = p, pl = (u_char *) q->payload; b != NULL; b = b->next) {
|
mbed714 |
0:d616ece2d859
|
1583
|
MEMCPY(pl, b->payload, b->len);
|
mbed714 |
0:d616ece2d859
|
1584
|
pl += b->len;
|
mbed714 |
0:d616ece2d859
|
1585
|
}
|
mbed714 |
0:d616ece2d859
|
1586
|
|
mbed714 |
0:d616ece2d859
|
1587
|
pbuf_free(p);
|
mbed714 |
0:d616ece2d859
|
1588
|
|
mbed714 |
0:d616ece2d859
|
1589
|
return q;
|
mbed714 |
0:d616ece2d859
|
1590
|
}
|
mbed714 |
0:d616ece2d859
|
1591
|
|
mbed714 |
0:d616ece2d859
|
1592
|
struct pppInputHeader {
|
mbed714 |
0:d616ece2d859
|
1593
|
int unit;
|
mbed714 |
0:d616ece2d859
|
1594
|
u16_t proto;
|
mbed714 |
0:d616ece2d859
|
1595
|
};
|
mbed714 |
0:d616ece2d859
|
1596
|
|
mbed714 |
0:d616ece2d859
|
1597
|
/*
|
mbed714 |
0:d616ece2d859
|
1598
|
* Pass the processed input packet to the appropriate handler.
|
mbed714 |
0:d616ece2d859
|
1599
|
* This function and all handlers run in the context of the tcpip_thread
|
mbed714 |
0:d616ece2d859
|
1600
|
*/
|
mbed714 |
0:d616ece2d859
|
1601
|
static void
|
mbed714 |
0:d616ece2d859
|
1602
|
pppInput(void *arg)
|
mbed714 |
0:d616ece2d859
|
1603
|
{
|
mbed714 |
0:d616ece2d859
|
1604
|
struct pbuf *nb = (struct pbuf *)arg;
|
mbed714 |
0:d616ece2d859
|
1605
|
u16_t protocol;
|
mbed714 |
0:d616ece2d859
|
1606
|
int pd;
|
mbed714 |
0:d616ece2d859
|
1607
|
|
mbed714 |
0:d616ece2d859
|
1608
|
pd = ((struct pppInputHeader *)nb->payload)->unit;
|
mbed714 |
0:d616ece2d859
|
1609
|
protocol = ((struct pppInputHeader *)nb->payload)->proto;
|
mbed714 |
0:d616ece2d859
|
1610
|
|
mbed714 |
0:d616ece2d859
|
1611
|
if(pbuf_header(nb, -(int)sizeof(struct pppInputHeader))) {
|
mbed714 |
0:d616ece2d859
|
1612
|
LWIP_ASSERT("pbuf_header failed\n", 0);
|
mbed714 |
0:d616ece2d859
|
1613
|
goto drop;
|
mbed714 |
0:d616ece2d859
|
1614
|
}
|
mbed714 |
0:d616ece2d859
|
1615
|
|
mbed714 |
0:d616ece2d859
|
1616
|
LINK_STATS_INC(link.recv);
|
mbed714 |
0:d616ece2d859
|
1617
|
snmp_inc_ifinucastpkts(&pppControl[pd].netif);
|
mbed714 |
0:d616ece2d859
|
1618
|
snmp_add_ifinoctets(&pppControl[pd].netif, nb->tot_len);
|
mbed714 |
0:d616ece2d859
|
1619
|
|
mbed714 |
0:d616ece2d859
|
1620
|
/*
|
mbed714 |
0:d616ece2d859
|
1621
|
* Toss all non-LCP packets unless LCP is OPEN.
|
mbed714 |
0:d616ece2d859
|
1622
|
* Until we get past the authentication phase, toss all packets
|
mbed714 |
0:d616ece2d859
|
1623
|
* except LCP, LQR and authentication packets.
|
mbed714 |
0:d616ece2d859
|
1624
|
*/
|
mbed714 |
0:d616ece2d859
|
1625
|
if((lcp_phase[pd] <= PHASE_AUTHENTICATE) && (protocol != PPP_LCP)) {
|
mbed714 |
0:d616ece2d859
|
1626
|
if(!((protocol == PPP_LQR) || (protocol == PPP_PAP) || (protocol == PPP_CHAP)) ||
|
mbed714 |
0:d616ece2d859
|
1627
|
(lcp_phase[pd] != PHASE_AUTHENTICATE)) {
|
mbed714 |
0:d616ece2d859
|
1628
|
PPPDEBUG(LOG_INFO, ("pppInput: discarding proto 0x%"X16_F" in phase %d\n", protocol, lcp_phase[pd]));
|
mbed714 |
0:d616ece2d859
|
1629
|
goto drop;
|
mbed714 |
0:d616ece2d859
|
1630
|
}
|
mbed714 |
0:d616ece2d859
|
1631
|
}
|
mbed714 |
0:d616ece2d859
|
1632
|
|
mbed714 |
0:d616ece2d859
|
1633
|
switch(protocol) {
|
mbed714 |
0:d616ece2d859
|
1634
|
case PPP_VJC_COMP: /* VJ compressed TCP */
|
mbed714 |
0:d616ece2d859
|
1635
|
#if PPPOS_SUPPORT && VJ_SUPPORT
|
mbed714 |
0:d616ece2d859
|
1636
|
PPPDEBUG(LOG_INFO, ("pppInput[%d]: vj_comp in pbuf len=%d\n", pd, nb->len));
|
mbed714 |
0:d616ece2d859
|
1637
|
/*
|
mbed714 |
0:d616ece2d859
|
1638
|
* Clip off the VJ header and prepend the rebuilt TCP/IP header and
|
mbed714 |
0:d616ece2d859
|
1639
|
* pass the result to IP.
|
mbed714 |
0:d616ece2d859
|
1640
|
*/
|
mbed714 |
0:d616ece2d859
|
1641
|
if ((vj_uncompress_tcp(&nb, &pppControl[pd].vjComp) >= 0) && (pppControl[pd].netif.input)) {
|
mbed714 |
0:d616ece2d859
|
1642
|
pppControl[pd].netif.input(nb, &pppControl[pd].netif);
|
mbed714 |
0:d616ece2d859
|
1643
|
return;
|
mbed714 |
0:d616ece2d859
|
1644
|
}
|
mbed714 |
0:d616ece2d859
|
1645
|
/* Something's wrong so drop it. */
|
mbed714 |
0:d616ece2d859
|
1646
|
PPPDEBUG(LOG_WARNING, ("pppInput[%d]: Dropping VJ compressed\n", pd));
|
mbed714 |
0:d616ece2d859
|
1647
|
#else /* PPPOS_SUPPORT && VJ_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
1648
|
/* No handler for this protocol so drop the packet. */
|
mbed714 |
0:d616ece2d859
|
1649
|
PPPDEBUG(LOG_INFO, ("pppInput[%d]: drop VJ Comp in %d:%s\n", pd, nb->len, nb->payload));
|
mbed714 |
0:d616ece2d859
|
1650
|
#endif /* PPPOS_SUPPORT && VJ_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
1651
|
break;
|
mbed714 |
0:d616ece2d859
|
1652
|
|
mbed714 |
0:d616ece2d859
|
1653
|
case PPP_VJC_UNCOMP: /* VJ uncompressed TCP */
|
mbed714 |
0:d616ece2d859
|
1654
|
#if PPPOS_SUPPORT && VJ_SUPPORT
|
mbed714 |
0:d616ece2d859
|
1655
|
PPPDEBUG(LOG_INFO, ("pppInput[%d]: vj_un in pbuf len=%d\n", pd, nb->len));
|
mbed714 |
0:d616ece2d859
|
1656
|
/*
|
mbed714 |
0:d616ece2d859
|
1657
|
* Process the TCP/IP header for VJ header compression and then pass
|
mbed714 |
0:d616ece2d859
|
1658
|
* the packet to IP.
|
mbed714 |
0:d616ece2d859
|
1659
|
*/
|
mbed714 |
0:d616ece2d859
|
1660
|
if ((vj_uncompress_uncomp(nb, &pppControl[pd].vjComp) >= 0) && pppControl[pd].netif.input) {
|
mbed714 |
0:d616ece2d859
|
1661
|
pppControl[pd].netif.input(nb, &pppControl[pd].netif);
|
mbed714 |
0:d616ece2d859
|
1662
|
return;
|
mbed714 |
0:d616ece2d859
|
1663
|
}
|
mbed714 |
0:d616ece2d859
|
1664
|
/* Something's wrong so drop it. */
|
mbed714 |
0:d616ece2d859
|
1665
|
PPPDEBUG(LOG_WARNING, ("pppInput[%d]: Dropping VJ uncompressed\n", pd));
|
mbed714 |
0:d616ece2d859
|
1666
|
#else /* PPPOS_SUPPORT && VJ_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
1667
|
/* No handler for this protocol so drop the packet. */
|
mbed714 |
0:d616ece2d859
|
1668
|
PPPDEBUG(LOG_INFO,
|
mbed714 |
0:d616ece2d859
|
1669
|
("pppInput[%d]: drop VJ UnComp in %d:.*H\n",
|
mbed714 |
0:d616ece2d859
|
1670
|
pd, nb->len, LWIP_MIN(nb->len * 2, 40), nb->payload));
|
mbed714 |
0:d616ece2d859
|
1671
|
#endif /* PPPOS_SUPPORT && VJ_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
1672
|
break;
|
mbed714 |
0:d616ece2d859
|
1673
|
|
mbed714 |
0:d616ece2d859
|
1674
|
case PPP_IP: /* Internet Protocol */
|
mbed714 |
0:d616ece2d859
|
1675
|
PPPDEBUG(LOG_INFO, ("pppInput[%d]: ip in pbuf len=%d\n", pd, nb->len));
|
mbed714 |
0:d616ece2d859
|
1676
|
if (pppControl[pd].netif.input) {
|
mbed714 |
0:d616ece2d859
|
1677
|
pppControl[pd].netif.input(nb, &pppControl[pd].netif);
|
mbed714 |
0:d616ece2d859
|
1678
|
return;
|
mbed714 |
0:d616ece2d859
|
1679
|
}
|
mbed714 |
0:d616ece2d859
|
1680
|
break;
|
mbed714 |
0:d616ece2d859
|
1681
|
|
mbed714 |
0:d616ece2d859
|
1682
|
default: {
|
mbed714 |
0:d616ece2d859
|
1683
|
struct protent *protp;
|
mbed714 |
0:d616ece2d859
|
1684
|
int i;
|
mbed714 |
0:d616ece2d859
|
1685
|
|
mbed714 |
0:d616ece2d859
|
1686
|
/*
|
mbed714 |
0:d616ece2d859
|
1687
|
* Upcall the proper protocol input routine.
|
mbed714 |
0:d616ece2d859
|
1688
|
*/
|
mbed714 |
0:d616ece2d859
|
1689
|
for (i = 0; (protp = ppp_protocols[i]) != NULL; ++i) {
|
mbed714 |
0:d616ece2d859
|
1690
|
if (protp->protocol == protocol && protp->enabled_flag) {
|
mbed714 |
0:d616ece2d859
|
1691
|
PPPDEBUG(LOG_INFO, ("pppInput[%d]: %s len=%d\n", pd, protp->name, nb->len));
|
mbed714 |
0:d616ece2d859
|
1692
|
nb = pppSingleBuf(nb);
|
mbed714 |
0:d616ece2d859
|
1693
|
(*protp->input)(pd, (u_char *)nb->payload, nb->len);
|
mbed714 |
0:d616ece2d859
|
1694
|
PPPDEBUG(LOG_DETAIL, ("pppInput[%d]: packet processed\n", pd));
|
mbed714 |
0:d616ece2d859
|
1695
|
goto out;
|
mbed714 |
0:d616ece2d859
|
1696
|
}
|
mbed714 |
0:d616ece2d859
|
1697
|
}
|
mbed714 |
0:d616ece2d859
|
1698
|
|
mbed714 |
0:d616ece2d859
|
1699
|
/* No handler for this protocol so reject the packet. */
|
mbed714 |
0:d616ece2d859
|
1700
|
PPPDEBUG(LOG_INFO, ("pppInput[%d]: rejecting unsupported proto 0x%"X16_F" len=%d\n", pd, protocol, nb->len));
|
mbed714 |
0:d616ece2d859
|
1701
|
if (pbuf_header(nb, sizeof(protocol))) {
|
mbed714 |
0:d616ece2d859
|
1702
|
LWIP_ASSERT("pbuf_header failed\n", 0);
|
mbed714 |
0:d616ece2d859
|
1703
|
goto drop;
|
mbed714 |
0:d616ece2d859
|
1704
|
}
|
mbed714 |
0:d616ece2d859
|
1705
|
#if BYTE_ORDER == LITTLE_ENDIAN
|
mbed714 |
0:d616ece2d859
|
1706
|
protocol = htons(protocol);
|
mbed714 |
0:d616ece2d859
|
1707
|
SMEMCPY(nb->payload, &protocol, sizeof(protocol));
|
mbed714 |
0:d616ece2d859
|
1708
|
#endif /* BYTE_ORDER == LITTLE_ENDIAN */
|
mbed714 |
0:d616ece2d859
|
1709
|
lcp_sprotrej(pd, (u_char *)nb->payload, nb->len);
|
mbed714 |
0:d616ece2d859
|
1710
|
}
|
mbed714 |
0:d616ece2d859
|
1711
|
break;
|
mbed714 |
0:d616ece2d859
|
1712
|
}
|
mbed714 |
0:d616ece2d859
|
1713
|
|
mbed714 |
0:d616ece2d859
|
1714
|
drop:
|
mbed714 |
0:d616ece2d859
|
1715
|
LINK_STATS_INC(link.drop);
|
mbed714 |
0:d616ece2d859
|
1716
|
snmp_inc_ifindiscards(&pppControl[pd].netif);
|
mbed714 |
0:d616ece2d859
|
1717
|
|
mbed714 |
0:d616ece2d859
|
1718
|
out:
|
mbed714 |
0:d616ece2d859
|
1719
|
pbuf_free(nb);
|
mbed714 |
0:d616ece2d859
|
1720
|
return;
|
mbed714 |
0:d616ece2d859
|
1721
|
}
|
mbed714 |
0:d616ece2d859
|
1722
|
|
mbed714 |
0:d616ece2d859
|
1723
|
#if PPPOS_SUPPORT
|
mbed714 |
0:d616ece2d859
|
1724
|
/*
|
mbed714 |
0:d616ece2d859
|
1725
|
* Drop the input packet.
|
mbed714 |
0:d616ece2d859
|
1726
|
*/
|
mbed714 |
0:d616ece2d859
|
1727
|
static void
|
mbed714 |
0:d616ece2d859
|
1728
|
pppDrop(PPPControlRx *pcrx)
|
mbed714 |
0:d616ece2d859
|
1729
|
{
|
mbed714 |
0:d616ece2d859
|
1730
|
if (pcrx->inHead != NULL) {
|
mbed714 |
0:d616ece2d859
|
1731
|
#if 0
|
mbed714 |
0:d616ece2d859
|
1732
|
PPPDEBUG(LOG_INFO, ("pppDrop: %d:%.*H\n", pcrx->inHead->len, min(60, pcrx->inHead->len * 2), pcrx->inHead->payload));
|
mbed714 |
0:d616ece2d859
|
1733
|
#endif
|
mbed714 |
0:d616ece2d859
|
1734
|
PPPDEBUG(LOG_INFO, ("pppDrop: pbuf len=%d, addr %p\n", pcrx->inHead->len, (void*)pcrx->inHead));
|
mbed714 |
0:d616ece2d859
|
1735
|
if (pcrx->inTail && (pcrx->inTail != pcrx->inHead)) {
|
mbed714 |
0:d616ece2d859
|
1736
|
pbuf_free(pcrx->inTail);
|
mbed714 |
0:d616ece2d859
|
1737
|
}
|
mbed714 |
0:d616ece2d859
|
1738
|
pbuf_free(pcrx->inHead);
|
mbed714 |
0:d616ece2d859
|
1739
|
pcrx->inHead = NULL;
|
mbed714 |
0:d616ece2d859
|
1740
|
pcrx->inTail = NULL;
|
mbed714 |
0:d616ece2d859
|
1741
|
}
|
mbed714 |
0:d616ece2d859
|
1742
|
#if VJ_SUPPORT
|
mbed714 |
0:d616ece2d859
|
1743
|
vj_uncompress_err(&pppControl[pcrx->pd].vjComp);
|
mbed714 |
0:d616ece2d859
|
1744
|
#endif /* VJ_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
1745
|
|
mbed714 |
0:d616ece2d859
|
1746
|
LINK_STATS_INC(link.drop);
|
mbed714 |
0:d616ece2d859
|
1747
|
snmp_inc_ifindiscards(&pppControl[pcrx->pd].netif);
|
mbed714 |
0:d616ece2d859
|
1748
|
}
|
mbed714 |
0:d616ece2d859
|
1749
|
|
mbed714 |
0:d616ece2d859
|
1750
|
/** Pass received raw characters to PPPoS to be decoded. This function is
|
mbed714 |
0:d616ece2d859
|
1751
|
* thread-safe and can be called from a dedicated RX-thread or from a main-loop.
|
mbed714 |
0:d616ece2d859
|
1752
|
*
|
mbed714 |
0:d616ece2d859
|
1753
|
* @param pd PPP descriptor index, returned by pppOpen()
|
mbed714 |
0:d616ece2d859
|
1754
|
* @param data received data
|
mbed714 |
0:d616ece2d859
|
1755
|
* @param len length of received data
|
mbed714 |
0:d616ece2d859
|
1756
|
*/
|
mbed714 |
0:d616ece2d859
|
1757
|
void
|
mbed714 |
0:d616ece2d859
|
1758
|
pppos_input(int pd, u_char* data, int len)
|
mbed714 |
0:d616ece2d859
|
1759
|
{
|
mbed714 |
0:d616ece2d859
|
1760
|
pppInProc(&pppControl[pd].rx, data, len);
|
mbed714 |
0:d616ece2d859
|
1761
|
}
|
mbed714 |
0:d616ece2d859
|
1762
|
|
mbed714 |
0:d616ece2d859
|
1763
|
/**
|
mbed714 |
0:d616ece2d859
|
1764
|
* Process a received octet string.
|
mbed714 |
0:d616ece2d859
|
1765
|
*/
|
mbed714 |
0:d616ece2d859
|
1766
|
static void
|
mbed714 |
0:d616ece2d859
|
1767
|
pppInProc(PPPControlRx *pcrx, u_char *s, int l)
|
mbed714 |
0:d616ece2d859
|
1768
|
{
|
mbed714 |
0:d616ece2d859
|
1769
|
struct pbuf *nextNBuf;
|
mbed714 |
0:d616ece2d859
|
1770
|
u_char curChar;
|
mbed714 |
0:d616ece2d859
|
1771
|
u_char escaped;
|
mbed714 |
0:d616ece2d859
|
1772
|
SYS_ARCH_DECL_PROTECT(lev);
|
mbed714 |
0:d616ece2d859
|
1773
|
|
mbed714 |
0:d616ece2d859
|
1774
|
PPPDEBUG(LOG_DEBUG, ("pppInProc[%d]: got %d bytes\n", pcrx->pd, l));
|
mbed714 |
0:d616ece2d859
|
1775
|
while (l-- > 0) {
|
mbed714 |
0:d616ece2d859
|
1776
|
curChar = *s++;
|
mbed714 |
0:d616ece2d859
|
1777
|
|
mbed714 |
0:d616ece2d859
|
1778
|
SYS_ARCH_PROTECT(lev);
|
mbed714 |
0:d616ece2d859
|
1779
|
escaped = ESCAPE_P(pcrx->inACCM, curChar);
|
mbed714 |
0:d616ece2d859
|
1780
|
SYS_ARCH_UNPROTECT(lev);
|
mbed714 |
0:d616ece2d859
|
1781
|
/* Handle special characters. */
|
mbed714 |
0:d616ece2d859
|
1782
|
if (escaped) {
|
mbed714 |
0:d616ece2d859
|
1783
|
/* Check for escape sequences. */
|
mbed714 |
0:d616ece2d859
|
1784
|
/* XXX Note that this does not handle an escaped 0x5d character which
|
mbed714 |
0:d616ece2d859
|
1785
|
* would appear as an escape character. Since this is an ASCII ']'
|
mbed714 |
0:d616ece2d859
|
1786
|
* and there is no reason that I know of to escape it, I won't complicate
|
mbed714 |
0:d616ece2d859
|
1787
|
* the code to handle this case. GLL */
|
mbed714 |
0:d616ece2d859
|
1788
|
if (curChar == PPP_ESCAPE) {
|
mbed714 |
0:d616ece2d859
|
1789
|
pcrx->inEscaped = 1;
|
mbed714 |
0:d616ece2d859
|
1790
|
/* Check for the flag character. */
|
mbed714 |
0:d616ece2d859
|
1791
|
} else if (curChar == PPP_FLAG) {
|
mbed714 |
0:d616ece2d859
|
1792
|
/* If this is just an extra flag character, ignore it. */
|
mbed714 |
0:d616ece2d859
|
1793
|
if (pcrx->inState <= PDADDRESS) {
|
mbed714 |
0:d616ece2d859
|
1794
|
/* ignore it */;
|
mbed714 |
0:d616ece2d859
|
1795
|
/* If we haven't received the packet header, drop what has come in. */
|
mbed714 |
0:d616ece2d859
|
1796
|
} else if (pcrx->inState < PDDATA) {
|
mbed714 |
0:d616ece2d859
|
1797
|
PPPDEBUG(LOG_WARNING,
|
mbed714 |
0:d616ece2d859
|
1798
|
("pppInProc[%d]: Dropping incomplete packet %d\n",
|
mbed714 |
0:d616ece2d859
|
1799
|
pcrx->pd, pcrx->inState));
|
mbed714 |
0:d616ece2d859
|
1800
|
LINK_STATS_INC(link.lenerr);
|
mbed714 |
0:d616ece2d859
|
1801
|
pppDrop(pcrx);
|
mbed714 |
0:d616ece2d859
|
1802
|
/* If the fcs is invalid, drop the packet. */
|
mbed714 |
0:d616ece2d859
|
1803
|
} else if (pcrx->inFCS != PPP_GOODFCS) {
|
mbed714 |
0:d616ece2d859
|
1804
|
PPPDEBUG(LOG_INFO,
|
mbed714 |
0:d616ece2d859
|
1805
|
("pppInProc[%d]: Dropping bad fcs 0x%"X16_F" proto=0x%"X16_F"\n",
|
mbed714 |
0:d616ece2d859
|
1806
|
pcrx->pd, pcrx->inFCS, pcrx->inProtocol));
|
mbed714 |
0:d616ece2d859
|
1807
|
/* Note: If you get lots of these, check for UART frame errors or try different baud rate */
|
mbed714 |
0:d616ece2d859
|
1808
|
LINK_STATS_INC(link.chkerr);
|
mbed714 |
0:d616ece2d859
|
1809
|
pppDrop(pcrx);
|
mbed714 |
0:d616ece2d859
|
1810
|
/* Otherwise it's a good packet so pass it on. */
|
mbed714 |
0:d616ece2d859
|
1811
|
} else {
|
mbed714 |
0:d616ece2d859
|
1812
|
/* Trim off the checksum. */
|
mbed714 |
0:d616ece2d859
|
1813
|
if(pcrx->inTail->len >= 2) {
|
mbed714 |
0:d616ece2d859
|
1814
|
pcrx->inTail->len -= 2;
|
mbed714 |
0:d616ece2d859
|
1815
|
|
mbed714 |
0:d616ece2d859
|
1816
|
pcrx->inTail->tot_len = pcrx->inTail->len;
|
mbed714 |
0:d616ece2d859
|
1817
|
if (pcrx->inTail != pcrx->inHead) {
|
mbed714 |
0:d616ece2d859
|
1818
|
pbuf_cat(pcrx->inHead, pcrx->inTail);
|
mbed714 |
0:d616ece2d859
|
1819
|
}
|
mbed714 |
0:d616ece2d859
|
1820
|
} else {
|
mbed714 |
0:d616ece2d859
|
1821
|
pcrx->inTail->tot_len = pcrx->inTail->len;
|
mbed714 |
0:d616ece2d859
|
1822
|
if (pcrx->inTail != pcrx->inHead) {
|
mbed714 |
0:d616ece2d859
|
1823
|
pbuf_cat(pcrx->inHead, pcrx->inTail);
|
mbed714 |
0:d616ece2d859
|
1824
|
}
|
mbed714 |
0:d616ece2d859
|
1825
|
|
mbed714 |
0:d616ece2d859
|
1826
|
pbuf_realloc(pcrx->inHead, pcrx->inHead->tot_len - 2);
|
mbed714 |
0:d616ece2d859
|
1827
|
}
|
mbed714 |
0:d616ece2d859
|
1828
|
|
mbed714 |
0:d616ece2d859
|
1829
|
/* Dispatch the packet thereby consuming it. */
|
mbed714 |
0:d616ece2d859
|
1830
|
#if PPP_INPROC_MULTITHREADED
|
mbed714 |
0:d616ece2d859
|
1831
|
if(tcpip_callback_with_block(pppInput, pcrx->inHead, 0) != ERR_OK) {
|
mbed714 |
0:d616ece2d859
|
1832
|
PPPDEBUG(LOG_ERR, ("pppInProc[%d]: tcpip_callback() failed, dropping packet\n", pcrx->pd));
|
mbed714 |
0:d616ece2d859
|
1833
|
pbuf_free(pcrx->inHead);
|
mbed714 |
0:d616ece2d859
|
1834
|
LINK_STATS_INC(link.drop);
|
mbed714 |
0:d616ece2d859
|
1835
|
snmp_inc_ifindiscards(&pppControl[pcrx->pd].netif);
|
mbed714 |
0:d616ece2d859
|
1836
|
}
|
mbed714 |
0:d616ece2d859
|
1837
|
#else /* PPP_INPROC_MULTITHREADED */
|
mbed714 |
0:d616ece2d859
|
1838
|
pppInput(pcrx->inHead);
|
mbed714 |
0:d616ece2d859
|
1839
|
#endif /* PPP_INPROC_MULTITHREADED */
|
mbed714 |
0:d616ece2d859
|
1840
|
pcrx->inHead = NULL;
|
mbed714 |
0:d616ece2d859
|
1841
|
pcrx->inTail = NULL;
|
mbed714 |
0:d616ece2d859
|
1842
|
}
|
mbed714 |
0:d616ece2d859
|
1843
|
|
mbed714 |
0:d616ece2d859
|
1844
|
/* Prepare for a new packet. */
|
mbed714 |
0:d616ece2d859
|
1845
|
pcrx->inFCS = PPP_INITFCS;
|
mbed714 |
0:d616ece2d859
|
1846
|
pcrx->inState = PDADDRESS;
|
mbed714 |
0:d616ece2d859
|
1847
|
pcrx->inEscaped = 0;
|
mbed714 |
0:d616ece2d859
|
1848
|
/* Other characters are usually control characters that may have
|
mbed714 |
0:d616ece2d859
|
1849
|
* been inserted by the physical layer so here we just drop them. */
|
mbed714 |
0:d616ece2d859
|
1850
|
} else {
|
mbed714 |
0:d616ece2d859
|
1851
|
PPPDEBUG(LOG_WARNING,
|
mbed714 |
0:d616ece2d859
|
1852
|
("pppInProc[%d]: Dropping ACCM char <%d>\n", pcrx->pd, curChar));
|
mbed714 |
0:d616ece2d859
|
1853
|
}
|
mbed714 |
0:d616ece2d859
|
1854
|
/* Process other characters. */
|
mbed714 |
0:d616ece2d859
|
1855
|
} else {
|
mbed714 |
0:d616ece2d859
|
1856
|
/* Unencode escaped characters. */
|
mbed714 |
0:d616ece2d859
|
1857
|
if (pcrx->inEscaped) {
|
mbed714 |
0:d616ece2d859
|
1858
|
pcrx->inEscaped = 0;
|
mbed714 |
0:d616ece2d859
|
1859
|
curChar ^= PPP_TRANS;
|
mbed714 |
0:d616ece2d859
|
1860
|
}
|
mbed714 |
0:d616ece2d859
|
1861
|
|
mbed714 |
0:d616ece2d859
|
1862
|
/* Process character relative to current state. */
|
mbed714 |
0:d616ece2d859
|
1863
|
switch(pcrx->inState) {
|
mbed714 |
0:d616ece2d859
|
1864
|
case PDIDLE: /* Idle state - waiting. */
|
mbed714 |
0:d616ece2d859
|
1865
|
/* Drop the character if it's not 0xff
|
mbed714 |
0:d616ece2d859
|
1866
|
* we would have processed a flag character above. */
|
mbed714 |
0:d616ece2d859
|
1867
|
if (curChar != PPP_ALLSTATIONS) {
|
mbed714 |
0:d616ece2d859
|
1868
|
break;
|
mbed714 |
0:d616ece2d859
|
1869
|
}
|
mbed714 |
0:d616ece2d859
|
1870
|
|
mbed714 |
0:d616ece2d859
|
1871
|
/* Fall through */
|
mbed714 |
0:d616ece2d859
|
1872
|
case PDSTART: /* Process start flag. */
|
mbed714 |
0:d616ece2d859
|
1873
|
/* Prepare for a new packet. */
|
mbed714 |
0:d616ece2d859
|
1874
|
pcrx->inFCS = PPP_INITFCS;
|
mbed714 |
0:d616ece2d859
|
1875
|
|
mbed714 |
0:d616ece2d859
|
1876
|
/* Fall through */
|
mbed714 |
0:d616ece2d859
|
1877
|
case PDADDRESS: /* Process address field. */
|
mbed714 |
0:d616ece2d859
|
1878
|
if (curChar == PPP_ALLSTATIONS) {
|
mbed714 |
0:d616ece2d859
|
1879
|
pcrx->inState = PDCONTROL;
|
mbed714 |
0:d616ece2d859
|
1880
|
break;
|
mbed714 |
0:d616ece2d859
|
1881
|
}
|
mbed714 |
0:d616ece2d859
|
1882
|
/* Else assume compressed address and control fields so
|
mbed714 |
0:d616ece2d859
|
1883
|
* fall through to get the protocol... */
|
mbed714 |
0:d616ece2d859
|
1884
|
case PDCONTROL: /* Process control field. */
|
mbed714 |
0:d616ece2d859
|
1885
|
/* If we don't get a valid control code, restart. */
|
mbed714 |
0:d616ece2d859
|
1886
|
if (curChar == PPP_UI) {
|
mbed714 |
0:d616ece2d859
|
1887
|
pcrx->inState = PDPROTOCOL1;
|
mbed714 |
0:d616ece2d859
|
1888
|
break;
|
mbed714 |
0:d616ece2d859
|
1889
|
}
|
mbed714 |
0:d616ece2d859
|
1890
|
#if 0
|
mbed714 |
0:d616ece2d859
|
1891
|
else {
|
mbed714 |
0:d616ece2d859
|
1892
|
PPPDEBUG(LOG_WARNING,
|
mbed714 |
0:d616ece2d859
|
1893
|
("pppInProc[%d]: Invalid control <%d>\n", pcrx->pd, curChar));
|
mbed714 |
0:d616ece2d859
|
1894
|
pcrx->inState = PDSTART;
|
mbed714 |
0:d616ece2d859
|
1895
|
}
|
mbed714 |
0:d616ece2d859
|
1896
|
#endif
|
mbed714 |
0:d616ece2d859
|
1897
|
case PDPROTOCOL1: /* Process protocol field 1. */
|
mbed714 |
0:d616ece2d859
|
1898
|
/* If the lower bit is set, this is the end of the protocol
|
mbed714 |
0:d616ece2d859
|
1899
|
* field. */
|
mbed714 |
0:d616ece2d859
|
1900
|
if (curChar & 1) {
|
mbed714 |
0:d616ece2d859
|
1901
|
pcrx->inProtocol = curChar;
|
mbed714 |
0:d616ece2d859
|
1902
|
pcrx->inState = PDDATA;
|
mbed714 |
0:d616ece2d859
|
1903
|
} else {
|
mbed714 |
0:d616ece2d859
|
1904
|
pcrx->inProtocol = (u_int)curChar << 8;
|
mbed714 |
0:d616ece2d859
|
1905
|
pcrx->inState = PDPROTOCOL2;
|
mbed714 |
0:d616ece2d859
|
1906
|
}
|
mbed714 |
0:d616ece2d859
|
1907
|
break;
|
mbed714 |
0:d616ece2d859
|
1908
|
case PDPROTOCOL2: /* Process protocol field 2. */
|
mbed714 |
0:d616ece2d859
|
1909
|
pcrx->inProtocol |= curChar;
|
mbed714 |
0:d616ece2d859
|
1910
|
pcrx->inState = PDDATA;
|
mbed714 |
0:d616ece2d859
|
1911
|
break;
|
mbed714 |
0:d616ece2d859
|
1912
|
case PDDATA: /* Process data byte. */
|
mbed714 |
0:d616ece2d859
|
1913
|
/* Make space to receive processed data. */
|
mbed714 |
0:d616ece2d859
|
1914
|
if (pcrx->inTail == NULL || pcrx->inTail->len == PBUF_POOL_BUFSIZE) {
|
mbed714 |
0:d616ece2d859
|
1915
|
if(pcrx->inTail) {
|
mbed714 |
0:d616ece2d859
|
1916
|
pcrx->inTail->tot_len = pcrx->inTail->len;
|
mbed714 |
0:d616ece2d859
|
1917
|
if (pcrx->inTail != pcrx->inHead) {
|
mbed714 |
0:d616ece2d859
|
1918
|
pbuf_cat(pcrx->inHead, pcrx->inTail);
|
mbed714 |
0:d616ece2d859
|
1919
|
}
|
mbed714 |
0:d616ece2d859
|
1920
|
}
|
mbed714 |
0:d616ece2d859
|
1921
|
/* If we haven't started a packet, we need a packet header. */
|
mbed714 |
0:d616ece2d859
|
1922
|
nextNBuf = pbuf_alloc(PBUF_RAW, 0, PBUF_POOL);
|
mbed714 |
0:d616ece2d859
|
1923
|
if (nextNBuf == NULL) {
|
mbed714 |
0:d616ece2d859
|
1924
|
/* No free buffers. Drop the input packet and let the
|
mbed714 |
0:d616ece2d859
|
1925
|
* higher layers deal with it. Continue processing
|
mbed714 |
0:d616ece2d859
|
1926
|
* the received pbuf chain in case a new packet starts. */
|
mbed714 |
0:d616ece2d859
|
1927
|
PPPDEBUG(LOG_ERR, ("pppInProc[%d]: NO FREE MBUFS!\n", pcrx->pd));
|
mbed714 |
0:d616ece2d859
|
1928
|
LINK_STATS_INC(link.memerr);
|
mbed714 |
0:d616ece2d859
|
1929
|
pppDrop(pcrx);
|
mbed714 |
0:d616ece2d859
|
1930
|
pcrx->inState = PDSTART; /* Wait for flag sequence. */
|
mbed714 |
0:d616ece2d859
|
1931
|
break;
|
mbed714 |
0:d616ece2d859
|
1932
|
}
|
mbed714 |
0:d616ece2d859
|
1933
|
if (pcrx->inHead == NULL) {
|
mbed714 |
0:d616ece2d859
|
1934
|
struct pppInputHeader *pih = (struct pppInputHeader *)nextNBuf->payload;
|
mbed714 |
0:d616ece2d859
|
1935
|
|
mbed714 |
0:d616ece2d859
|
1936
|
pih->unit = pcrx->pd;
|
mbed714 |
0:d616ece2d859
|
1937
|
pih->proto = pcrx->inProtocol;
|
mbed714 |
0:d616ece2d859
|
1938
|
|
mbed714 |
0:d616ece2d859
|
1939
|
nextNBuf->len += sizeof(*pih);
|
mbed714 |
0:d616ece2d859
|
1940
|
|
mbed714 |
0:d616ece2d859
|
1941
|
pcrx->inHead = nextNBuf;
|
mbed714 |
0:d616ece2d859
|
1942
|
}
|
mbed714 |
0:d616ece2d859
|
1943
|
pcrx->inTail = nextNBuf;
|
mbed714 |
0:d616ece2d859
|
1944
|
}
|
mbed714 |
0:d616ece2d859
|
1945
|
/* Load character into buffer. */
|
mbed714 |
0:d616ece2d859
|
1946
|
((u_char*)pcrx->inTail->payload)[pcrx->inTail->len++] = curChar;
|
mbed714 |
0:d616ece2d859
|
1947
|
break;
|
mbed714 |
0:d616ece2d859
|
1948
|
}
|
mbed714 |
0:d616ece2d859
|
1949
|
|
mbed714 |
0:d616ece2d859
|
1950
|
/* update the frame check sequence number. */
|
mbed714 |
0:d616ece2d859
|
1951
|
pcrx->inFCS = PPP_FCS(pcrx->inFCS, curChar);
|
mbed714 |
0:d616ece2d859
|
1952
|
}
|
mbed714 |
0:d616ece2d859
|
1953
|
} /* while (l-- > 0), all bytes processed */
|
mbed714 |
0:d616ece2d859
|
1954
|
|
mbed714 |
0:d616ece2d859
|
1955
|
avRandomize();
|
mbed714 |
0:d616ece2d859
|
1956
|
}
|
mbed714 |
0:d616ece2d859
|
1957
|
#endif /* PPPOS_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
1958
|
|
mbed714 |
0:d616ece2d859
|
1959
|
#if PPPOE_SUPPORT
|
mbed714 |
0:d616ece2d859
|
1960
|
void
|
mbed714 |
0:d616ece2d859
|
1961
|
pppInProcOverEthernet(int pd, struct pbuf *pb)
|
mbed714 |
0:d616ece2d859
|
1962
|
{
|
mbed714 |
0:d616ece2d859
|
1963
|
struct pppInputHeader *pih;
|
mbed714 |
0:d616ece2d859
|
1964
|
u16_t inProtocol;
|
mbed714 |
0:d616ece2d859
|
1965
|
|
mbed714 |
0:d616ece2d859
|
1966
|
if(pb->len < sizeof(inProtocol)) {
|
mbed714 |
0:d616ece2d859
|
1967
|
PPPDEBUG(LOG_ERR, ("pppInProcOverEthernet: too small for protocol field\n"));
|
mbed714 |
0:d616ece2d859
|
1968
|
goto drop;
|
mbed714 |
0:d616ece2d859
|
1969
|
}
|
mbed714 |
0:d616ece2d859
|
1970
|
|
mbed714 |
0:d616ece2d859
|
1971
|
inProtocol = (((u8_t *)pb->payload)[0] << 8) | ((u8_t*)pb->payload)[1];
|
mbed714 |
0:d616ece2d859
|
1972
|
|
mbed714 |
0:d616ece2d859
|
1973
|
/* make room for pppInputHeader - should not fail */
|
mbed714 |
0:d616ece2d859
|
1974
|
if (pbuf_header(pb, sizeof(*pih) - sizeof(inProtocol)) != 0) {
|
mbed714 |
0:d616ece2d859
|
1975
|
PPPDEBUG(LOG_ERR, ("pppInProcOverEthernet: could not allocate room for header\n"));
|
mbed714 |
0:d616ece2d859
|
1976
|
goto drop;
|
mbed714 |
0:d616ece2d859
|
1977
|
}
|
mbed714 |
0:d616ece2d859
|
1978
|
|
mbed714 |
0:d616ece2d859
|
1979
|
pih = pb->payload;
|
mbed714 |
0:d616ece2d859
|
1980
|
|
mbed714 |
0:d616ece2d859
|
1981
|
pih->unit = pd;
|
mbed714 |
0:d616ece2d859
|
1982
|
pih->proto = inProtocol;
|
mbed714 |
0:d616ece2d859
|
1983
|
|
mbed714 |
0:d616ece2d859
|
1984
|
/* Dispatch the packet thereby consuming it. */
|
mbed714 |
0:d616ece2d859
|
1985
|
pppInput(pb);
|
mbed714 |
0:d616ece2d859
|
1986
|
return;
|
mbed714 |
0:d616ece2d859
|
1987
|
|
mbed714 |
0:d616ece2d859
|
1988
|
drop:
|
mbed714 |
0:d616ece2d859
|
1989
|
LINK_STATS_INC(link.drop);
|
mbed714 |
0:d616ece2d859
|
1990
|
snmp_inc_ifindiscards(&pppControl[pd].netif);
|
mbed714 |
0:d616ece2d859
|
1991
|
pbuf_free(pb);
|
mbed714 |
0:d616ece2d859
|
1992
|
return;
|
mbed714 |
0:d616ece2d859
|
1993
|
}
|
mbed714 |
0:d616ece2d859
|
1994
|
#endif /* PPPOE_SUPPORT */
|
mbed714 |
0:d616ece2d859
|
1995
|
|
mbed714 |
0:d616ece2d859
|
1996
|
#if LWIP_NETIF_STATUS_CALLBACK
|
mbed714 |
0:d616ece2d859
|
1997
|
/** Set the status callback of a PPP's netif
|
mbed714 |
0:d616ece2d859
|
1998
|
*
|
mbed714 |
0:d616ece2d859
|
1999
|
* @param pd The PPP descriptor returned by pppOpen()
|
mbed714 |
0:d616ece2d859
|
2000
|
* @param status_callback pointer to the status callback function
|
mbed714 |
0:d616ece2d859
|
2001
|
*
|
mbed714 |
0:d616ece2d859
|
2002
|
* @see netif_set_status_callback
|
mbed714 |
0:d616ece2d859
|
2003
|
*/
|
mbed714 |
0:d616ece2d859
|
2004
|
void
|
mbed714 |
0:d616ece2d859
|
2005
|
ppp_set_netif_statuscallback(int pd, netif_status_callback_fn status_callback)
|
mbed714 |
0:d616ece2d859
|
2006
|
{
|
mbed714 |
0:d616ece2d859
|
2007
|
netif_set_status_callback(&pppControl[pd].netif, status_callback);
|
mbed714 |
0:d616ece2d859
|
2008
|
}
|
mbed714 |
0:d616ece2d859
|
2009
|
#endif /* LWIP_NETIF_STATUS_CALLBACK */
|
mbed714 |
0:d616ece2d859
|
2010
|
|
mbed714 |
0:d616ece2d859
|
2011
|
#if LWIP_NETIF_LINK_CALLBACK
|
mbed714 |
0:d616ece2d859
|
2012
|
/** Set the link callback of a PPP's netif
|
mbed714 |
0:d616ece2d859
|
2013
|
*
|
mbed714 |
0:d616ece2d859
|
2014
|
* @param pd The PPP descriptor returned by pppOpen()
|
mbed714 |
0:d616ece2d859
|
2015
|
* @param link_callback pointer to the link callback function
|
mbed714 |
0:d616ece2d859
|
2016
|
*
|
mbed714 |
0:d616ece2d859
|
2017
|
* @see netif_set_link_callback
|
mbed714 |
0:d616ece2d859
|
2018
|
*/
|
mbed714 |
0:d616ece2d859
|
2019
|
void
|
mbed714 |
0:d616ece2d859
|
2020
|
ppp_set_netif_linkcallback(int pd, netif_status_callback_fn link_callback)
|
mbed714 |
0:d616ece2d859
|
2021
|
{
|
mbed714 |
0:d616ece2d859
|
2022
|
netif_set_link_callback(&pppControl[pd].netif, link_callback);
|
mbed714 |
0:d616ece2d859
|
2023
|
}
|
mbed714 |
0:d616ece2d859
|
2024
|
#endif /* LWIP_NETIF_LINK_CALLBACK */
|
mbed714 |
0:d616ece2d859
|
2025
|
|
mbed714 |
0:d616ece2d859
|
2026
|
#endif /* PPP_SUPPORT */
|