ZG2100 Network interface source

Committer:
donatien
Date:
Fri Jul 09 15:37:23 2010 +0000
Revision:
0:b802fc31f1db

        

Who changed what in which revision?

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