Donatien Garnier
ZG2100 Network interface source
lwip/netif/ppp/fsm.c@0:b802fc31f1db, 2010-07-09 (annotated)
- Committer:
- donatien
- Date:
- Fri Jul 09 15:37:23 2010 +0000
- Revision:
- 0:b802fc31f1db
- Child:
- 1:3a7c15057192
Who changed what in which revision?
| User | Revision | Line number | New contents of line |
|---|---|---|---|
| donatien | 0:b802fc31f1db | 1 | /***************************************************************************** |
| donatien | 0:b802fc31f1db | 2 | * fsm.c - Network Control Protocol Finite State Machine program file. |
| donatien | 0:b802fc31f1db | 3 | * |
| donatien | 0:b802fc31f1db | 4 | * Copyright (c) 2003 by Marc Boucher, Services Informatiques (MBSI) inc. |
| donatien | 0:b802fc31f1db | 5 | * portions Copyright (c) 1997 by Global Election Systems Inc. |
| donatien | 0:b802fc31f1db | 6 | * |
| donatien | 0:b802fc31f1db | 7 | * The authors hereby grant permission to use, copy, modify, distribute, |
| donatien | 0:b802fc31f1db | 8 | * and license this software and its documentation for any purpose, provided |
| donatien | 0:b802fc31f1db | 9 | * that existing copyright notices are retained in all copies and that this |
| donatien | 0:b802fc31f1db | 10 | * notice and the following disclaimer are included verbatim in any |
| donatien | 0:b802fc31f1db | 11 | * distributions. No written agreement, license, or royalty fee is required |
| donatien | 0:b802fc31f1db | 12 | * for any of the authorized uses. |
| donatien | 0:b802fc31f1db | 13 | * |
| donatien | 0:b802fc31f1db | 14 | * THIS SOFTWARE IS PROVIDED BY THE CONTRIBUTORS *AS IS* AND ANY EXPRESS OR |
| donatien | 0:b802fc31f1db | 15 | * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES |
| donatien | 0:b802fc31f1db | 16 | * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. |
| donatien | 0:b802fc31f1db | 17 | * IN NO EVENT SHALL THE CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, |
| donatien | 0:b802fc31f1db | 18 | * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT |
| donatien | 0:b802fc31f1db | 19 | * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, |
| donatien | 0:b802fc31f1db | 20 | * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY |
| donatien | 0:b802fc31f1db | 21 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
| donatien | 0:b802fc31f1db | 22 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF |
| donatien | 0:b802fc31f1db | 23 | * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
| donatien | 0:b802fc31f1db | 24 | * |
| donatien | 0:b802fc31f1db | 25 | ****************************************************************************** |
| donatien | 0:b802fc31f1db | 26 | * REVISION HISTORY |
| donatien | 0:b802fc31f1db | 27 | * |
| donatien | 0:b802fc31f1db | 28 | * 03-01-01 Marc Boucher <marc@mbsi.ca> |
| donatien | 0:b802fc31f1db | 29 | * Ported to lwIP. |
| donatien | 0:b802fc31f1db | 30 | * 97-12-01 Guy Lancaster <lancasterg@acm.org>, Global Election Systems Inc. |
| donatien | 0:b802fc31f1db | 31 | * Original based on BSD fsm.c. |
| donatien | 0:b802fc31f1db | 32 | *****************************************************************************/ |
| donatien | 0:b802fc31f1db | 33 | /* |
| donatien | 0:b802fc31f1db | 34 | * fsm.c - {Link, IP} Control Protocol Finite State Machine. |
| donatien | 0:b802fc31f1db | 35 | * |
| donatien | 0:b802fc31f1db | 36 | * Copyright (c) 1989 Carnegie Mellon University. |
| donatien | 0:b802fc31f1db | 37 | * All rights reserved. |
| donatien | 0:b802fc31f1db | 38 | * |
| donatien | 0:b802fc31f1db | 39 | * Redistribution and use in source and binary forms are permitted |
| donatien | 0:b802fc31f1db | 40 | * provided that the above copyright notice and this paragraph are |
| donatien | 0:b802fc31f1db | 41 | * duplicated in all such forms and that any documentation, |
| donatien | 0:b802fc31f1db | 42 | * advertising materials, and other materials related to such |
| donatien | 0:b802fc31f1db | 43 | * distribution and use acknowledge that the software was developed |
| donatien | 0:b802fc31f1db | 44 | * by Carnegie Mellon University. The name of the |
| donatien | 0:b802fc31f1db | 45 | * University may not be used to endorse or promote products derived |
| donatien | 0:b802fc31f1db | 46 | * from this software without specific prior written permission. |
| donatien | 0:b802fc31f1db | 47 | * THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR |
| donatien | 0:b802fc31f1db | 48 | * IMPLIED WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED |
| donatien | 0:b802fc31f1db | 49 | * WARRANTIES OF MERCHANTIBILITY AND FITNESS FOR A PARTICULAR PURPOSE. |
| donatien | 0:b802fc31f1db | 50 | */ |
| donatien | 0:b802fc31f1db | 51 | |
| donatien | 0:b802fc31f1db | 52 | /* |
| donatien | 0:b802fc31f1db | 53 | * TODO: |
| donatien | 0:b802fc31f1db | 54 | * Randomize fsm id on link/init. |
| donatien | 0:b802fc31f1db | 55 | * Deal with variable outgoing MTU. |
| donatien | 0:b802fc31f1db | 56 | */ |
| donatien | 0:b802fc31f1db | 57 | |
| donatien | 0:b802fc31f1db | 58 | #include "lwip/opt.h" |
| donatien | 0:b802fc31f1db | 59 | |
| donatien | 0:b802fc31f1db | 60 | #if PPP_SUPPORT /* don't build if not configured for use in lwipopts.h */ |
| donatien | 0:b802fc31f1db | 61 | |
| donatien | 0:b802fc31f1db | 62 | #include "ppp.h" |
| donatien | 0:b802fc31f1db | 63 | #include "pppdebug.h" |
| donatien | 0:b802fc31f1db | 64 | |
| donatien | 0:b802fc31f1db | 65 | #include "fsm.h" |
| donatien | 0:b802fc31f1db | 66 | |
| donatien | 0:b802fc31f1db | 67 | #include <string.h> |
| donatien | 0:b802fc31f1db | 68 | |
| donatien | 0:b802fc31f1db | 69 | #if PPP_DEBUG |
| donatien | 0:b802fc31f1db | 70 | static const char *ppperr_strerr[] = { |
| donatien | 0:b802fc31f1db | 71 | "LS_INITIAL", /* LS_INITIAL 0 */ |
| donatien | 0:b802fc31f1db | 72 | "LS_STARTING", /* LS_STARTING 1 */ |
| donatien | 0:b802fc31f1db | 73 | "LS_CLOSED", /* LS_CLOSED 2 */ |
| donatien | 0:b802fc31f1db | 74 | "LS_STOPPED", /* LS_STOPPED 3 */ |
| donatien | 0:b802fc31f1db | 75 | "LS_CLOSING", /* LS_CLOSING 4 */ |
| donatien | 0:b802fc31f1db | 76 | "LS_STOPPING", /* LS_STOPPING 5 */ |
| donatien | 0:b802fc31f1db | 77 | "LS_REQSENT", /* LS_REQSENT 6 */ |
| donatien | 0:b802fc31f1db | 78 | "LS_ACKRCVD", /* LS_ACKRCVD 7 */ |
| donatien | 0:b802fc31f1db | 79 | "LS_ACKSENT", /* LS_ACKSENT 8 */ |
| donatien | 0:b802fc31f1db | 80 | "LS_OPENED" /* LS_OPENED 9 */ |
| donatien | 0:b802fc31f1db | 81 | }; |
| donatien | 0:b802fc31f1db | 82 | #endif /* PPP_DEBUG */ |
| donatien | 0:b802fc31f1db | 83 | |
| donatien | 0:b802fc31f1db | 84 | static void fsm_timeout (void *); |
| donatien | 0:b802fc31f1db | 85 | static void fsm_rconfreq (fsm *, u_char, u_char *, int); |
| donatien | 0:b802fc31f1db | 86 | static void fsm_rconfack (fsm *, int, u_char *, int); |
| donatien | 0:b802fc31f1db | 87 | static void fsm_rconfnakrej (fsm *, int, int, u_char *, int); |
| donatien | 0:b802fc31f1db | 88 | static void fsm_rtermreq (fsm *, int, u_char *, int); |
| donatien | 0:b802fc31f1db | 89 | static void fsm_rtermack (fsm *); |
| donatien | 0:b802fc31f1db | 90 | static void fsm_rcoderej (fsm *, u_char *, int); |
| donatien | 0:b802fc31f1db | 91 | static void fsm_sconfreq (fsm *, int); |
| donatien | 0:b802fc31f1db | 92 | |
| donatien | 0:b802fc31f1db | 93 | #define PROTO_NAME(f) ((f)->callbacks->proto_name) |
| donatien | 0:b802fc31f1db | 94 | |
| donatien | 0:b802fc31f1db | 95 | int peer_mru[NUM_PPP]; |
| donatien | 0:b802fc31f1db | 96 | |
| donatien | 0:b802fc31f1db | 97 | |
| donatien | 0:b802fc31f1db | 98 | /* |
| donatien | 0:b802fc31f1db | 99 | * fsm_init - Initialize fsm. |
| donatien | 0:b802fc31f1db | 100 | * |
| donatien | 0:b802fc31f1db | 101 | * Initialize fsm state. |
| donatien | 0:b802fc31f1db | 102 | */ |
| donatien | 0:b802fc31f1db | 103 | void |
| donatien | 0:b802fc31f1db | 104 | fsm_init(fsm *f) |
| donatien | 0:b802fc31f1db | 105 | { |
| donatien | 0:b802fc31f1db | 106 | f->state = LS_INITIAL; |
| donatien | 0:b802fc31f1db | 107 | f->flags = 0; |
| donatien | 0:b802fc31f1db | 108 | f->id = 0; /* XXX Start with random id? */ |
| donatien | 0:b802fc31f1db | 109 | f->timeouttime = FSM_DEFTIMEOUT; |
| donatien | 0:b802fc31f1db | 110 | f->maxconfreqtransmits = FSM_DEFMAXCONFREQS; |
| donatien | 0:b802fc31f1db | 111 | f->maxtermtransmits = FSM_DEFMAXTERMREQS; |
| donatien | 0:b802fc31f1db | 112 | f->maxnakloops = FSM_DEFMAXNAKLOOPS; |
| donatien | 0:b802fc31f1db | 113 | f->term_reason_len = 0; |
| donatien | 0:b802fc31f1db | 114 | } |
| donatien | 0:b802fc31f1db | 115 | |
| donatien | 0:b802fc31f1db | 116 | |
| donatien | 0:b802fc31f1db | 117 | /* |
| donatien | 0:b802fc31f1db | 118 | * fsm_lowerup - The lower layer is up. |
| donatien | 0:b802fc31f1db | 119 | */ |
| donatien | 0:b802fc31f1db | 120 | void |
| donatien | 0:b802fc31f1db | 121 | fsm_lowerup(fsm *f) |
| donatien | 0:b802fc31f1db | 122 | { |
| donatien | 0:b802fc31f1db | 123 | #if PPP_DEBUG |
| donatien | 0:b802fc31f1db | 124 | int oldState = f->state; |
| donatien | 0:b802fc31f1db | 125 | |
| donatien | 0:b802fc31f1db | 126 | LWIP_UNUSED_ARG(oldState); |
| donatien | 0:b802fc31f1db | 127 | #endif |
| donatien | 0:b802fc31f1db | 128 | |
| donatien | 0:b802fc31f1db | 129 | switch( f->state ) { |
| donatien | 0:b802fc31f1db | 130 | case LS_INITIAL: |
| donatien | 0:b802fc31f1db | 131 | f->state = LS_CLOSED; |
| donatien | 0:b802fc31f1db | 132 | break; |
| donatien | 0:b802fc31f1db | 133 | |
| donatien | 0:b802fc31f1db | 134 | case LS_STARTING: |
| donatien | 0:b802fc31f1db | 135 | if( f->flags & OPT_SILENT ) { |
| donatien | 0:b802fc31f1db | 136 | f->state = LS_STOPPED; |
| donatien | 0:b802fc31f1db | 137 | } else { |
| donatien | 0:b802fc31f1db | 138 | /* Send an initial configure-request */ |
| donatien | 0:b802fc31f1db | 139 | fsm_sconfreq(f, 0); |
| donatien | 0:b802fc31f1db | 140 | f->state = LS_REQSENT; |
| donatien | 0:b802fc31f1db | 141 | } |
| donatien | 0:b802fc31f1db | 142 | break; |
| donatien | 0:b802fc31f1db | 143 | |
| donatien | 0:b802fc31f1db | 144 | default: |
| donatien | 0:b802fc31f1db | 145 | FSMDEBUG(LOG_INFO, ("%s: Up event in state %d (%s)!\n", |
| donatien | 0:b802fc31f1db | 146 | PROTO_NAME(f), f->state, ppperr_strerr[f->state])); |
| donatien | 0:b802fc31f1db | 147 | } |
| donatien | 0:b802fc31f1db | 148 | |
| donatien | 0:b802fc31f1db | 149 | FSMDEBUG(LOG_INFO, ("%s: lowerup state %d (%s) -> %d (%s)\n", |
| donatien | 0:b802fc31f1db | 150 | PROTO_NAME(f), oldState, ppperr_strerr[oldState], f->state, ppperr_strerr[f->state])); |
| donatien | 0:b802fc31f1db | 151 | } |
| donatien | 0:b802fc31f1db | 152 | |
| donatien | 0:b802fc31f1db | 153 | |
| donatien | 0:b802fc31f1db | 154 | /* |
| donatien | 0:b802fc31f1db | 155 | * fsm_lowerdown - The lower layer is down. |
| donatien | 0:b802fc31f1db | 156 | * |
| donatien | 0:b802fc31f1db | 157 | * Cancel all timeouts and inform upper layers. |
| donatien | 0:b802fc31f1db | 158 | */ |
| donatien | 0:b802fc31f1db | 159 | void |
| donatien | 0:b802fc31f1db | 160 | fsm_lowerdown(fsm *f) |
| donatien | 0:b802fc31f1db | 161 | { |
| donatien | 0:b802fc31f1db | 162 | #if PPP_DEBUG |
| donatien | 0:b802fc31f1db | 163 | int oldState = f->state; |
| donatien | 0:b802fc31f1db | 164 | |
| donatien | 0:b802fc31f1db | 165 | LWIP_UNUSED_ARG(oldState); |
| donatien | 0:b802fc31f1db | 166 | #endif |
| donatien | 0:b802fc31f1db | 167 | |
| donatien | 0:b802fc31f1db | 168 | switch( f->state ) { |
| donatien | 0:b802fc31f1db | 169 | case LS_CLOSED: |
| donatien | 0:b802fc31f1db | 170 | f->state = LS_INITIAL; |
| donatien | 0:b802fc31f1db | 171 | break; |
| donatien | 0:b802fc31f1db | 172 | |
| donatien | 0:b802fc31f1db | 173 | case LS_STOPPED: |
| donatien | 0:b802fc31f1db | 174 | f->state = LS_STARTING; |
| donatien | 0:b802fc31f1db | 175 | if( f->callbacks->starting ) { |
| donatien | 0:b802fc31f1db | 176 | (*f->callbacks->starting)(f); |
| donatien | 0:b802fc31f1db | 177 | } |
| donatien | 0:b802fc31f1db | 178 | break; |
| donatien | 0:b802fc31f1db | 179 | |
| donatien | 0:b802fc31f1db | 180 | case LS_CLOSING: |
| donatien | 0:b802fc31f1db | 181 | f->state = LS_INITIAL; |
| donatien | 0:b802fc31f1db | 182 | UNTIMEOUT(fsm_timeout, f); /* Cancel timeout */ |
| donatien | 0:b802fc31f1db | 183 | break; |
| donatien | 0:b802fc31f1db | 184 | |
| donatien | 0:b802fc31f1db | 185 | case LS_STOPPING: |
| donatien | 0:b802fc31f1db | 186 | case LS_REQSENT: |
| donatien | 0:b802fc31f1db | 187 | case LS_ACKRCVD: |
| donatien | 0:b802fc31f1db | 188 | case LS_ACKSENT: |
| donatien | 0:b802fc31f1db | 189 | f->state = LS_STARTING; |
| donatien | 0:b802fc31f1db | 190 | UNTIMEOUT(fsm_timeout, f); /* Cancel timeout */ |
| donatien | 0:b802fc31f1db | 191 | break; |
| donatien | 0:b802fc31f1db | 192 | |
| donatien | 0:b802fc31f1db | 193 | case LS_OPENED: |
| donatien | 0:b802fc31f1db | 194 | if( f->callbacks->down ) { |
| donatien | 0:b802fc31f1db | 195 | (*f->callbacks->down)(f); |
| donatien | 0:b802fc31f1db | 196 | } |
| donatien | 0:b802fc31f1db | 197 | f->state = LS_STARTING; |
| donatien | 0:b802fc31f1db | 198 | break; |
| donatien | 0:b802fc31f1db | 199 | |
| donatien | 0:b802fc31f1db | 200 | default: |
| donatien | 0:b802fc31f1db | 201 | FSMDEBUG(LOG_INFO, ("%s: Down event in state %d (%s)!\n", |
| donatien | 0:b802fc31f1db | 202 | PROTO_NAME(f), f->state, ppperr_strerr[f->state])); |
| donatien | 0:b802fc31f1db | 203 | } |
| donatien | 0:b802fc31f1db | 204 | |
| donatien | 0:b802fc31f1db | 205 | FSMDEBUG(LOG_INFO, ("%s: lowerdown state %d (%s) -> %d (%s)\n", |
| donatien | 0:b802fc31f1db | 206 | PROTO_NAME(f), oldState, ppperr_strerr[oldState], f->state, ppperr_strerr[f->state])); |
| donatien | 0:b802fc31f1db | 207 | } |
| donatien | 0:b802fc31f1db | 208 | |
| donatien | 0:b802fc31f1db | 209 | |
| donatien | 0:b802fc31f1db | 210 | /* |
| donatien | 0:b802fc31f1db | 211 | * fsm_open - Link is allowed to come up. |
| donatien | 0:b802fc31f1db | 212 | */ |
| donatien | 0:b802fc31f1db | 213 | void |
| donatien | 0:b802fc31f1db | 214 | fsm_open(fsm *f) |
| donatien | 0:b802fc31f1db | 215 | { |
| donatien | 0:b802fc31f1db | 216 | #if PPP_DEBUG |
| donatien | 0:b802fc31f1db | 217 | int oldState = f->state; |
| donatien | 0:b802fc31f1db | 218 | |
| donatien | 0:b802fc31f1db | 219 | LWIP_UNUSED_ARG(oldState); |
| donatien | 0:b802fc31f1db | 220 | #endif |
| donatien | 0:b802fc31f1db | 221 | |
| donatien | 0:b802fc31f1db | 222 | switch( f->state ) { |
| donatien | 0:b802fc31f1db | 223 | case LS_INITIAL: |
| donatien | 0:b802fc31f1db | 224 | f->state = LS_STARTING; |
| donatien | 0:b802fc31f1db | 225 | if( f->callbacks->starting ) { |
| donatien | 0:b802fc31f1db | 226 | (*f->callbacks->starting)(f); |
| donatien | 0:b802fc31f1db | 227 | } |
| donatien | 0:b802fc31f1db | 228 | break; |
| donatien | 0:b802fc31f1db | 229 | |
| donatien | 0:b802fc31f1db | 230 | case LS_CLOSED: |
| donatien | 0:b802fc31f1db | 231 | if( f->flags & OPT_SILENT ) { |
| donatien | 0:b802fc31f1db | 232 | f->state = LS_STOPPED; |
| donatien | 0:b802fc31f1db | 233 | } else { |
| donatien | 0:b802fc31f1db | 234 | /* Send an initial configure-request */ |
| donatien | 0:b802fc31f1db | 235 | fsm_sconfreq(f, 0); |
| donatien | 0:b802fc31f1db | 236 | f->state = LS_REQSENT; |
| donatien | 0:b802fc31f1db | 237 | } |
| donatien | 0:b802fc31f1db | 238 | break; |
| donatien | 0:b802fc31f1db | 239 | |
| donatien | 0:b802fc31f1db | 240 | case LS_CLOSING: |
| donatien | 0:b802fc31f1db | 241 | f->state = LS_STOPPING; |
| donatien | 0:b802fc31f1db | 242 | /* fall through */ |
| donatien | 0:b802fc31f1db | 243 | case LS_STOPPED: |
| donatien | 0:b802fc31f1db | 244 | case LS_OPENED: |
| donatien | 0:b802fc31f1db | 245 | if( f->flags & OPT_RESTART ) { |
| donatien | 0:b802fc31f1db | 246 | fsm_lowerdown(f); |
| donatien | 0:b802fc31f1db | 247 | fsm_lowerup(f); |
| donatien | 0:b802fc31f1db | 248 | } |
| donatien | 0:b802fc31f1db | 249 | break; |
| donatien | 0:b802fc31f1db | 250 | } |
| donatien | 0:b802fc31f1db | 251 | |
| donatien | 0:b802fc31f1db | 252 | FSMDEBUG(LOG_INFO, ("%s: open state %d (%s) -> %d (%s)\n", |
| donatien | 0:b802fc31f1db | 253 | PROTO_NAME(f), oldState, ppperr_strerr[oldState], f->state, ppperr_strerr[f->state])); |
| donatien | 0:b802fc31f1db | 254 | } |
| donatien | 0:b802fc31f1db | 255 | |
| donatien | 0:b802fc31f1db | 256 | #if 0 /* backport pppd 2.4.4b1; */ |
| donatien | 0:b802fc31f1db | 257 | /* |
| donatien | 0:b802fc31f1db | 258 | * terminate_layer - Start process of shutting down the FSM |
| donatien | 0:b802fc31f1db | 259 | * |
| donatien | 0:b802fc31f1db | 260 | * Cancel any timeout running, notify upper layers we're done, and |
| donatien | 0:b802fc31f1db | 261 | * send a terminate-request message as configured. |
| donatien | 0:b802fc31f1db | 262 | */ |
| donatien | 0:b802fc31f1db | 263 | static void |
| donatien | 0:b802fc31f1db | 264 | terminate_layer(fsm *f, int nextstate) |
| donatien | 0:b802fc31f1db | 265 | { |
| donatien | 0:b802fc31f1db | 266 | /* @todo */ |
| donatien | 0:b802fc31f1db | 267 | } |
| donatien | 0:b802fc31f1db | 268 | #endif |
| donatien | 0:b802fc31f1db | 269 | |
| donatien | 0:b802fc31f1db | 270 | /* |
| donatien | 0:b802fc31f1db | 271 | * fsm_close - Start closing connection. |
| donatien | 0:b802fc31f1db | 272 | * |
| donatien | 0:b802fc31f1db | 273 | * Cancel timeouts and either initiate close or possibly go directly to |
| donatien | 0:b802fc31f1db | 274 | * the LS_CLOSED state. |
| donatien | 0:b802fc31f1db | 275 | */ |
| donatien | 0:b802fc31f1db | 276 | void |
| donatien | 0:b802fc31f1db | 277 | fsm_close(fsm *f, char *reason) |
| donatien | 0:b802fc31f1db | 278 | { |
| donatien | 0:b802fc31f1db | 279 | #if PPP_DEBUG |
| donatien | 0:b802fc31f1db | 280 | int oldState = f->state; |
| donatien | 0:b802fc31f1db | 281 | |
| donatien | 0:b802fc31f1db | 282 | LWIP_UNUSED_ARG(oldState); |
| donatien | 0:b802fc31f1db | 283 | #endif |
| donatien | 0:b802fc31f1db | 284 | |
| donatien | 0:b802fc31f1db | 285 | f->term_reason = reason; |
| donatien | 0:b802fc31f1db | 286 | f->term_reason_len = (reason == NULL ? 0 : (int)strlen(reason)); |
| donatien | 0:b802fc31f1db | 287 | switch( f->state ) { |
| donatien | 0:b802fc31f1db | 288 | case LS_STARTING: |
| donatien | 0:b802fc31f1db | 289 | f->state = LS_INITIAL; |
| donatien | 0:b802fc31f1db | 290 | break; |
| donatien | 0:b802fc31f1db | 291 | case LS_STOPPED: |
| donatien | 0:b802fc31f1db | 292 | f->state = LS_CLOSED; |
| donatien | 0:b802fc31f1db | 293 | break; |
| donatien | 0:b802fc31f1db | 294 | case LS_STOPPING: |
| donatien | 0:b802fc31f1db | 295 | f->state = LS_CLOSING; |
| donatien | 0:b802fc31f1db | 296 | break; |
| donatien | 0:b802fc31f1db | 297 | |
| donatien | 0:b802fc31f1db | 298 | case LS_REQSENT: |
| donatien | 0:b802fc31f1db | 299 | case LS_ACKRCVD: |
| donatien | 0:b802fc31f1db | 300 | case LS_ACKSENT: |
| donatien | 0:b802fc31f1db | 301 | case LS_OPENED: |
| donatien | 0:b802fc31f1db | 302 | if( f->state != LS_OPENED ) { |
| donatien | 0:b802fc31f1db | 303 | UNTIMEOUT(fsm_timeout, f); /* Cancel timeout */ |
| donatien | 0:b802fc31f1db | 304 | } else if( f->callbacks->down ) { |
| donatien | 0:b802fc31f1db | 305 | (*f->callbacks->down)(f); /* Inform upper layers we're down */ |
| donatien | 0:b802fc31f1db | 306 | } |
| donatien | 0:b802fc31f1db | 307 | /* Init restart counter, send Terminate-Request */ |
| donatien | 0:b802fc31f1db | 308 | f->retransmits = f->maxtermtransmits; |
| donatien | 0:b802fc31f1db | 309 | fsm_sdata(f, TERMREQ, f->reqid = ++f->id, |
| donatien | 0:b802fc31f1db | 310 | (u_char *) f->term_reason, f->term_reason_len); |
| donatien | 0:b802fc31f1db | 311 | TIMEOUT(fsm_timeout, f, f->timeouttime); |
| donatien | 0:b802fc31f1db | 312 | --f->retransmits; |
| donatien | 0:b802fc31f1db | 313 | |
| donatien | 0:b802fc31f1db | 314 | f->state = LS_CLOSING; |
| donatien | 0:b802fc31f1db | 315 | break; |
| donatien | 0:b802fc31f1db | 316 | } |
| donatien | 0:b802fc31f1db | 317 | |
| donatien | 0:b802fc31f1db | 318 | FSMDEBUG(LOG_INFO, ("%s: close reason=%s state %d (%s) -> %d (%s)\n", |
| donatien | 0:b802fc31f1db | 319 | PROTO_NAME(f), reason, oldState, ppperr_strerr[oldState], f->state, ppperr_strerr[f->state])); |
| donatien | 0:b802fc31f1db | 320 | } |
| donatien | 0:b802fc31f1db | 321 | |
| donatien | 0:b802fc31f1db | 322 | |
| donatien | 0:b802fc31f1db | 323 | /* |
| donatien | 0:b802fc31f1db | 324 | * fsm_timeout - Timeout expired. |
| donatien | 0:b802fc31f1db | 325 | */ |
| donatien | 0:b802fc31f1db | 326 | static void |
| donatien | 0:b802fc31f1db | 327 | fsm_timeout(void *arg) |
| donatien | 0:b802fc31f1db | 328 | { |
| donatien | 0:b802fc31f1db | 329 | fsm *f = (fsm *) arg; |
| donatien | 0:b802fc31f1db | 330 | |
| donatien | 0:b802fc31f1db | 331 | switch (f->state) { |
| donatien | 0:b802fc31f1db | 332 | case LS_CLOSING: |
| donatien | 0:b802fc31f1db | 333 | case LS_STOPPING: |
| donatien | 0:b802fc31f1db | 334 | if( f->retransmits <= 0 ) { |
| donatien | 0:b802fc31f1db | 335 | FSMDEBUG(LOG_WARNING, ("%s: timeout sending Terminate-Request state=%d (%s)\n", |
| donatien | 0:b802fc31f1db | 336 | PROTO_NAME(f), f->state, ppperr_strerr[f->state])); |
| donatien | 0:b802fc31f1db | 337 | /* |
| donatien | 0:b802fc31f1db | 338 | * We've waited for an ack long enough. Peer probably heard us. |
| donatien | 0:b802fc31f1db | 339 | */ |
| donatien | 0:b802fc31f1db | 340 | f->state = (f->state == LS_CLOSING)? LS_CLOSED: LS_STOPPED; |
| donatien | 0:b802fc31f1db | 341 | if( f->callbacks->finished ) { |
| donatien | 0:b802fc31f1db | 342 | (*f->callbacks->finished)(f); |
| donatien | 0:b802fc31f1db | 343 | } |
| donatien | 0:b802fc31f1db | 344 | } else { |
| donatien | 0:b802fc31f1db | 345 | FSMDEBUG(LOG_WARNING, ("%s: timeout resending Terminate-Requests state=%d (%s)\n", |
| donatien | 0:b802fc31f1db | 346 | PROTO_NAME(f), f->state, ppperr_strerr[f->state])); |
| donatien | 0:b802fc31f1db | 347 | /* Send Terminate-Request */ |
| donatien | 0:b802fc31f1db | 348 | fsm_sdata(f, TERMREQ, f->reqid = ++f->id, |
| donatien | 0:b802fc31f1db | 349 | (u_char *) f->term_reason, f->term_reason_len); |
| donatien | 0:b802fc31f1db | 350 | TIMEOUT(fsm_timeout, f, f->timeouttime); |
| donatien | 0:b802fc31f1db | 351 | --f->retransmits; |
| donatien | 0:b802fc31f1db | 352 | } |
| donatien | 0:b802fc31f1db | 353 | break; |
| donatien | 0:b802fc31f1db | 354 | |
| donatien | 0:b802fc31f1db | 355 | case LS_REQSENT: |
| donatien | 0:b802fc31f1db | 356 | case LS_ACKRCVD: |
| donatien | 0:b802fc31f1db | 357 | case LS_ACKSENT: |
| donatien | 0:b802fc31f1db | 358 | if (f->retransmits <= 0) { |
| donatien | 0:b802fc31f1db | 359 | FSMDEBUG(LOG_WARNING, ("%s: timeout sending Config-Requests state=%d (%s)\n", |
| donatien | 0:b802fc31f1db | 360 | PROTO_NAME(f), f->state, ppperr_strerr[f->state])); |
| donatien | 0:b802fc31f1db | 361 | f->state = LS_STOPPED; |
| donatien | 0:b802fc31f1db | 362 | if( (f->flags & OPT_PASSIVE) == 0 && f->callbacks->finished ) { |
| donatien | 0:b802fc31f1db | 363 | (*f->callbacks->finished)(f); |
| donatien | 0:b802fc31f1db | 364 | } |
| donatien | 0:b802fc31f1db | 365 | } else { |
| donatien | 0:b802fc31f1db | 366 | FSMDEBUG(LOG_WARNING, ("%s: timeout resending Config-Request state=%d (%s)\n", |
| donatien | 0:b802fc31f1db | 367 | PROTO_NAME(f), f->state, ppperr_strerr[f->state])); |
| donatien | 0:b802fc31f1db | 368 | /* Retransmit the configure-request */ |
| donatien | 0:b802fc31f1db | 369 | if (f->callbacks->retransmit) { |
| donatien | 0:b802fc31f1db | 370 | (*f->callbacks->retransmit)(f); |
| donatien | 0:b802fc31f1db | 371 | } |
| donatien | 0:b802fc31f1db | 372 | fsm_sconfreq(f, 1); /* Re-send Configure-Request */ |
| donatien | 0:b802fc31f1db | 373 | if( f->state == LS_ACKRCVD ) { |
| donatien | 0:b802fc31f1db | 374 | f->state = LS_REQSENT; |
| donatien | 0:b802fc31f1db | 375 | } |
| donatien | 0:b802fc31f1db | 376 | } |
| donatien | 0:b802fc31f1db | 377 | break; |
| donatien | 0:b802fc31f1db | 378 | |
| donatien | 0:b802fc31f1db | 379 | default: |
| donatien | 0:b802fc31f1db | 380 | FSMDEBUG(LOG_INFO, ("%s: UNHANDLED timeout event in state %d (%s)!\n", |
| donatien | 0:b802fc31f1db | 381 | PROTO_NAME(f), f->state, ppperr_strerr[f->state])); |
| donatien | 0:b802fc31f1db | 382 | } |
| donatien | 0:b802fc31f1db | 383 | } |
| donatien | 0:b802fc31f1db | 384 | |
| donatien | 0:b802fc31f1db | 385 | |
| donatien | 0:b802fc31f1db | 386 | /* |
| donatien | 0:b802fc31f1db | 387 | * fsm_input - Input packet. |
| donatien | 0:b802fc31f1db | 388 | */ |
| donatien | 0:b802fc31f1db | 389 | void |
| donatien | 0:b802fc31f1db | 390 | fsm_input(fsm *f, u_char *inpacket, int l) |
| donatien | 0:b802fc31f1db | 391 | { |
| donatien | 0:b802fc31f1db | 392 | u_char *inp = inpacket; |
| donatien | 0:b802fc31f1db | 393 | u_char code, id; |
| donatien | 0:b802fc31f1db | 394 | int len; |
| donatien | 0:b802fc31f1db | 395 | |
| donatien | 0:b802fc31f1db | 396 | /* |
| donatien | 0:b802fc31f1db | 397 | * Parse header (code, id and length). |
| donatien | 0:b802fc31f1db | 398 | * If packet too short, drop it. |
| donatien | 0:b802fc31f1db | 399 | */ |
| donatien | 0:b802fc31f1db | 400 | if (l < HEADERLEN) { |
| donatien | 0:b802fc31f1db | 401 | FSMDEBUG(LOG_WARNING, ("fsm_input(%x): Rcvd short header.\n", |
| donatien | 0:b802fc31f1db | 402 | f->protocol)); |
| donatien | 0:b802fc31f1db | 403 | return; |
| donatien | 0:b802fc31f1db | 404 | } |
| donatien | 0:b802fc31f1db | 405 | GETCHAR(code, inp); |
| donatien | 0:b802fc31f1db | 406 | GETCHAR(id, inp); |
| donatien | 0:b802fc31f1db | 407 | GETSHORT(len, inp); |
| donatien | 0:b802fc31f1db | 408 | if (len < HEADERLEN) { |
| donatien | 0:b802fc31f1db | 409 | FSMDEBUG(LOG_INFO, ("fsm_input(%x): Rcvd illegal length.\n", |
| donatien | 0:b802fc31f1db | 410 | f->protocol)); |
| donatien | 0:b802fc31f1db | 411 | return; |
| donatien | 0:b802fc31f1db | 412 | } |
| donatien | 0:b802fc31f1db | 413 | if (len > l) { |
| donatien | 0:b802fc31f1db | 414 | FSMDEBUG(LOG_INFO, ("fsm_input(%x): Rcvd short packet.\n", |
| donatien | 0:b802fc31f1db | 415 | f->protocol)); |
| donatien | 0:b802fc31f1db | 416 | return; |
| donatien | 0:b802fc31f1db | 417 | } |
| donatien | 0:b802fc31f1db | 418 | len -= HEADERLEN; /* subtract header length */ |
| donatien | 0:b802fc31f1db | 419 | |
| donatien | 0:b802fc31f1db | 420 | if( f->state == LS_INITIAL || f->state == LS_STARTING ) { |
| donatien | 0:b802fc31f1db | 421 | FSMDEBUG(LOG_INFO, ("fsm_input(%x): Rcvd packet in state %d (%s).\n", |
| donatien | 0:b802fc31f1db | 422 | f->protocol, f->state, ppperr_strerr[f->state])); |
| donatien | 0:b802fc31f1db | 423 | return; |
| donatien | 0:b802fc31f1db | 424 | } |
| donatien | 0:b802fc31f1db | 425 | FSMDEBUG(LOG_INFO, ("fsm_input(%s):%d,%d,%d\n", PROTO_NAME(f), code, id, l)); |
| donatien | 0:b802fc31f1db | 426 | /* |
| donatien | 0:b802fc31f1db | 427 | * Action depends on code. |
| donatien | 0:b802fc31f1db | 428 | */ |
| donatien | 0:b802fc31f1db | 429 | switch (code) { |
| donatien | 0:b802fc31f1db | 430 | case CONFREQ: |
| donatien | 0:b802fc31f1db | 431 | fsm_rconfreq(f, id, inp, len); |
| donatien | 0:b802fc31f1db | 432 | break; |
| donatien | 0:b802fc31f1db | 433 | |
| donatien | 0:b802fc31f1db | 434 | case CONFACK: |
| donatien | 0:b802fc31f1db | 435 | fsm_rconfack(f, id, inp, len); |
| donatien | 0:b802fc31f1db | 436 | break; |
| donatien | 0:b802fc31f1db | 437 | |
| donatien | 0:b802fc31f1db | 438 | case CONFNAK: |
| donatien | 0:b802fc31f1db | 439 | case CONFREJ: |
| donatien | 0:b802fc31f1db | 440 | fsm_rconfnakrej(f, code, id, inp, len); |
| donatien | 0:b802fc31f1db | 441 | break; |
| donatien | 0:b802fc31f1db | 442 | |
| donatien | 0:b802fc31f1db | 443 | case TERMREQ: |
| donatien | 0:b802fc31f1db | 444 | fsm_rtermreq(f, id, inp, len); |
| donatien | 0:b802fc31f1db | 445 | break; |
| donatien | 0:b802fc31f1db | 446 | |
| donatien | 0:b802fc31f1db | 447 | case TERMACK: |
| donatien | 0:b802fc31f1db | 448 | fsm_rtermack(f); |
| donatien | 0:b802fc31f1db | 449 | break; |
| donatien | 0:b802fc31f1db | 450 | |
| donatien | 0:b802fc31f1db | 451 | case CODEREJ: |
| donatien | 0:b802fc31f1db | 452 | fsm_rcoderej(f, inp, len); |
| donatien | 0:b802fc31f1db | 453 | break; |
| donatien | 0:b802fc31f1db | 454 | |
| donatien | 0:b802fc31f1db | 455 | default: |
| donatien | 0:b802fc31f1db | 456 | FSMDEBUG(LOG_INFO, ("fsm_input(%s): default: \n", PROTO_NAME(f))); |
| donatien | 0:b802fc31f1db | 457 | if( !f->callbacks->extcode || |
| donatien | 0:b802fc31f1db | 458 | !(*f->callbacks->extcode)(f, code, id, inp, len) ) { |
| donatien | 0:b802fc31f1db | 459 | fsm_sdata(f, CODEREJ, ++f->id, inpacket, len + HEADERLEN); |
| donatien | 0:b802fc31f1db | 460 | } |
| donatien | 0:b802fc31f1db | 461 | break; |
| donatien | 0:b802fc31f1db | 462 | } |
| donatien | 0:b802fc31f1db | 463 | } |
| donatien | 0:b802fc31f1db | 464 | |
| donatien | 0:b802fc31f1db | 465 | |
| donatien | 0:b802fc31f1db | 466 | /* |
| donatien | 0:b802fc31f1db | 467 | * fsm_rconfreq - Receive Configure-Request. |
| donatien | 0:b802fc31f1db | 468 | */ |
| donatien | 0:b802fc31f1db | 469 | static void |
| donatien | 0:b802fc31f1db | 470 | fsm_rconfreq(fsm *f, u_char id, u_char *inp, int len) |
| donatien | 0:b802fc31f1db | 471 | { |
| donatien | 0:b802fc31f1db | 472 | int code, reject_if_disagree; |
| donatien | 0:b802fc31f1db | 473 | |
| donatien | 0:b802fc31f1db | 474 | FSMDEBUG(LOG_INFO, ("fsm_rconfreq(%s): Rcvd id %d state=%d (%s)\n", |
| donatien | 0:b802fc31f1db | 475 | PROTO_NAME(f), id, f->state, ppperr_strerr[f->state])); |
| donatien | 0:b802fc31f1db | 476 | switch( f->state ) { |
| donatien | 0:b802fc31f1db | 477 | case LS_CLOSED: |
| donatien | 0:b802fc31f1db | 478 | /* Go away, we're closed */ |
| donatien | 0:b802fc31f1db | 479 | fsm_sdata(f, TERMACK, id, NULL, 0); |
| donatien | 0:b802fc31f1db | 480 | return; |
| donatien | 0:b802fc31f1db | 481 | case LS_CLOSING: |
| donatien | 0:b802fc31f1db | 482 | case LS_STOPPING: |
| donatien | 0:b802fc31f1db | 483 | return; |
| donatien | 0:b802fc31f1db | 484 | |
| donatien | 0:b802fc31f1db | 485 | case LS_OPENED: |
| donatien | 0:b802fc31f1db | 486 | /* Go down and restart negotiation */ |
| donatien | 0:b802fc31f1db | 487 | if( f->callbacks->down ) { |
| donatien | 0:b802fc31f1db | 488 | (*f->callbacks->down)(f); /* Inform upper layers */ |
| donatien | 0:b802fc31f1db | 489 | } |
| donatien | 0:b802fc31f1db | 490 | fsm_sconfreq(f, 0); /* Send initial Configure-Request */ |
| donatien | 0:b802fc31f1db | 491 | break; |
| donatien | 0:b802fc31f1db | 492 | |
| donatien | 0:b802fc31f1db | 493 | case LS_STOPPED: |
| donatien | 0:b802fc31f1db | 494 | /* Negotiation started by our peer */ |
| donatien | 0:b802fc31f1db | 495 | fsm_sconfreq(f, 0); /* Send initial Configure-Request */ |
| donatien | 0:b802fc31f1db | 496 | f->state = LS_REQSENT; |
| donatien | 0:b802fc31f1db | 497 | break; |
| donatien | 0:b802fc31f1db | 498 | } |
| donatien | 0:b802fc31f1db | 499 | |
| donatien | 0:b802fc31f1db | 500 | /* |
| donatien | 0:b802fc31f1db | 501 | * Pass the requested configuration options |
| donatien | 0:b802fc31f1db | 502 | * to protocol-specific code for checking. |
| donatien | 0:b802fc31f1db | 503 | */ |
| donatien | 0:b802fc31f1db | 504 | if (f->callbacks->reqci) { /* Check CI */ |
| donatien | 0:b802fc31f1db | 505 | reject_if_disagree = (f->nakloops >= f->maxnakloops); |
| donatien | 0:b802fc31f1db | 506 | code = (*f->callbacks->reqci)(f, inp, &len, reject_if_disagree); |
| donatien | 0:b802fc31f1db | 507 | } else if (len) { |
| donatien | 0:b802fc31f1db | 508 | code = CONFREJ; /* Reject all CI */ |
| donatien | 0:b802fc31f1db | 509 | } else { |
| donatien | 0:b802fc31f1db | 510 | code = CONFACK; |
| donatien | 0:b802fc31f1db | 511 | } |
| donatien | 0:b802fc31f1db | 512 | |
| donatien | 0:b802fc31f1db | 513 | /* send the Ack, Nak or Rej to the peer */ |
| donatien | 0:b802fc31f1db | 514 | fsm_sdata(f, (u_char)code, id, inp, len); |
| donatien | 0:b802fc31f1db | 515 | |
| donatien | 0:b802fc31f1db | 516 | if (code == CONFACK) { |
| donatien | 0:b802fc31f1db | 517 | if (f->state == LS_ACKRCVD) { |
| donatien | 0:b802fc31f1db | 518 | UNTIMEOUT(fsm_timeout, f); /* Cancel timeout */ |
| donatien | 0:b802fc31f1db | 519 | f->state = LS_OPENED; |
| donatien | 0:b802fc31f1db | 520 | if (f->callbacks->up) { |
| donatien | 0:b802fc31f1db | 521 | (*f->callbacks->up)(f); /* Inform upper layers */ |
| donatien | 0:b802fc31f1db | 522 | } |
| donatien | 0:b802fc31f1db | 523 | } else { |
| donatien | 0:b802fc31f1db | 524 | f->state = LS_ACKSENT; |
| donatien | 0:b802fc31f1db | 525 | } |
| donatien | 0:b802fc31f1db | 526 | f->nakloops = 0; |
| donatien | 0:b802fc31f1db | 527 | } else { |
| donatien | 0:b802fc31f1db | 528 | /* we sent CONFACK or CONFREJ */ |
| donatien | 0:b802fc31f1db | 529 | if (f->state != LS_ACKRCVD) { |
| donatien | 0:b802fc31f1db | 530 | f->state = LS_REQSENT; |
| donatien | 0:b802fc31f1db | 531 | } |
| donatien | 0:b802fc31f1db | 532 | if( code == CONFNAK ) { |
| donatien | 0:b802fc31f1db | 533 | ++f->nakloops; |
| donatien | 0:b802fc31f1db | 534 | } |
| donatien | 0:b802fc31f1db | 535 | } |
| donatien | 0:b802fc31f1db | 536 | } |
| donatien | 0:b802fc31f1db | 537 | |
| donatien | 0:b802fc31f1db | 538 | |
| donatien | 0:b802fc31f1db | 539 | /* |
| donatien | 0:b802fc31f1db | 540 | * fsm_rconfack - Receive Configure-Ack. |
| donatien | 0:b802fc31f1db | 541 | */ |
| donatien | 0:b802fc31f1db | 542 | static void |
| donatien | 0:b802fc31f1db | 543 | fsm_rconfack(fsm *f, int id, u_char *inp, int len) |
| donatien | 0:b802fc31f1db | 544 | { |
| donatien | 0:b802fc31f1db | 545 | FSMDEBUG(LOG_INFO, ("fsm_rconfack(%s): Rcvd id %d state=%d (%s)\n", |
| donatien | 0:b802fc31f1db | 546 | PROTO_NAME(f), id, f->state, ppperr_strerr[f->state])); |
| donatien | 0:b802fc31f1db | 547 | |
| donatien | 0:b802fc31f1db | 548 | if (id != f->reqid || f->seen_ack) { /* Expected id? */ |
| donatien | 0:b802fc31f1db | 549 | return; /* Nope, toss... */ |
| donatien | 0:b802fc31f1db | 550 | } |
| donatien | 0:b802fc31f1db | 551 | if( !(f->callbacks->ackci? (*f->callbacks->ackci)(f, inp, len): (len == 0)) ) { |
| donatien | 0:b802fc31f1db | 552 | /* Ack is bad - ignore it */ |
| donatien | 0:b802fc31f1db | 553 | FSMDEBUG(LOG_INFO, ("%s: received bad Ack (length %d)\n", |
| donatien | 0:b802fc31f1db | 554 | PROTO_NAME(f), len)); |
| donatien | 0:b802fc31f1db | 555 | return; |
| donatien | 0:b802fc31f1db | 556 | } |
| donatien | 0:b802fc31f1db | 557 | f->seen_ack = 1; |
| donatien | 0:b802fc31f1db | 558 | |
| donatien | 0:b802fc31f1db | 559 | switch (f->state) { |
| donatien | 0:b802fc31f1db | 560 | case LS_CLOSED: |
| donatien | 0:b802fc31f1db | 561 | case LS_STOPPED: |
| donatien | 0:b802fc31f1db | 562 | fsm_sdata(f, TERMACK, (u_char)id, NULL, 0); |
| donatien | 0:b802fc31f1db | 563 | break; |
| donatien | 0:b802fc31f1db | 564 | |
| donatien | 0:b802fc31f1db | 565 | case LS_REQSENT: |
| donatien | 0:b802fc31f1db | 566 | f->state = LS_ACKRCVD; |
| donatien | 0:b802fc31f1db | 567 | f->retransmits = f->maxconfreqtransmits; |
| donatien | 0:b802fc31f1db | 568 | break; |
| donatien | 0:b802fc31f1db | 569 | |
| donatien | 0:b802fc31f1db | 570 | case LS_ACKRCVD: |
| donatien | 0:b802fc31f1db | 571 | /* Huh? an extra valid Ack? oh well... */ |
| donatien | 0:b802fc31f1db | 572 | UNTIMEOUT(fsm_timeout, f); /* Cancel timeout */ |
| donatien | 0:b802fc31f1db | 573 | fsm_sconfreq(f, 0); |
| donatien | 0:b802fc31f1db | 574 | f->state = LS_REQSENT; |
| donatien | 0:b802fc31f1db | 575 | break; |
| donatien | 0:b802fc31f1db | 576 | |
| donatien | 0:b802fc31f1db | 577 | case LS_ACKSENT: |
| donatien | 0:b802fc31f1db | 578 | UNTIMEOUT(fsm_timeout, f); /* Cancel timeout */ |
| donatien | 0:b802fc31f1db | 579 | f->state = LS_OPENED; |
| donatien | 0:b802fc31f1db | 580 | f->retransmits = f->maxconfreqtransmits; |
| donatien | 0:b802fc31f1db | 581 | if (f->callbacks->up) { |
| donatien | 0:b802fc31f1db | 582 | (*f->callbacks->up)(f); /* Inform upper layers */ |
| donatien | 0:b802fc31f1db | 583 | } |
| donatien | 0:b802fc31f1db | 584 | break; |
| donatien | 0:b802fc31f1db | 585 | |
| donatien | 0:b802fc31f1db | 586 | case LS_OPENED: |
| donatien | 0:b802fc31f1db | 587 | /* Go down and restart negotiation */ |
| donatien | 0:b802fc31f1db | 588 | if (f->callbacks->down) { |
| donatien | 0:b802fc31f1db | 589 | (*f->callbacks->down)(f); /* Inform upper layers */ |
| donatien | 0:b802fc31f1db | 590 | } |
| donatien | 0:b802fc31f1db | 591 | fsm_sconfreq(f, 0); /* Send initial Configure-Request */ |
| donatien | 0:b802fc31f1db | 592 | f->state = LS_REQSENT; |
| donatien | 0:b802fc31f1db | 593 | break; |
| donatien | 0:b802fc31f1db | 594 | } |
| donatien | 0:b802fc31f1db | 595 | } |
| donatien | 0:b802fc31f1db | 596 | |
| donatien | 0:b802fc31f1db | 597 | |
| donatien | 0:b802fc31f1db | 598 | /* |
| donatien | 0:b802fc31f1db | 599 | * fsm_rconfnakrej - Receive Configure-Nak or Configure-Reject. |
| donatien | 0:b802fc31f1db | 600 | */ |
| donatien | 0:b802fc31f1db | 601 | static void |
| donatien | 0:b802fc31f1db | 602 | fsm_rconfnakrej(fsm *f, int code, int id, u_char *inp, int len) |
| donatien | 0:b802fc31f1db | 603 | { |
| donatien | 0:b802fc31f1db | 604 | int (*proc) (fsm *, u_char *, int); |
| donatien | 0:b802fc31f1db | 605 | int ret; |
| donatien | 0:b802fc31f1db | 606 | |
| donatien | 0:b802fc31f1db | 607 | FSMDEBUG(LOG_INFO, ("fsm_rconfnakrej(%s): Rcvd id %d state=%d (%s)\n", |
| donatien | 0:b802fc31f1db | 608 | PROTO_NAME(f), id, f->state, ppperr_strerr[f->state])); |
| donatien | 0:b802fc31f1db | 609 | |
| donatien | 0:b802fc31f1db | 610 | if (id != f->reqid || f->seen_ack) { /* Expected id? */ |
| donatien | 0:b802fc31f1db | 611 | return; /* Nope, toss... */ |
| donatien | 0:b802fc31f1db | 612 | } |
| donatien | 0:b802fc31f1db | 613 | proc = (code == CONFNAK)? f->callbacks->nakci: f->callbacks->rejci; |
| donatien | 0:b802fc31f1db | 614 | if (!proc || !((ret = proc(f, inp, len)))) { |
| donatien | 0:b802fc31f1db | 615 | /* Nak/reject is bad - ignore it */ |
| donatien | 0:b802fc31f1db | 616 | FSMDEBUG(LOG_INFO, ("%s: received bad %s (length %d)\n", |
| donatien | 0:b802fc31f1db | 617 | PROTO_NAME(f), (code==CONFNAK? "Nak": "reject"), len)); |
| donatien | 0:b802fc31f1db | 618 | return; |
| donatien | 0:b802fc31f1db | 619 | } |
| donatien | 0:b802fc31f1db | 620 | f->seen_ack = 1; |
| donatien | 0:b802fc31f1db | 621 | |
| donatien | 0:b802fc31f1db | 622 | switch (f->state) { |
| donatien | 0:b802fc31f1db | 623 | case LS_CLOSED: |
| donatien | 0:b802fc31f1db | 624 | case LS_STOPPED: |
| donatien | 0:b802fc31f1db | 625 | fsm_sdata(f, TERMACK, (u_char)id, NULL, 0); |
| donatien | 0:b802fc31f1db | 626 | break; |
| donatien | 0:b802fc31f1db | 627 | |
| donatien | 0:b802fc31f1db | 628 | case LS_REQSENT: |
| donatien | 0:b802fc31f1db | 629 | case LS_ACKSENT: |
| donatien | 0:b802fc31f1db | 630 | /* They didn't agree to what we wanted - try another request */ |
| donatien | 0:b802fc31f1db | 631 | UNTIMEOUT(fsm_timeout, f); /* Cancel timeout */ |
| donatien | 0:b802fc31f1db | 632 | if (ret < 0) { |
| donatien | 0:b802fc31f1db | 633 | f->state = LS_STOPPED; /* kludge for stopping CCP */ |
| donatien | 0:b802fc31f1db | 634 | } else { |
| donatien | 0:b802fc31f1db | 635 | fsm_sconfreq(f, 0); /* Send Configure-Request */ |
| donatien | 0:b802fc31f1db | 636 | } |
| donatien | 0:b802fc31f1db | 637 | break; |
| donatien | 0:b802fc31f1db | 638 | |
| donatien | 0:b802fc31f1db | 639 | case LS_ACKRCVD: |
| donatien | 0:b802fc31f1db | 640 | /* Got a Nak/reject when we had already had an Ack?? oh well... */ |
| donatien | 0:b802fc31f1db | 641 | UNTIMEOUT(fsm_timeout, f); /* Cancel timeout */ |
| donatien | 0:b802fc31f1db | 642 | fsm_sconfreq(f, 0); |
| donatien | 0:b802fc31f1db | 643 | f->state = LS_REQSENT; |
| donatien | 0:b802fc31f1db | 644 | break; |
| donatien | 0:b802fc31f1db | 645 | |
| donatien | 0:b802fc31f1db | 646 | case LS_OPENED: |
| donatien | 0:b802fc31f1db | 647 | /* Go down and restart negotiation */ |
| donatien | 0:b802fc31f1db | 648 | if (f->callbacks->down) { |
| donatien | 0:b802fc31f1db | 649 | (*f->callbacks->down)(f); /* Inform upper layers */ |
| donatien | 0:b802fc31f1db | 650 | } |
| donatien | 0:b802fc31f1db | 651 | fsm_sconfreq(f, 0); /* Send initial Configure-Request */ |
| donatien | 0:b802fc31f1db | 652 | f->state = LS_REQSENT; |
| donatien | 0:b802fc31f1db | 653 | break; |
| donatien | 0:b802fc31f1db | 654 | } |
| donatien | 0:b802fc31f1db | 655 | } |
| donatien | 0:b802fc31f1db | 656 | |
| donatien | 0:b802fc31f1db | 657 | |
| donatien | 0:b802fc31f1db | 658 | /* |
| donatien | 0:b802fc31f1db | 659 | * fsm_rtermreq - Receive Terminate-Req. |
| donatien | 0:b802fc31f1db | 660 | */ |
| donatien | 0:b802fc31f1db | 661 | static void |
| donatien | 0:b802fc31f1db | 662 | fsm_rtermreq(fsm *f, int id, u_char *p, int len) |
| donatien | 0:b802fc31f1db | 663 | { |
| donatien | 0:b802fc31f1db | 664 | LWIP_UNUSED_ARG(p); |
| donatien | 0:b802fc31f1db | 665 | |
| donatien | 0:b802fc31f1db | 666 | FSMDEBUG(LOG_INFO, ("fsm_rtermreq(%s): Rcvd id %d state=%d (%s)\n", |
| donatien | 0:b802fc31f1db | 667 | PROTO_NAME(f), id, f->state, ppperr_strerr[f->state])); |
| donatien | 0:b802fc31f1db | 668 | |
| donatien | 0:b802fc31f1db | 669 | switch (f->state) { |
| donatien | 0:b802fc31f1db | 670 | case LS_ACKRCVD: |
| donatien | 0:b802fc31f1db | 671 | case LS_ACKSENT: |
| donatien | 0:b802fc31f1db | 672 | f->state = LS_REQSENT; /* Start over but keep trying */ |
| donatien | 0:b802fc31f1db | 673 | break; |
| donatien | 0:b802fc31f1db | 674 | |
| donatien | 0:b802fc31f1db | 675 | case LS_OPENED: |
| donatien | 0:b802fc31f1db | 676 | if (len > 0) { |
| donatien | 0:b802fc31f1db | 677 | FSMDEBUG(LOG_INFO, ("%s terminated by peer (%p)\n", PROTO_NAME(f), p)); |
| donatien | 0:b802fc31f1db | 678 | } else { |
| donatien | 0:b802fc31f1db | 679 | FSMDEBUG(LOG_INFO, ("%s terminated by peer\n", PROTO_NAME(f))); |
| donatien | 0:b802fc31f1db | 680 | } |
| donatien | 0:b802fc31f1db | 681 | if (f->callbacks->down) { |
| donatien | 0:b802fc31f1db | 682 | (*f->callbacks->down)(f); /* Inform upper layers */ |
| donatien | 0:b802fc31f1db | 683 | } |
| donatien | 0:b802fc31f1db | 684 | f->retransmits = 0; |
| donatien | 0:b802fc31f1db | 685 | f->state = LS_STOPPING; |
| donatien | 0:b802fc31f1db | 686 | TIMEOUT(fsm_timeout, f, f->timeouttime); |
| donatien | 0:b802fc31f1db | 687 | break; |
| donatien | 0:b802fc31f1db | 688 | } |
| donatien | 0:b802fc31f1db | 689 | |
| donatien | 0:b802fc31f1db | 690 | fsm_sdata(f, TERMACK, (u_char)id, NULL, 0); |
| donatien | 0:b802fc31f1db | 691 | } |
| donatien | 0:b802fc31f1db | 692 | |
| donatien | 0:b802fc31f1db | 693 | |
| donatien | 0:b802fc31f1db | 694 | /* |
| donatien | 0:b802fc31f1db | 695 | * fsm_rtermack - Receive Terminate-Ack. |
| donatien | 0:b802fc31f1db | 696 | */ |
| donatien | 0:b802fc31f1db | 697 | static void |
| donatien | 0:b802fc31f1db | 698 | fsm_rtermack(fsm *f) |
| donatien | 0:b802fc31f1db | 699 | { |
| donatien | 0:b802fc31f1db | 700 | FSMDEBUG(LOG_INFO, ("fsm_rtermack(%s): state=%d (%s)\n", |
| donatien | 0:b802fc31f1db | 701 | PROTO_NAME(f), f->state, ppperr_strerr[f->state])); |
| donatien | 0:b802fc31f1db | 702 | |
| donatien | 0:b802fc31f1db | 703 | switch (f->state) { |
| donatien | 0:b802fc31f1db | 704 | case LS_CLOSING: |
| donatien | 0:b802fc31f1db | 705 | UNTIMEOUT(fsm_timeout, f); |
| donatien | 0:b802fc31f1db | 706 | f->state = LS_CLOSED; |
| donatien | 0:b802fc31f1db | 707 | if( f->callbacks->finished ) { |
| donatien | 0:b802fc31f1db | 708 | (*f->callbacks->finished)(f); |
| donatien | 0:b802fc31f1db | 709 | } |
| donatien | 0:b802fc31f1db | 710 | break; |
| donatien | 0:b802fc31f1db | 711 | |
| donatien | 0:b802fc31f1db | 712 | case LS_STOPPING: |
| donatien | 0:b802fc31f1db | 713 | UNTIMEOUT(fsm_timeout, f); |
| donatien | 0:b802fc31f1db | 714 | f->state = LS_STOPPED; |
| donatien | 0:b802fc31f1db | 715 | if( f->callbacks->finished ) { |
| donatien | 0:b802fc31f1db | 716 | (*f->callbacks->finished)(f); |
| donatien | 0:b802fc31f1db | 717 | } |
| donatien | 0:b802fc31f1db | 718 | break; |
| donatien | 0:b802fc31f1db | 719 | |
| donatien | 0:b802fc31f1db | 720 | case LS_ACKRCVD: |
| donatien | 0:b802fc31f1db | 721 | f->state = LS_REQSENT; |
| donatien | 0:b802fc31f1db | 722 | break; |
| donatien | 0:b802fc31f1db | 723 | |
| donatien | 0:b802fc31f1db | 724 | case LS_OPENED: |
| donatien | 0:b802fc31f1db | 725 | if (f->callbacks->down) { |
| donatien | 0:b802fc31f1db | 726 | (*f->callbacks->down)(f); /* Inform upper layers */ |
| donatien | 0:b802fc31f1db | 727 | } |
| donatien | 0:b802fc31f1db | 728 | fsm_sconfreq(f, 0); |
| donatien | 0:b802fc31f1db | 729 | break; |
| donatien | 0:b802fc31f1db | 730 | default: |
| donatien | 0:b802fc31f1db | 731 | FSMDEBUG(LOG_INFO, ("fsm_rtermack(%s): UNHANDLED state=%d (%s)!!!\n", |
| donatien | 0:b802fc31f1db | 732 | PROTO_NAME(f), f->state, ppperr_strerr[f->state])); |
| donatien | 0:b802fc31f1db | 733 | } |
| donatien | 0:b802fc31f1db | 734 | } |
| donatien | 0:b802fc31f1db | 735 | |
| donatien | 0:b802fc31f1db | 736 | |
| donatien | 0:b802fc31f1db | 737 | /* |
| donatien | 0:b802fc31f1db | 738 | * fsm_rcoderej - Receive an Code-Reject. |
| donatien | 0:b802fc31f1db | 739 | */ |
| donatien | 0:b802fc31f1db | 740 | static void |
| donatien | 0:b802fc31f1db | 741 | fsm_rcoderej(fsm *f, u_char *inp, int len) |
| donatien | 0:b802fc31f1db | 742 | { |
| donatien | 0:b802fc31f1db | 743 | u_char code, id; |
| donatien | 0:b802fc31f1db | 744 | |
| donatien | 0:b802fc31f1db | 745 | FSMDEBUG(LOG_INFO, ("fsm_rcoderej(%s): state=%d (%s)\n", |
| donatien | 0:b802fc31f1db | 746 | PROTO_NAME(f), f->state, ppperr_strerr[f->state])); |
| donatien | 0:b802fc31f1db | 747 | |
| donatien | 0:b802fc31f1db | 748 | if (len < HEADERLEN) { |
| donatien | 0:b802fc31f1db | 749 | FSMDEBUG(LOG_INFO, ("fsm_rcoderej: Rcvd short Code-Reject packet!\n")); |
| donatien | 0:b802fc31f1db | 750 | return; |
| donatien | 0:b802fc31f1db | 751 | } |
| donatien | 0:b802fc31f1db | 752 | GETCHAR(code, inp); |
| donatien | 0:b802fc31f1db | 753 | GETCHAR(id, inp); |
| donatien | 0:b802fc31f1db | 754 | FSMDEBUG(LOG_WARNING, ("%s: Rcvd Code-Reject for code %d, id %d\n", |
| donatien | 0:b802fc31f1db | 755 | PROTO_NAME(f), code, id)); |
| donatien | 0:b802fc31f1db | 756 | |
| donatien | 0:b802fc31f1db | 757 | if( f->state == LS_ACKRCVD ) { |
| donatien | 0:b802fc31f1db | 758 | f->state = LS_REQSENT; |
| donatien | 0:b802fc31f1db | 759 | } |
| donatien | 0:b802fc31f1db | 760 | } |
| donatien | 0:b802fc31f1db | 761 | |
| donatien | 0:b802fc31f1db | 762 | |
| donatien | 0:b802fc31f1db | 763 | /* |
| donatien | 0:b802fc31f1db | 764 | * fsm_protreject - Peer doesn't speak this protocol. |
| donatien | 0:b802fc31f1db | 765 | * |
| donatien | 0:b802fc31f1db | 766 | * Treat this as a catastrophic error (RXJ-). |
| donatien | 0:b802fc31f1db | 767 | */ |
| donatien | 0:b802fc31f1db | 768 | void |
| donatien | 0:b802fc31f1db | 769 | fsm_protreject(fsm *f) |
| donatien | 0:b802fc31f1db | 770 | { |
| donatien | 0:b802fc31f1db | 771 | switch( f->state ) { |
| donatien | 0:b802fc31f1db | 772 | case LS_CLOSING: |
| donatien | 0:b802fc31f1db | 773 | UNTIMEOUT(fsm_timeout, f); /* Cancel timeout */ |
| donatien | 0:b802fc31f1db | 774 | /* fall through */ |
| donatien | 0:b802fc31f1db | 775 | case LS_CLOSED: |
| donatien | 0:b802fc31f1db | 776 | f->state = LS_CLOSED; |
| donatien | 0:b802fc31f1db | 777 | if( f->callbacks->finished ) { |
| donatien | 0:b802fc31f1db | 778 | (*f->callbacks->finished)(f); |
| donatien | 0:b802fc31f1db | 779 | } |
| donatien | 0:b802fc31f1db | 780 | break; |
| donatien | 0:b802fc31f1db | 781 | |
| donatien | 0:b802fc31f1db | 782 | case LS_STOPPING: |
| donatien | 0:b802fc31f1db | 783 | case LS_REQSENT: |
| donatien | 0:b802fc31f1db | 784 | case LS_ACKRCVD: |
| donatien | 0:b802fc31f1db | 785 | case LS_ACKSENT: |
| donatien | 0:b802fc31f1db | 786 | UNTIMEOUT(fsm_timeout, f); /* Cancel timeout */ |
| donatien | 0:b802fc31f1db | 787 | /* fall through */ |
| donatien | 0:b802fc31f1db | 788 | case LS_STOPPED: |
| donatien | 0:b802fc31f1db | 789 | f->state = LS_STOPPED; |
| donatien | 0:b802fc31f1db | 790 | if( f->callbacks->finished ) { |
| donatien | 0:b802fc31f1db | 791 | (*f->callbacks->finished)(f); |
| donatien | 0:b802fc31f1db | 792 | } |
| donatien | 0:b802fc31f1db | 793 | break; |
| donatien | 0:b802fc31f1db | 794 | |
| donatien | 0:b802fc31f1db | 795 | case LS_OPENED: |
| donatien | 0:b802fc31f1db | 796 | if( f->callbacks->down ) { |
| donatien | 0:b802fc31f1db | 797 | (*f->callbacks->down)(f); |
| donatien | 0:b802fc31f1db | 798 | } |
| donatien | 0:b802fc31f1db | 799 | /* Init restart counter, send Terminate-Request */ |
| donatien | 0:b802fc31f1db | 800 | f->retransmits = f->maxtermtransmits; |
| donatien | 0:b802fc31f1db | 801 | fsm_sdata(f, TERMREQ, f->reqid = ++f->id, |
| donatien | 0:b802fc31f1db | 802 | (u_char *) f->term_reason, f->term_reason_len); |
| donatien | 0:b802fc31f1db | 803 | TIMEOUT(fsm_timeout, f, f->timeouttime); |
| donatien | 0:b802fc31f1db | 804 | --f->retransmits; |
| donatien | 0:b802fc31f1db | 805 | |
| donatien | 0:b802fc31f1db | 806 | f->state = LS_STOPPING; |
| donatien | 0:b802fc31f1db | 807 | break; |
| donatien | 0:b802fc31f1db | 808 | |
| donatien | 0:b802fc31f1db | 809 | default: |
| donatien | 0:b802fc31f1db | 810 | FSMDEBUG(LOG_INFO, ("%s: Protocol-reject event in state %d (%s)!\n", |
| donatien | 0:b802fc31f1db | 811 | PROTO_NAME(f), f->state, ppperr_strerr[f->state])); |
| donatien | 0:b802fc31f1db | 812 | } |
| donatien | 0:b802fc31f1db | 813 | } |
| donatien | 0:b802fc31f1db | 814 | |
| donatien | 0:b802fc31f1db | 815 | |
| donatien | 0:b802fc31f1db | 816 | /* |
| donatien | 0:b802fc31f1db | 817 | * fsm_sconfreq - Send a Configure-Request. |
| donatien | 0:b802fc31f1db | 818 | */ |
| donatien | 0:b802fc31f1db | 819 | static void |
| donatien | 0:b802fc31f1db | 820 | fsm_sconfreq(fsm *f, int retransmit) |
| donatien | 0:b802fc31f1db | 821 | { |
| donatien | 0:b802fc31f1db | 822 | u_char *outp; |
| donatien | 0:b802fc31f1db | 823 | int cilen; |
| donatien | 0:b802fc31f1db | 824 | |
| donatien | 0:b802fc31f1db | 825 | if( f->state != LS_REQSENT && f->state != LS_ACKRCVD && f->state != LS_ACKSENT ) { |
| donatien | 0:b802fc31f1db | 826 | /* Not currently negotiating - reset options */ |
| donatien | 0:b802fc31f1db | 827 | if( f->callbacks->resetci ) { |
| donatien | 0:b802fc31f1db | 828 | (*f->callbacks->resetci)(f); |
| donatien | 0:b802fc31f1db | 829 | } |
| donatien | 0:b802fc31f1db | 830 | f->nakloops = 0; |
| donatien | 0:b802fc31f1db | 831 | } |
| donatien | 0:b802fc31f1db | 832 | |
| donatien | 0:b802fc31f1db | 833 | if( !retransmit ) { |
| donatien | 0:b802fc31f1db | 834 | /* New request - reset retransmission counter, use new ID */ |
| donatien | 0:b802fc31f1db | 835 | f->retransmits = f->maxconfreqtransmits; |
| donatien | 0:b802fc31f1db | 836 | f->reqid = ++f->id; |
| donatien | 0:b802fc31f1db | 837 | } |
| donatien | 0:b802fc31f1db | 838 | |
| donatien | 0:b802fc31f1db | 839 | f->seen_ack = 0; |
| donatien | 0:b802fc31f1db | 840 | |
| donatien | 0:b802fc31f1db | 841 | /* |
| donatien | 0:b802fc31f1db | 842 | * Make up the request packet |
| donatien | 0:b802fc31f1db | 843 | */ |
| donatien | 0:b802fc31f1db | 844 | outp = outpacket_buf[f->unit] + PPP_HDRLEN + HEADERLEN; |
| donatien | 0:b802fc31f1db | 845 | if( f->callbacks->cilen && f->callbacks->addci ) { |
| donatien | 0:b802fc31f1db | 846 | cilen = (*f->callbacks->cilen)(f); |
| donatien | 0:b802fc31f1db | 847 | if( cilen > peer_mru[f->unit] - (int)HEADERLEN ) { |
| donatien | 0:b802fc31f1db | 848 | cilen = peer_mru[f->unit] - HEADERLEN; |
| donatien | 0:b802fc31f1db | 849 | } |
| donatien | 0:b802fc31f1db | 850 | if (f->callbacks->addci) { |
| donatien | 0:b802fc31f1db | 851 | (*f->callbacks->addci)(f, outp, &cilen); |
| donatien | 0:b802fc31f1db | 852 | } |
| donatien | 0:b802fc31f1db | 853 | } else { |
| donatien | 0:b802fc31f1db | 854 | cilen = 0; |
| donatien | 0:b802fc31f1db | 855 | } |
| donatien | 0:b802fc31f1db | 856 | |
| donatien | 0:b802fc31f1db | 857 | /* send the request to our peer */ |
| donatien | 0:b802fc31f1db | 858 | fsm_sdata(f, CONFREQ, f->reqid, outp, cilen); |
| donatien | 0:b802fc31f1db | 859 | |
| donatien | 0:b802fc31f1db | 860 | /* start the retransmit timer */ |
| donatien | 0:b802fc31f1db | 861 | --f->retransmits; |
| donatien | 0:b802fc31f1db | 862 | TIMEOUT(fsm_timeout, f, f->timeouttime); |
| donatien | 0:b802fc31f1db | 863 | |
| donatien | 0:b802fc31f1db | 864 | FSMDEBUG(LOG_INFO, ("%s: sending Configure-Request, id %d\n", |
| donatien | 0:b802fc31f1db | 865 | PROTO_NAME(f), f->reqid)); |
| donatien | 0:b802fc31f1db | 866 | } |
| donatien | 0:b802fc31f1db | 867 | |
| donatien | 0:b802fc31f1db | 868 | |
| donatien | 0:b802fc31f1db | 869 | /* |
| donatien | 0:b802fc31f1db | 870 | * fsm_sdata - Send some data. |
| donatien | 0:b802fc31f1db | 871 | * |
| donatien | 0:b802fc31f1db | 872 | * Used for all packets sent to our peer by this module. |
| donatien | 0:b802fc31f1db | 873 | */ |
| donatien | 0:b802fc31f1db | 874 | void |
| donatien | 0:b802fc31f1db | 875 | fsm_sdata( fsm *f, u_char code, u_char id, u_char *data, int datalen) |
| donatien | 0:b802fc31f1db | 876 | { |
| donatien | 0:b802fc31f1db | 877 | u_char *outp; |
| donatien | 0:b802fc31f1db | 878 | int outlen; |
| donatien | 0:b802fc31f1db | 879 | |
| donatien | 0:b802fc31f1db | 880 | /* Adjust length to be smaller than MTU */ |
| donatien | 0:b802fc31f1db | 881 | outp = outpacket_buf[f->unit]; |
| donatien | 0:b802fc31f1db | 882 | if (datalen > peer_mru[f->unit] - (int)HEADERLEN) { |
| donatien | 0:b802fc31f1db | 883 | datalen = peer_mru[f->unit] - HEADERLEN; |
| donatien | 0:b802fc31f1db | 884 | } |
| donatien | 0:b802fc31f1db | 885 | if (datalen && data != outp + PPP_HDRLEN + HEADERLEN) { |
| donatien | 0:b802fc31f1db | 886 | BCOPY(data, outp + PPP_HDRLEN + HEADERLEN, datalen); |
| donatien | 0:b802fc31f1db | 887 | } |
| donatien | 0:b802fc31f1db | 888 | outlen = datalen + HEADERLEN; |
| donatien | 0:b802fc31f1db | 889 | MAKEHEADER(outp, f->protocol); |
| donatien | 0:b802fc31f1db | 890 | PUTCHAR(code, outp); |
| donatien | 0:b802fc31f1db | 891 | PUTCHAR(id, outp); |
| donatien | 0:b802fc31f1db | 892 | PUTSHORT(outlen, outp); |
| donatien | 0:b802fc31f1db | 893 | pppWrite(f->unit, outpacket_buf[f->unit], outlen + PPP_HDRLEN); |
| donatien | 0:b802fc31f1db | 894 | FSMDEBUG(LOG_INFO, ("fsm_sdata(%s): Sent code %d,%d,%d.\n", |
| donatien | 0:b802fc31f1db | 895 | PROTO_NAME(f), code, id, outlen)); |
| donatien | 0:b802fc31f1db | 896 | } |
| donatien | 0:b802fc31f1db | 897 | |
| donatien | 0:b802fc31f1db | 898 | #endif /* PPP_SUPPORT */ |