11ae349f5Scvs2svn /* 21ae349f5Scvs2svn * PPP Finite State Machine for LCP/IPCP 31ae349f5Scvs2svn * 41ae349f5Scvs2svn * Written by Toshiharu OHNO (tony-o@iij.ad.jp) 51ae349f5Scvs2svn * 61ae349f5Scvs2svn * Copyright (C) 1993, Internet Initiative Japan, Inc. All rights reserverd. 71ae349f5Scvs2svn * 81ae349f5Scvs2svn * Redistribution and use in source and binary forms are permitted 91ae349f5Scvs2svn * provided that the above copyright notice and this paragraph are 101ae349f5Scvs2svn * duplicated in all such forms and that any documentation, 111ae349f5Scvs2svn * advertising materials, and other materials related to such 121ae349f5Scvs2svn * distribution and use acknowledge that the software was developed 131ae349f5Scvs2svn * by the Internet Initiative Japan, Inc. The name of the 141ae349f5Scvs2svn * IIJ may not be used to endorse or promote products derived 151ae349f5Scvs2svn * from this software without specific prior written permission. 161ae349f5Scvs2svn * THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR 171ae349f5Scvs2svn * IMPLIED WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED 181ae349f5Scvs2svn * WARRANTIES OF MERCHANTIBILITY AND FITNESS FOR A PARTICULAR PURPOSE. 191ae349f5Scvs2svn * 201ae349f5Scvs2svn * $Id: fsm.c,v 1.26 1998/01/10 01:55:09 brian Exp $ 211ae349f5Scvs2svn * 221ae349f5Scvs2svn * TODO: 231ae349f5Scvs2svn * o Refer loglevel for log output 241ae349f5Scvs2svn * o Better option log display 251ae349f5Scvs2svn */ 261ae349f5Scvs2svn #include <sys/param.h> 271ae349f5Scvs2svn #include <netinet/in.h> 281ae349f5Scvs2svn 291ae349f5Scvs2svn #include <stdio.h> 301ae349f5Scvs2svn #include <string.h> 311ae349f5Scvs2svn #include <termios.h> 321ae349f5Scvs2svn 331ae349f5Scvs2svn #include "command.h" 341ae349f5Scvs2svn #include "mbuf.h" 351ae349f5Scvs2svn #include "log.h" 361ae349f5Scvs2svn #include "defs.h" 371ae349f5Scvs2svn #include "timer.h" 381ae349f5Scvs2svn #include "fsm.h" 391ae349f5Scvs2svn #include "hdlc.h" 401ae349f5Scvs2svn #include "lqr.h" 411ae349f5Scvs2svn #include "lcpproto.h" 421ae349f5Scvs2svn #include "lcp.h" 431ae349f5Scvs2svn #include "ccp.h" 441ae349f5Scvs2svn #include "modem.h" 451ae349f5Scvs2svn #include "loadalias.h" 461ae349f5Scvs2svn #include "vars.h" 471ae349f5Scvs2svn 481ae349f5Scvs2svn u_char AckBuff[200]; 491ae349f5Scvs2svn u_char NakBuff[200]; 501ae349f5Scvs2svn u_char RejBuff[100]; 511ae349f5Scvs2svn u_char ReqBuff[200]; 521ae349f5Scvs2svn u_char *ackp = NULL; 531ae349f5Scvs2svn u_char *nakp = NULL; 541ae349f5Scvs2svn u_char *rejp = NULL; 551ae349f5Scvs2svn 561ae349f5Scvs2svn static void FsmSendConfigReq(struct fsm *); 571ae349f5Scvs2svn static void FsmSendTerminateReq(struct fsm *); 581ae349f5Scvs2svn static void FsmInitRestartCounter(struct fsm *); 591ae349f5Scvs2svn 601ae349f5Scvs2svn char const *StateNames[] = { 611ae349f5Scvs2svn "Initial", "Starting", "Closed", "Stopped", "Closing", "Stopping", 621ae349f5Scvs2svn "Req-Sent", "Ack-Rcvd", "Ack-Sent", "Opened", 631ae349f5Scvs2svn }; 641ae349f5Scvs2svn 651ae349f5Scvs2svn static void 661ae349f5Scvs2svn StoppedTimeout(void *v) 671ae349f5Scvs2svn { 681ae349f5Scvs2svn struct fsm *fp = (struct fsm *)v; 691ae349f5Scvs2svn 701ae349f5Scvs2svn LogPrintf(fp->LogLevel, "Stopped timer expired\n"); 711ae349f5Scvs2svn if (fp->OpenTimer.state == TIMER_RUNNING) { 721ae349f5Scvs2svn LogPrintf(LogWARN, "%s: aborting open delay due to stopped timer\n", 731ae349f5Scvs2svn fp->name); 741ae349f5Scvs2svn StopTimer(&fp->OpenTimer); 751ae349f5Scvs2svn } 761ae349f5Scvs2svn if (modem != -1) 771ae349f5Scvs2svn DownConnection(); 781ae349f5Scvs2svn else 791ae349f5Scvs2svn FsmDown(fp); 801ae349f5Scvs2svn } 811ae349f5Scvs2svn 821ae349f5Scvs2svn void 831ae349f5Scvs2svn FsmInit(struct fsm * fp) 841ae349f5Scvs2svn { 851ae349f5Scvs2svn LogPrintf(LogDEBUG, "FsmInit\n"); 861ae349f5Scvs2svn fp->state = ST_INITIAL; 871ae349f5Scvs2svn fp->reqid = 1; 881ae349f5Scvs2svn fp->restart = 1; 891ae349f5Scvs2svn fp->maxconfig = 3; 901ae349f5Scvs2svn } 911ae349f5Scvs2svn 921ae349f5Scvs2svn static void 931ae349f5Scvs2svn NewState(struct fsm * fp, int new) 941ae349f5Scvs2svn { 951ae349f5Scvs2svn LogPrintf(fp->LogLevel, "State change %s --> %s\n", 961ae349f5Scvs2svn StateNames[fp->state], StateNames[new]); 971ae349f5Scvs2svn if (fp->state == ST_STOPPED && fp->StoppedTimer.state == TIMER_RUNNING) 981ae349f5Scvs2svn StopTimer(&fp->StoppedTimer); 991ae349f5Scvs2svn fp->state = new; 1001ae349f5Scvs2svn if ((new >= ST_INITIAL && new <= ST_STOPPED) || (new == ST_OPENED)) { 1011ae349f5Scvs2svn StopTimer(&fp->FsmTimer); 1021ae349f5Scvs2svn if (new == ST_STOPPED && fp->StoppedTimer.load) { 1031ae349f5Scvs2svn fp->StoppedTimer.state = TIMER_STOPPED; 1041ae349f5Scvs2svn fp->StoppedTimer.func = StoppedTimeout; 1051ae349f5Scvs2svn fp->StoppedTimer.arg = (void *) fp; 1061ae349f5Scvs2svn StartTimer(&fp->StoppedTimer); 1071ae349f5Scvs2svn } 1081ae349f5Scvs2svn } 1091ae349f5Scvs2svn } 1101ae349f5Scvs2svn 1111ae349f5Scvs2svn void 1121ae349f5Scvs2svn FsmOutput(struct fsm * fp, u_int code, u_int id, u_char * ptr, int count) 1131ae349f5Scvs2svn { 1141ae349f5Scvs2svn int plen; 1151ae349f5Scvs2svn struct fsmheader lh; 1161ae349f5Scvs2svn struct mbuf *bp; 1171ae349f5Scvs2svn 1181ae349f5Scvs2svn plen = sizeof(struct fsmheader) + count; 1191ae349f5Scvs2svn lh.code = code; 1201ae349f5Scvs2svn lh.id = id; 1211ae349f5Scvs2svn lh.length = htons(plen); 1221ae349f5Scvs2svn bp = mballoc(plen, MB_FSM); 1231ae349f5Scvs2svn memcpy(MBUF_CTOP(bp), &lh, sizeof(struct fsmheader)); 1241ae349f5Scvs2svn if (count) 1251ae349f5Scvs2svn memcpy(MBUF_CTOP(bp) + sizeof(struct fsmheader), ptr, count); 1261ae349f5Scvs2svn LogDumpBp(LogDEBUG, "FsmOutput", bp); 1271ae349f5Scvs2svn HdlcOutput(PRI_LINK, fp->proto, bp); 1281ae349f5Scvs2svn } 1291ae349f5Scvs2svn 1301ae349f5Scvs2svn static void 1311ae349f5Scvs2svn FsmOpenNow(void *v) 1321ae349f5Scvs2svn { 1331ae349f5Scvs2svn struct fsm *fp = (struct fsm *)v; 1341ae349f5Scvs2svn 1351ae349f5Scvs2svn StopTimer(&fp->OpenTimer); 1361ae349f5Scvs2svn if (fp->state <= ST_STOPPED) { 1371ae349f5Scvs2svn FsmInitRestartCounter(fp); 1381ae349f5Scvs2svn FsmSendConfigReq(fp); 1391ae349f5Scvs2svn NewState(fp, ST_REQSENT); 1401ae349f5Scvs2svn } 1411ae349f5Scvs2svn } 1421ae349f5Scvs2svn 1431ae349f5Scvs2svn void 1441ae349f5Scvs2svn FsmOpen(struct fsm * fp) 1451ae349f5Scvs2svn { 1461ae349f5Scvs2svn switch (fp->state) { 1471ae349f5Scvs2svn case ST_INITIAL: 1481ae349f5Scvs2svn (fp->LayerStart) (fp); 1491ae349f5Scvs2svn NewState(fp, ST_STARTING); 1501ae349f5Scvs2svn break; 1511ae349f5Scvs2svn case ST_STARTING: 1521ae349f5Scvs2svn break; 1531ae349f5Scvs2svn case ST_CLOSED: 1541ae349f5Scvs2svn if (fp->open_mode == OPEN_PASSIVE) { 1551ae349f5Scvs2svn NewState(fp, ST_STOPPED); 1561ae349f5Scvs2svn } else if (fp->open_mode > 0) { 1571ae349f5Scvs2svn if (fp->open_mode > 1) 1581ae349f5Scvs2svn LogPrintf(LogPHASE, "Entering STOPPED state for %d seconds\n", 1591ae349f5Scvs2svn fp->open_mode); 1601ae349f5Scvs2svn NewState(fp, ST_STOPPED); 1611ae349f5Scvs2svn fp->OpenTimer.state = TIMER_STOPPED; 1621ae349f5Scvs2svn fp->OpenTimer.load = fp->open_mode * SECTICKS; 1631ae349f5Scvs2svn fp->OpenTimer.func = FsmOpenNow; 1641ae349f5Scvs2svn fp->OpenTimer.arg = (void *)fp; 1651ae349f5Scvs2svn StartTimer(&fp->OpenTimer); 1661ae349f5Scvs2svn } else 1671ae349f5Scvs2svn FsmOpenNow(fp); 1681ae349f5Scvs2svn break; 1691ae349f5Scvs2svn case ST_STOPPED: /* XXX: restart option */ 1701ae349f5Scvs2svn case ST_REQSENT: 1711ae349f5Scvs2svn case ST_ACKRCVD: 1721ae349f5Scvs2svn case ST_ACKSENT: 1731ae349f5Scvs2svn case ST_OPENED: /* XXX: restart option */ 1741ae349f5Scvs2svn break; 1751ae349f5Scvs2svn case ST_CLOSING: /* XXX: restart option */ 1761ae349f5Scvs2svn case ST_STOPPING: /* XXX: restart option */ 1771ae349f5Scvs2svn NewState(fp, ST_STOPPING); 1781ae349f5Scvs2svn break; 1791ae349f5Scvs2svn } 1801ae349f5Scvs2svn } 1811ae349f5Scvs2svn 1821ae349f5Scvs2svn void 1831ae349f5Scvs2svn FsmUp(struct fsm * fp) 1841ae349f5Scvs2svn { 1851ae349f5Scvs2svn switch (fp->state) { 1861ae349f5Scvs2svn case ST_INITIAL: 1871ae349f5Scvs2svn NewState(fp, ST_CLOSED); 1881ae349f5Scvs2svn break; 1891ae349f5Scvs2svn case ST_STARTING: 1901ae349f5Scvs2svn FsmInitRestartCounter(fp); 1911ae349f5Scvs2svn FsmSendConfigReq(fp); 1921ae349f5Scvs2svn NewState(fp, ST_REQSENT); 1931ae349f5Scvs2svn break; 1941ae349f5Scvs2svn default: 1951ae349f5Scvs2svn LogPrintf(fp->LogLevel, "Oops, Up at %s\n", StateNames[fp->state]); 1961ae349f5Scvs2svn break; 1971ae349f5Scvs2svn } 1981ae349f5Scvs2svn } 1991ae349f5Scvs2svn 2001ae349f5Scvs2svn void 2011ae349f5Scvs2svn FsmDown(struct fsm * fp) 2021ae349f5Scvs2svn { 2031ae349f5Scvs2svn switch (fp->state) { 2041ae349f5Scvs2svn case ST_CLOSED: 2051ae349f5Scvs2svn case ST_CLOSING: 2061ae349f5Scvs2svn NewState(fp, ST_INITIAL); 2071ae349f5Scvs2svn break; 2081ae349f5Scvs2svn case ST_STOPPED: 2091ae349f5Scvs2svn (fp->LayerStart) (fp); 2101ae349f5Scvs2svn /* Fall into.. */ 2111ae349f5Scvs2svn case ST_STOPPING: 2121ae349f5Scvs2svn case ST_REQSENT: 2131ae349f5Scvs2svn case ST_ACKRCVD: 2141ae349f5Scvs2svn case ST_ACKSENT: 2151ae349f5Scvs2svn NewState(fp, ST_STARTING); 2161ae349f5Scvs2svn break; 2171ae349f5Scvs2svn case ST_OPENED: 2181ae349f5Scvs2svn (fp->LayerDown) (fp); 2191ae349f5Scvs2svn NewState(fp, ST_STARTING); 2201ae349f5Scvs2svn break; 2211ae349f5Scvs2svn } 2221ae349f5Scvs2svn } 2231ae349f5Scvs2svn 2241ae349f5Scvs2svn void 2251ae349f5Scvs2svn FsmClose(struct fsm * fp) 2261ae349f5Scvs2svn { 2271ae349f5Scvs2svn switch (fp->state) { 2281ae349f5Scvs2svn case ST_STARTING: 2291ae349f5Scvs2svn NewState(fp, ST_INITIAL); 2301ae349f5Scvs2svn break; 2311ae349f5Scvs2svn case ST_STOPPED: 2321ae349f5Scvs2svn NewState(fp, ST_CLOSED); 2331ae349f5Scvs2svn break; 2341ae349f5Scvs2svn case ST_STOPPING: 2351ae349f5Scvs2svn NewState(fp, ST_CLOSING); 2361ae349f5Scvs2svn break; 2371ae349f5Scvs2svn case ST_OPENED: 2381ae349f5Scvs2svn (fp->LayerDown) (fp); 2391ae349f5Scvs2svn /* Fall down */ 2401ae349f5Scvs2svn case ST_REQSENT: 2411ae349f5Scvs2svn case ST_ACKRCVD: 2421ae349f5Scvs2svn case ST_ACKSENT: 2431ae349f5Scvs2svn FsmInitRestartCounter(fp); 2441ae349f5Scvs2svn FsmSendTerminateReq(fp); 2451ae349f5Scvs2svn NewState(fp, ST_CLOSING); 2461ae349f5Scvs2svn break; 2471ae349f5Scvs2svn } 2481ae349f5Scvs2svn } 2491ae349f5Scvs2svn 2501ae349f5Scvs2svn /* 2511ae349f5Scvs2svn * Send functions 2521ae349f5Scvs2svn */ 2531ae349f5Scvs2svn static void 2541ae349f5Scvs2svn FsmSendConfigReq(struct fsm * fp) 2551ae349f5Scvs2svn { 2561ae349f5Scvs2svn if (--fp->maxconfig > 0) { 2571ae349f5Scvs2svn (fp->SendConfigReq) (fp); 2581ae349f5Scvs2svn StartTimer(&fp->FsmTimer); /* Start restart timer */ 2591ae349f5Scvs2svn fp->restart--; /* Decrement restart counter */ 2601ae349f5Scvs2svn } else { 2611ae349f5Scvs2svn FsmClose(fp); 2621ae349f5Scvs2svn } 2631ae349f5Scvs2svn } 2641ae349f5Scvs2svn 2651ae349f5Scvs2svn static void 2661ae349f5Scvs2svn FsmSendTerminateReq(struct fsm * fp) 2671ae349f5Scvs2svn { 2681ae349f5Scvs2svn LogPrintf(fp->LogLevel, "SendTerminateReq.\n"); 2691ae349f5Scvs2svn FsmOutput(fp, CODE_TERMREQ, fp->reqid++, NULL, 0); 2701ae349f5Scvs2svn (fp->SendTerminateReq) (fp); 2711ae349f5Scvs2svn StartTimer(&fp->FsmTimer); /* Start restart timer */ 2721ae349f5Scvs2svn fp->restart--; /* Decrement restart counter */ 2731ae349f5Scvs2svn } 2741ae349f5Scvs2svn 2751ae349f5Scvs2svn static void 2761ae349f5Scvs2svn FsmSendConfigAck(struct fsm * fp, 2771ae349f5Scvs2svn struct fsmheader * lhp, 2781ae349f5Scvs2svn u_char * option, 2791ae349f5Scvs2svn int count) 2801ae349f5Scvs2svn { 2811ae349f5Scvs2svn LogPrintf(fp->LogLevel, "SendConfigAck(%s)\n", StateNames[fp->state]); 2821ae349f5Scvs2svn (fp->DecodeConfig) (option, count, MODE_NOP); 2831ae349f5Scvs2svn FsmOutput(fp, CODE_CONFIGACK, lhp->id, option, count); 2841ae349f5Scvs2svn } 2851ae349f5Scvs2svn 2861ae349f5Scvs2svn static void 2871ae349f5Scvs2svn FsmSendConfigRej(struct fsm * fp, 2881ae349f5Scvs2svn struct fsmheader * lhp, 2891ae349f5Scvs2svn u_char * option, 2901ae349f5Scvs2svn int count) 2911ae349f5Scvs2svn { 2921ae349f5Scvs2svn LogPrintf(fp->LogLevel, "SendConfigRej(%s)\n", StateNames[fp->state]); 2931ae349f5Scvs2svn (fp->DecodeConfig) (option, count, MODE_NOP); 2941ae349f5Scvs2svn FsmOutput(fp, CODE_CONFIGREJ, lhp->id, option, count); 2951ae349f5Scvs2svn } 2961ae349f5Scvs2svn 2971ae349f5Scvs2svn static void 2981ae349f5Scvs2svn FsmSendConfigNak(struct fsm * fp, 2991ae349f5Scvs2svn struct fsmheader * lhp, 3001ae349f5Scvs2svn u_char * option, 3011ae349f5Scvs2svn int count) 3021ae349f5Scvs2svn { 3031ae349f5Scvs2svn LogPrintf(fp->LogLevel, "SendConfigNak(%s)\n", StateNames[fp->state]); 3041ae349f5Scvs2svn (fp->DecodeConfig) (option, count, MODE_NOP); 3051ae349f5Scvs2svn FsmOutput(fp, CODE_CONFIGNAK, lhp->id, option, count); 3061ae349f5Scvs2svn } 3071ae349f5Scvs2svn 3081ae349f5Scvs2svn /* 3091ae349f5Scvs2svn * Timeout actions 3101ae349f5Scvs2svn */ 3111ae349f5Scvs2svn static void 3121ae349f5Scvs2svn FsmTimeout(void *v) 3131ae349f5Scvs2svn { 3141ae349f5Scvs2svn struct fsm *fp = (struct fsm *)v; 3151ae349f5Scvs2svn 3161ae349f5Scvs2svn if (fp->restart) { 3171ae349f5Scvs2svn switch (fp->state) { 3181ae349f5Scvs2svn case ST_CLOSING: 3191ae349f5Scvs2svn case ST_STOPPING: 3201ae349f5Scvs2svn FsmSendTerminateReq(fp); 3211ae349f5Scvs2svn break; 3221ae349f5Scvs2svn case ST_REQSENT: 3231ae349f5Scvs2svn case ST_ACKSENT: 3241ae349f5Scvs2svn FsmSendConfigReq(fp); 3251ae349f5Scvs2svn break; 3261ae349f5Scvs2svn case ST_ACKRCVD: 3271ae349f5Scvs2svn FsmSendConfigReq(fp); 3281ae349f5Scvs2svn NewState(fp, ST_REQSENT); 3291ae349f5Scvs2svn break; 3301ae349f5Scvs2svn } 3311ae349f5Scvs2svn StartTimer(&fp->FsmTimer); 3321ae349f5Scvs2svn } else { 3331ae349f5Scvs2svn switch (fp->state) { 3341ae349f5Scvs2svn case ST_CLOSING: 3351ae349f5Scvs2svn NewState(fp, ST_CLOSED); 3361ae349f5Scvs2svn (fp->LayerFinish) (fp); 3371ae349f5Scvs2svn break; 3381ae349f5Scvs2svn case ST_STOPPING: 3391ae349f5Scvs2svn NewState(fp, ST_STOPPED); 3401ae349f5Scvs2svn (fp->LayerFinish) (fp); 3411ae349f5Scvs2svn break; 3421ae349f5Scvs2svn case ST_REQSENT: /* XXX: 3p */ 3431ae349f5Scvs2svn case ST_ACKSENT: 3441ae349f5Scvs2svn case ST_ACKRCVD: 3451ae349f5Scvs2svn NewState(fp, ST_STOPPED); 3461ae349f5Scvs2svn (fp->LayerFinish) (fp); 3471ae349f5Scvs2svn break; 3481ae349f5Scvs2svn } 3491ae349f5Scvs2svn } 3501ae349f5Scvs2svn } 3511ae349f5Scvs2svn 3521ae349f5Scvs2svn static void 3531ae349f5Scvs2svn FsmInitRestartCounter(struct fsm * fp) 3541ae349f5Scvs2svn { 3551ae349f5Scvs2svn StopTimer(&fp->FsmTimer); 3561ae349f5Scvs2svn fp->FsmTimer.state = TIMER_STOPPED; 3571ae349f5Scvs2svn fp->FsmTimer.func = FsmTimeout; 3581ae349f5Scvs2svn fp->FsmTimer.arg = (void *) fp; 3591ae349f5Scvs2svn (fp->InitRestartCounter) (fp); 3601ae349f5Scvs2svn } 3611ae349f5Scvs2svn 3621ae349f5Scvs2svn /* 3631ae349f5Scvs2svn * Actions when receive packets 3641ae349f5Scvs2svn */ 3651ae349f5Scvs2svn static void 3661ae349f5Scvs2svn FsmRecvConfigReq(struct fsm * fp, struct fsmheader * lhp, struct mbuf * bp) 3671ae349f5Scvs2svn /* RCR */ 3681ae349f5Scvs2svn { 3691ae349f5Scvs2svn int plen, flen; 3701ae349f5Scvs2svn int ackaction = 0; 3711ae349f5Scvs2svn 3721ae349f5Scvs2svn plen = plength(bp); 3731ae349f5Scvs2svn flen = ntohs(lhp->length) - sizeof *lhp; 3741ae349f5Scvs2svn if (plen < flen) { 3751ae349f5Scvs2svn LogPrintf(LogERROR, "FsmRecvConfigReq: plen (%d) < flen (%d)\n", 3761ae349f5Scvs2svn plen, flen); 3771ae349f5Scvs2svn pfree(bp); 3781ae349f5Scvs2svn return; 3791ae349f5Scvs2svn } 3801ae349f5Scvs2svn 3811ae349f5Scvs2svn /* 3821ae349f5Scvs2svn * Check and process easy case 3831ae349f5Scvs2svn */ 3841ae349f5Scvs2svn switch (fp->state) { 3851ae349f5Scvs2svn case ST_INITIAL: 3861ae349f5Scvs2svn case ST_STARTING: 3871ae349f5Scvs2svn LogPrintf(fp->LogLevel, "Oops, RCR in %s.\n", StateNames[fp->state]); 3881ae349f5Scvs2svn pfree(bp); 3891ae349f5Scvs2svn return; 3901ae349f5Scvs2svn case ST_CLOSED: 3911ae349f5Scvs2svn (fp->SendTerminateAck) (fp); 3921ae349f5Scvs2svn pfree(bp); 3931ae349f5Scvs2svn return; 3941ae349f5Scvs2svn case ST_CLOSING: 3951ae349f5Scvs2svn LogPrintf(fp->LogLevel, "Error: Got ConfigReq while state = %d\n", 3961ae349f5Scvs2svn fp->state); 3971ae349f5Scvs2svn case ST_STOPPING: 3981ae349f5Scvs2svn pfree(bp); 3991ae349f5Scvs2svn return; 4001ae349f5Scvs2svn } 4011ae349f5Scvs2svn 4021ae349f5Scvs2svn (fp->DecodeConfig) (MBUF_CTOP(bp), flen, MODE_REQ); 4031ae349f5Scvs2svn 4041ae349f5Scvs2svn if (nakp == NakBuff && rejp == RejBuff) 4051ae349f5Scvs2svn ackaction = 1; 4061ae349f5Scvs2svn 4071ae349f5Scvs2svn switch (fp->state) { 4081ae349f5Scvs2svn case ST_OPENED: 4091ae349f5Scvs2svn (fp->LayerDown) (fp); 4101ae349f5Scvs2svn FsmSendConfigReq(fp); 4111ae349f5Scvs2svn break; 4121ae349f5Scvs2svn case ST_STOPPED: 4131ae349f5Scvs2svn FsmInitRestartCounter(fp); 4141ae349f5Scvs2svn FsmSendConfigReq(fp); 4151ae349f5Scvs2svn break; 4161ae349f5Scvs2svn } 4171ae349f5Scvs2svn 4181ae349f5Scvs2svn if (rejp != RejBuff) 4191ae349f5Scvs2svn FsmSendConfigRej(fp, lhp, RejBuff, rejp - RejBuff); 4201ae349f5Scvs2svn if (nakp != NakBuff) 4211ae349f5Scvs2svn FsmSendConfigNak(fp, lhp, NakBuff, nakp - NakBuff); 4221ae349f5Scvs2svn if (ackaction) 4231ae349f5Scvs2svn FsmSendConfigAck(fp, lhp, AckBuff, ackp - AckBuff); 4241ae349f5Scvs2svn 4251ae349f5Scvs2svn switch (fp->state) { 4261ae349f5Scvs2svn case ST_STOPPED: 4271ae349f5Scvs2svn case ST_OPENED: 4281ae349f5Scvs2svn if (ackaction) 4291ae349f5Scvs2svn NewState(fp, ST_ACKSENT); 4301ae349f5Scvs2svn else 4311ae349f5Scvs2svn NewState(fp, ST_REQSENT); 4321ae349f5Scvs2svn break; 4331ae349f5Scvs2svn case ST_REQSENT: 4341ae349f5Scvs2svn if (ackaction) 4351ae349f5Scvs2svn NewState(fp, ST_ACKSENT); 4361ae349f5Scvs2svn break; 4371ae349f5Scvs2svn case ST_ACKRCVD: 4381ae349f5Scvs2svn if (ackaction) { 4391ae349f5Scvs2svn NewState(fp, ST_OPENED); 4401ae349f5Scvs2svn (fp->LayerUp) (fp); 4411ae349f5Scvs2svn } 4421ae349f5Scvs2svn break; 4431ae349f5Scvs2svn case ST_ACKSENT: 4441ae349f5Scvs2svn if (!ackaction) 4451ae349f5Scvs2svn NewState(fp, ST_REQSENT); 4461ae349f5Scvs2svn break; 4471ae349f5Scvs2svn } 4481ae349f5Scvs2svn pfree(bp); 4491ae349f5Scvs2svn } 4501ae349f5Scvs2svn 4511ae349f5Scvs2svn static void 4521ae349f5Scvs2svn FsmRecvConfigAck(struct fsm * fp, struct fsmheader * lhp, struct mbuf * bp) 4531ae349f5Scvs2svn /* RCA */ 4541ae349f5Scvs2svn { 4551ae349f5Scvs2svn switch (fp->state) { 4561ae349f5Scvs2svn case ST_CLOSED: 4571ae349f5Scvs2svn case ST_STOPPED: 4581ae349f5Scvs2svn (fp->SendTerminateAck) (fp); 4591ae349f5Scvs2svn break; 4601ae349f5Scvs2svn case ST_CLOSING: 4611ae349f5Scvs2svn case ST_STOPPING: 4621ae349f5Scvs2svn break; 4631ae349f5Scvs2svn case ST_REQSENT: 4641ae349f5Scvs2svn FsmInitRestartCounter(fp); 4651ae349f5Scvs2svn NewState(fp, ST_ACKRCVD); 4661ae349f5Scvs2svn break; 4671ae349f5Scvs2svn case ST_ACKRCVD: 4681ae349f5Scvs2svn FsmSendConfigReq(fp); 4691ae349f5Scvs2svn NewState(fp, ST_REQSENT); 4701ae349f5Scvs2svn break; 4711ae349f5Scvs2svn case ST_ACKSENT: 4721ae349f5Scvs2svn FsmInitRestartCounter(fp); 4731ae349f5Scvs2svn NewState(fp, ST_OPENED); 4741ae349f5Scvs2svn (fp->LayerUp) (fp); 4751ae349f5Scvs2svn break; 4761ae349f5Scvs2svn case ST_OPENED: 4771ae349f5Scvs2svn (fp->LayerDown) (fp); 4781ae349f5Scvs2svn FsmSendConfigReq(fp); 4791ae349f5Scvs2svn NewState(fp, ST_REQSENT); 4801ae349f5Scvs2svn break; 4811ae349f5Scvs2svn } 4821ae349f5Scvs2svn pfree(bp); 4831ae349f5Scvs2svn } 4841ae349f5Scvs2svn 4851ae349f5Scvs2svn static void 4861ae349f5Scvs2svn FsmRecvConfigNak(struct fsm * fp, struct fsmheader * lhp, struct mbuf * bp) 4871ae349f5Scvs2svn /* RCN */ 4881ae349f5Scvs2svn { 4891ae349f5Scvs2svn int plen, flen; 4901ae349f5Scvs2svn 4911ae349f5Scvs2svn plen = plength(bp); 4921ae349f5Scvs2svn flen = ntohs(lhp->length) - sizeof *lhp; 4931ae349f5Scvs2svn if (plen < flen) { 4941ae349f5Scvs2svn pfree(bp); 4951ae349f5Scvs2svn return; 4961ae349f5Scvs2svn } 4971ae349f5Scvs2svn 4981ae349f5Scvs2svn /* 4991ae349f5Scvs2svn * Check and process easy case 5001ae349f5Scvs2svn */ 5011ae349f5Scvs2svn switch (fp->state) { 5021ae349f5Scvs2svn case ST_INITIAL: 5031ae349f5Scvs2svn case ST_STARTING: 5041ae349f5Scvs2svn LogPrintf(fp->LogLevel, "Oops, RCN in %s.\n", StateNames[fp->state]); 5051ae349f5Scvs2svn pfree(bp); 5061ae349f5Scvs2svn return; 5071ae349f5Scvs2svn case ST_CLOSED: 5081ae349f5Scvs2svn case ST_STOPPED: 5091ae349f5Scvs2svn (fp->SendTerminateAck) (fp); 5101ae349f5Scvs2svn pfree(bp); 5111ae349f5Scvs2svn return; 5121ae349f5Scvs2svn case ST_CLOSING: 5131ae349f5Scvs2svn case ST_STOPPING: 5141ae349f5Scvs2svn pfree(bp); 5151ae349f5Scvs2svn return; 5161ae349f5Scvs2svn } 5171ae349f5Scvs2svn 5181ae349f5Scvs2svn (fp->DecodeConfig) (MBUF_CTOP(bp), flen, MODE_NAK); 5191ae349f5Scvs2svn 5201ae349f5Scvs2svn switch (fp->state) { 5211ae349f5Scvs2svn case ST_REQSENT: 5221ae349f5Scvs2svn case ST_ACKSENT: 5231ae349f5Scvs2svn FsmInitRestartCounter(fp); 5241ae349f5Scvs2svn FsmSendConfigReq(fp); 5251ae349f5Scvs2svn break; 5261ae349f5Scvs2svn case ST_OPENED: 5271ae349f5Scvs2svn (fp->LayerDown) (fp); 5281ae349f5Scvs2svn /* Fall down */ 5291ae349f5Scvs2svn case ST_ACKRCVD: 5301ae349f5Scvs2svn FsmSendConfigReq(fp); 5311ae349f5Scvs2svn NewState(fp, ST_REQSENT); 5321ae349f5Scvs2svn break; 5331ae349f5Scvs2svn } 5341ae349f5Scvs2svn 5351ae349f5Scvs2svn pfree(bp); 5361ae349f5Scvs2svn } 5371ae349f5Scvs2svn 5381ae349f5Scvs2svn static void 5391ae349f5Scvs2svn FsmRecvTermReq(struct fsm * fp, struct fsmheader * lhp, struct mbuf * bp) 5401ae349f5Scvs2svn /* RTR */ 5411ae349f5Scvs2svn { 5421ae349f5Scvs2svn switch (fp->state) { 5431ae349f5Scvs2svn case ST_INITIAL: 5441ae349f5Scvs2svn case ST_STARTING: 5451ae349f5Scvs2svn LogPrintf(fp->LogLevel, "Oops, RTR in %s\n", StateNames[fp->state]); 5461ae349f5Scvs2svn break; 5471ae349f5Scvs2svn case ST_CLOSED: 5481ae349f5Scvs2svn case ST_STOPPED: 5491ae349f5Scvs2svn case ST_CLOSING: 5501ae349f5Scvs2svn case ST_STOPPING: 5511ae349f5Scvs2svn case ST_REQSENT: 5521ae349f5Scvs2svn (fp->SendTerminateAck) (fp); 5531ae349f5Scvs2svn break; 5541ae349f5Scvs2svn case ST_ACKRCVD: 5551ae349f5Scvs2svn case ST_ACKSENT: 5561ae349f5Scvs2svn (fp->SendTerminateAck) (fp); 5571ae349f5Scvs2svn NewState(fp, ST_REQSENT); 5581ae349f5Scvs2svn break; 5591ae349f5Scvs2svn case ST_OPENED: 5601ae349f5Scvs2svn (fp->LayerDown) (fp); 5611ae349f5Scvs2svn (fp->SendTerminateAck) (fp); 5621ae349f5Scvs2svn StartTimer(&fp->FsmTimer); /* Start restart timer */ 5631ae349f5Scvs2svn fp->restart = 0; 5641ae349f5Scvs2svn NewState(fp, ST_STOPPING); 5651ae349f5Scvs2svn break; 5661ae349f5Scvs2svn } 5671ae349f5Scvs2svn pfree(bp); 5681ae349f5Scvs2svn } 5691ae349f5Scvs2svn 5701ae349f5Scvs2svn static void 5711ae349f5Scvs2svn FsmRecvTermAck(struct fsm * fp, struct fsmheader * lhp, struct mbuf * bp) 5721ae349f5Scvs2svn /* RTA */ 5731ae349f5Scvs2svn { 5741ae349f5Scvs2svn switch (fp->state) { 5751ae349f5Scvs2svn case ST_CLOSING: 5761ae349f5Scvs2svn NewState(fp, ST_CLOSED); 5771ae349f5Scvs2svn (fp->LayerFinish) (fp); 5781ae349f5Scvs2svn break; 5791ae349f5Scvs2svn case ST_STOPPING: 5801ae349f5Scvs2svn NewState(fp, ST_STOPPED); 5811ae349f5Scvs2svn (fp->LayerFinish) (fp); 5821ae349f5Scvs2svn break; 5831ae349f5Scvs2svn case ST_ACKRCVD: 5841ae349f5Scvs2svn NewState(fp, ST_REQSENT); 5851ae349f5Scvs2svn break; 5861ae349f5Scvs2svn case ST_OPENED: 5871ae349f5Scvs2svn (fp->LayerDown) (fp); 5881ae349f5Scvs2svn FsmSendConfigReq(fp); 5891ae349f5Scvs2svn NewState(fp, ST_REQSENT); 5901ae349f5Scvs2svn break; 5911ae349f5Scvs2svn } 5921ae349f5Scvs2svn pfree(bp); 5931ae349f5Scvs2svn } 5941ae349f5Scvs2svn 5951ae349f5Scvs2svn static void 5961ae349f5Scvs2svn FsmRecvConfigRej(struct fsm * fp, struct fsmheader * lhp, struct mbuf * bp) 5971ae349f5Scvs2svn /* RCJ */ 5981ae349f5Scvs2svn { 5991ae349f5Scvs2svn int plen, flen; 6001ae349f5Scvs2svn 6011ae349f5Scvs2svn plen = plength(bp); 6021ae349f5Scvs2svn flen = ntohs(lhp->length) - sizeof *lhp; 6031ae349f5Scvs2svn if (plen < flen) { 6041ae349f5Scvs2svn pfree(bp); 6051ae349f5Scvs2svn return; 6061ae349f5Scvs2svn } 6071ae349f5Scvs2svn LogPrintf(fp->LogLevel, "RecvConfigRej.\n"); 6081ae349f5Scvs2svn 6091ae349f5Scvs2svn /* 6101ae349f5Scvs2svn * Check and process easy case 6111ae349f5Scvs2svn */ 6121ae349f5Scvs2svn switch (fp->state) { 6131ae349f5Scvs2svn case ST_INITIAL: 6141ae349f5Scvs2svn case ST_STARTING: 6151ae349f5Scvs2svn LogPrintf(fp->LogLevel, "Oops, RCJ in %s.\n", StateNames[fp->state]); 6161ae349f5Scvs2svn pfree(bp); 6171ae349f5Scvs2svn return; 6181ae349f5Scvs2svn case ST_CLOSED: 6191ae349f5Scvs2svn case ST_STOPPED: 6201ae349f5Scvs2svn (fp->SendTerminateAck) (fp); 6211ae349f5Scvs2svn pfree(bp); 6221ae349f5Scvs2svn return; 6231ae349f5Scvs2svn case ST_CLOSING: 6241ae349f5Scvs2svn case ST_STOPPING: 6251ae349f5Scvs2svn pfree(bp); 6261ae349f5Scvs2svn return; 6271ae349f5Scvs2svn } 6281ae349f5Scvs2svn 6291ae349f5Scvs2svn (fp->DecodeConfig) (MBUF_CTOP(bp), flen, MODE_REJ); 6301ae349f5Scvs2svn 6311ae349f5Scvs2svn switch (fp->state) { 6321ae349f5Scvs2svn case ST_REQSENT: 6331ae349f5Scvs2svn case ST_ACKSENT: 6341ae349f5Scvs2svn FsmInitRestartCounter(fp); 6351ae349f5Scvs2svn FsmSendConfigReq(fp); 6361ae349f5Scvs2svn break; 6371ae349f5Scvs2svn case ST_OPENED: 6381ae349f5Scvs2svn (fp->LayerDown) (fp); 6391ae349f5Scvs2svn /* Fall down */ 6401ae349f5Scvs2svn case ST_ACKRCVD: 6411ae349f5Scvs2svn FsmSendConfigReq(fp); 6421ae349f5Scvs2svn NewState(fp, ST_REQSENT); 6431ae349f5Scvs2svn break; 6441ae349f5Scvs2svn } 6451ae349f5Scvs2svn pfree(bp); 6461ae349f5Scvs2svn } 6471ae349f5Scvs2svn 6481ae349f5Scvs2svn static void 6491ae349f5Scvs2svn FsmRecvCodeRej(struct fsm * fp, struct fsmheader * lhp, struct mbuf * bp) 6501ae349f5Scvs2svn { 6511ae349f5Scvs2svn LogPrintf(fp->LogLevel, "RecvCodeRej\n"); 6521ae349f5Scvs2svn pfree(bp); 6531ae349f5Scvs2svn } 6541ae349f5Scvs2svn 6551ae349f5Scvs2svn static void 6561ae349f5Scvs2svn FsmRecvProtoRej(struct fsm * fp, struct fsmheader * lhp, struct mbuf * bp) 6571ae349f5Scvs2svn { 6581ae349f5Scvs2svn u_short *sp, proto; 6591ae349f5Scvs2svn 6601ae349f5Scvs2svn sp = (u_short *) MBUF_CTOP(bp); 6611ae349f5Scvs2svn proto = ntohs(*sp); 6621ae349f5Scvs2svn LogPrintf(fp->LogLevel, "-- Protocol (%04x) was rejected.\n", proto); 6631ae349f5Scvs2svn 6641ae349f5Scvs2svn switch (proto) { 6651ae349f5Scvs2svn case PROTO_LQR: 6661ae349f5Scvs2svn StopLqr(LQM_LQR); 6671ae349f5Scvs2svn break; 6681ae349f5Scvs2svn case PROTO_CCP: 6691ae349f5Scvs2svn fp = &CcpFsm; 6701ae349f5Scvs2svn (fp->LayerFinish) (fp); 6711ae349f5Scvs2svn switch (fp->state) { 6721ae349f5Scvs2svn case ST_CLOSED: 6731ae349f5Scvs2svn case ST_CLOSING: 6741ae349f5Scvs2svn NewState(fp, ST_CLOSED); 6751ae349f5Scvs2svn default: 6761ae349f5Scvs2svn NewState(fp, ST_STOPPED); 6771ae349f5Scvs2svn break; 6781ae349f5Scvs2svn } 6791ae349f5Scvs2svn break; 6801ae349f5Scvs2svn } 6811ae349f5Scvs2svn pfree(bp); 6821ae349f5Scvs2svn } 6831ae349f5Scvs2svn 6841ae349f5Scvs2svn static void 6851ae349f5Scvs2svn FsmRecvEchoReq(struct fsm * fp, struct fsmheader * lhp, struct mbuf * bp) 6861ae349f5Scvs2svn { 6871ae349f5Scvs2svn u_char *cp; 6881ae349f5Scvs2svn u_long *lp, magic; 6891ae349f5Scvs2svn 6901ae349f5Scvs2svn cp = MBUF_CTOP(bp); 6911ae349f5Scvs2svn lp = (u_long *) cp; 6921ae349f5Scvs2svn magic = ntohl(*lp); 6931ae349f5Scvs2svn if (magic != LcpInfo.his_magic) { 6941ae349f5Scvs2svn LogPrintf(LogERROR, "RecvEchoReq: his magic is bad!!\n"); 6951ae349f5Scvs2svn /* XXX: We should send terminate request */ 6961ae349f5Scvs2svn } 6971ae349f5Scvs2svn if (fp->state == ST_OPENED) { 6981ae349f5Scvs2svn *lp = htonl(LcpInfo.want_magic); /* Insert local magic number */ 6991ae349f5Scvs2svn LogPrintf(fp->LogLevel, "SendEchoRep(%s)\n", StateNames[fp->state]); 7001ae349f5Scvs2svn FsmOutput(fp, CODE_ECHOREP, lhp->id, cp, plength(bp)); 7011ae349f5Scvs2svn } 7021ae349f5Scvs2svn pfree(bp); 7031ae349f5Scvs2svn } 7041ae349f5Scvs2svn 7051ae349f5Scvs2svn static void 7061ae349f5Scvs2svn FsmRecvEchoRep(struct fsm * fp, struct fsmheader * lhp, struct mbuf * bp) 7071ae349f5Scvs2svn { 7081ae349f5Scvs2svn u_long *lp, magic; 7091ae349f5Scvs2svn 7101ae349f5Scvs2svn lp = (u_long *) MBUF_CTOP(bp); 7111ae349f5Scvs2svn magic = ntohl(*lp); 7121ae349f5Scvs2svn /* 7131ae349f5Scvs2svn * Tolerate echo replies with either magic number 7141ae349f5Scvs2svn */ 7151ae349f5Scvs2svn if (magic != 0 && magic != LcpInfo.his_magic && magic != LcpInfo.want_magic) { 7161ae349f5Scvs2svn LogPrintf(LogERROR, "RecvEchoRep: his magic is wrong! expect: %x got: %x\n", 7171ae349f5Scvs2svn LcpInfo.his_magic, magic); 7181ae349f5Scvs2svn 7191ae349f5Scvs2svn /* 7201ae349f5Scvs2svn * XXX: We should send terminate request. But poor implementation may die 7211ae349f5Scvs2svn * as a result. 7221ae349f5Scvs2svn */ 7231ae349f5Scvs2svn } 7241ae349f5Scvs2svn RecvEchoLqr(bp); 7251ae349f5Scvs2svn pfree(bp); 7261ae349f5Scvs2svn } 7271ae349f5Scvs2svn 7281ae349f5Scvs2svn static void 7291ae349f5Scvs2svn FsmRecvDiscReq(struct fsm * fp, struct fsmheader * lhp, struct mbuf * bp) 7301ae349f5Scvs2svn { 7311ae349f5Scvs2svn LogPrintf(fp->LogLevel, "RecvDiscReq\n"); 7321ae349f5Scvs2svn pfree(bp); 7331ae349f5Scvs2svn } 7341ae349f5Scvs2svn 7351ae349f5Scvs2svn static void 7361ae349f5Scvs2svn FsmRecvIdent(struct fsm * fp, struct fsmheader * lhp, struct mbuf * bp) 7371ae349f5Scvs2svn { 7381ae349f5Scvs2svn LogPrintf(fp->LogLevel, "RecvIdent\n"); 7391ae349f5Scvs2svn pfree(bp); 7401ae349f5Scvs2svn } 7411ae349f5Scvs2svn 7421ae349f5Scvs2svn static void 7431ae349f5Scvs2svn FsmRecvTimeRemain(struct fsm * fp, struct fsmheader * lhp, struct mbuf * bp) 7441ae349f5Scvs2svn { 7451ae349f5Scvs2svn LogPrintf(fp->LogLevel, "RecvTimeRemain\n"); 7461ae349f5Scvs2svn pfree(bp); 7471ae349f5Scvs2svn } 7481ae349f5Scvs2svn 7491ae349f5Scvs2svn static void 7501ae349f5Scvs2svn FsmRecvResetReq(struct fsm * fp, struct fsmheader * lhp, struct mbuf * bp) 7511ae349f5Scvs2svn { 7521ae349f5Scvs2svn LogPrintf(fp->LogLevel, "RecvResetReq(%d)\n", lhp->id); 7531ae349f5Scvs2svn CcpRecvResetReq(fp); 7541ae349f5Scvs2svn /* 7551ae349f5Scvs2svn * All sendable compressed packets are queued in the PRI_NORMAL modem 7561ae349f5Scvs2svn * output queue.... dump 'em to the priority queue so that they arrive 7571ae349f5Scvs2svn * at the peer before our ResetAck. 7581ae349f5Scvs2svn */ 7591ae349f5Scvs2svn SequenceQueues(); 7601ae349f5Scvs2svn LogPrintf(fp->LogLevel, "SendResetAck(%d)\n", lhp->id); 7611ae349f5Scvs2svn FsmOutput(fp, CODE_RESETACK, lhp->id, NULL, 0); 7621ae349f5Scvs2svn pfree(bp); 7631ae349f5Scvs2svn } 7641ae349f5Scvs2svn 7651ae349f5Scvs2svn static void 7661ae349f5Scvs2svn FsmRecvResetAck(struct fsm * fp, struct fsmheader * lhp, struct mbuf * bp) 7671ae349f5Scvs2svn { 7681ae349f5Scvs2svn LogPrintf(fp->LogLevel, "RecvResetAck(%d)\n", lhp->id); 7691ae349f5Scvs2svn CcpResetInput(lhp->id); 7701ae349f5Scvs2svn fp->reqid++; 7711ae349f5Scvs2svn pfree(bp); 7721ae349f5Scvs2svn } 7731ae349f5Scvs2svn 7741ae349f5Scvs2svn static const struct fsmcodedesc FsmCodes[] = { 7751ae349f5Scvs2svn {FsmRecvConfigReq, "Configure Request",}, 7761ae349f5Scvs2svn {FsmRecvConfigAck, "Configure Ack",}, 7771ae349f5Scvs2svn {FsmRecvConfigNak, "Configure Nak",}, 7781ae349f5Scvs2svn {FsmRecvConfigRej, "Configure Reject",}, 7791ae349f5Scvs2svn {FsmRecvTermReq, "Terminate Request",}, 7801ae349f5Scvs2svn {FsmRecvTermAck, "Terminate Ack",}, 7811ae349f5Scvs2svn {FsmRecvCodeRej, "Code Reject",}, 7821ae349f5Scvs2svn {FsmRecvProtoRej, "Protocol Reject",}, 7831ae349f5Scvs2svn {FsmRecvEchoReq, "Echo Request",}, 7841ae349f5Scvs2svn {FsmRecvEchoRep, "Echo Reply",}, 7851ae349f5Scvs2svn {FsmRecvDiscReq, "Discard Request",}, 7861ae349f5Scvs2svn {FsmRecvIdent, "Ident",}, 7871ae349f5Scvs2svn {FsmRecvTimeRemain, "Time Remain",}, 7881ae349f5Scvs2svn {FsmRecvResetReq, "Reset Request",}, 7891ae349f5Scvs2svn {FsmRecvResetAck, "Reset Ack",}, 7901ae349f5Scvs2svn }; 7911ae349f5Scvs2svn 7921ae349f5Scvs2svn void 7931ae349f5Scvs2svn FsmInput(struct fsm * fp, struct mbuf * bp) 7941ae349f5Scvs2svn { 7951ae349f5Scvs2svn int len; 7961ae349f5Scvs2svn struct fsmheader *lhp; 7971ae349f5Scvs2svn const struct fsmcodedesc *codep; 7981ae349f5Scvs2svn 7991ae349f5Scvs2svn len = plength(bp); 8001ae349f5Scvs2svn if (len < sizeof(struct fsmheader)) { 8011ae349f5Scvs2svn pfree(bp); 8021ae349f5Scvs2svn return; 8031ae349f5Scvs2svn } 8041ae349f5Scvs2svn lhp = (struct fsmheader *) MBUF_CTOP(bp); 8051ae349f5Scvs2svn if (lhp->code == 0 || lhp->code > fp->max_code) { 8061ae349f5Scvs2svn pfree(bp); /* XXX: Should send code reject */ 8071ae349f5Scvs2svn return; 8081ae349f5Scvs2svn } 8091ae349f5Scvs2svn bp->offset += sizeof(struct fsmheader); 8101ae349f5Scvs2svn bp->cnt -= sizeof(struct fsmheader); 8111ae349f5Scvs2svn 8121ae349f5Scvs2svn codep = FsmCodes + lhp->code - 1; 8131ae349f5Scvs2svn LogPrintf(fp->LogLevel, "Received %s (%d) state = %s (%d)\n", 8141ae349f5Scvs2svn codep->name, lhp->id, StateNames[fp->state], fp->state); 8151ae349f5Scvs2svn if (LogIsKept(LogDEBUG)) 8161ae349f5Scvs2svn LogMemory(); 8171ae349f5Scvs2svn (codep->action) (fp, lhp, bp); 8181ae349f5Scvs2svn if (LogIsKept(LogDEBUG)) 8191ae349f5Scvs2svn LogMemory(); 8201ae349f5Scvs2svn } 821