pppd/fsm.c

   1 /*
   2  * fsm.c - {Link, IP} Control Protocol Finite State Machine.
   3  *
   4  * Copyright (c) 1989 Carnegie Mellon University.
   5  * All rights reserved.
   6  *
   7  * Redistribution and use in source and binary forms are permitted
   8  * provided that the above copyright notice and this paragraph are
   9  * duplicated in all such forms and that any documentation,
  10  * advertising materials, and other materials related to such
  11  * distribution and use acknowledge that the software was developed
  12  * by Carnegie Mellon University.  The name of the
  13  * University may not be used to endorse or promote products derived
  14  * from this software without specific prior written permission.
  15  * THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR
  16  * IMPLIED WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED
  17  * WARRANTIES OF MERCHANTIBILITY AND FITNESS FOR A PARTICULAR PURPOSE.
  18  */
  19
  20 #ifndef lint
  21 static char rcsid[] = "$Id: fsm.c,v 1.3 1994/05/24 11:21:10 paulus Exp $";
  22 #endif
  23
  24 /*
  25  * TODO:
  26  * Randomize fsm id on link/init.
  27  * Deal with variable outgoing MTU.
  28  */
  29
  30 #include <stdio.h>
  31 #include <sys/types.h>
  32 #include <syslog.h>
  33
  34 #include "ppp.h"
  35 #include "pppd.h"
  36 #include "fsm.h"
  37
  38 extern char *proto_name();
  39
  40 static void fsm_timeout __ARGS((caddr_t));
  41 static void fsm_rconfreq __ARGS((fsm *, int, u_char *, int));
  42 static void fsm_rconfack __ARGS((fsm *, int, u_char *, int));
  43 static void fsm_rconfnakrej __ARGS((fsm *, int, int, u_char *, int));
  44 static void fsm_rtermreq __ARGS((fsm *, int));
  45 static void fsm_rtermack __ARGS((fsm *));
  46 static void fsm_rcoderej __ARGS((fsm *, u_char *, int));
  47 static void fsm_sconfreq __ARGS((fsm *, int));
  48
  49 #define PROTO_NAME(f)   ((f)->callbacks->proto_name)
  50
  51 int peer_mru[NPPP];
  52
  53
  54 /*
  55  * fsm_init - Initialize fsm.
  56  *
  57  * Initialize fsm state.
  58  */
  59 void
  60 fsm_init(f)
  61     fsm *f;
  62 {
  63     f->state = INITIAL;
  64     f->flags = 0;
  65     f->id = 0;                          /* XXX Start with random id? */
  66     f->timeouttime = DEFTIMEOUT;
  67     f->maxconfreqtransmits = DEFMAXCONFREQS;
  68     f->maxtermtransmits = DEFMAXTERMREQS;
  69     f->maxnakloops = DEFMAXNAKLOOPS;
  70 }
  71
  72
  73 /*
  74  * fsm_lowerup - The lower layer is up.
  75  */
  76 void
  77 fsm_lowerup(f)
  78     fsm *f;
  79 {
  80     switch( f->state ){
  81     case INITIAL:
  82         f->state = CLOSED;
  83         break;
  84
  85     case STARTING:
  86         if( f->flags & OPT_SILENT )
  87             f->state = STOPPED;
  88         else {
  89             /* Send an initial configure-request */
  90             fsm_sconfreq(f, 0);
  91             f->state = REQSENT;
  92         }
  93         break;
  94
  95     default:
  96         FSMDEBUG((LOG_INFO, "%s: Up event in state %d!",
  97                   PROTO_NAME(f), f->state));
  98     }
  99 }
 100
 101
 102 /*
 103  * fsm_lowerdown - The lower layer is down.
 104  *
 105  * Cancel all timeouts and inform upper layers.
 106  */
 107 void
 108 fsm_lowerdown(f)
 109     fsm *f;
 110 {
 111     switch( f->state ){
 112     case CLOSED:
 113         f->state = INITIAL;
 114         break;
 115
 116     case STOPPED:
 117         f->state = STARTING;
 118         if( f->callbacks->starting )
 119             (*f->callbacks->starting)(f);
 120         break;
 121
 122     case CLOSING:
 123         f->state = INITIAL;
 124         UNTIMEOUT(fsm_timeout, (caddr_t) f);    /* Cancel timeout */
 125         break;
 126
 127     case STOPPING:
 128     case REQSENT:
 129     case ACKRCVD:
 130     case ACKSENT:
 131         f->state = STARTING;
 132         UNTIMEOUT(fsm_timeout, (caddr_t) f);    /* Cancel timeout */
 133         break;
 134
 135     case OPENED:
 136         if( f->callbacks->down )
 137             (*f->callbacks->down)(f);
 138         f->state = STARTING;
 139         break;
 140
 141     default:
 142         FSMDEBUG((LOG_INFO, "%s: Down event in state %d!",
 143                   PROTO_NAME(f), f->state));
 144     }
 145 }
 146
 147
 148 /*
 149  * fsm_open - Link is allowed to come up.
 150  */
 151 void
 152 fsm_open(f)
 153     fsm *f;
 154 {
 155     switch( f->state ){
 156     case INITIAL:
 157         f->state = STARTING;
 158         if( f->callbacks->starting )
 159             (*f->callbacks->starting)(f);
 160         break;
 161
 162     case CLOSED:
 163         if( f->flags & OPT_SILENT )
 164             f->state = STOPPED;
 165         else {
 166             /* Send an initial configure-request */
 167             fsm_sconfreq(f, 0);
 168             f->state = REQSENT;
 169         }
 170         break;
 171
 172     case CLOSING:
 173         f->state = STOPPING;
 174         /* fall through */
 175     case STOPPED:
 176     case OPENED:
 177         if( f->flags & OPT_RESTART ){
 178             fsm_lowerdown(f);
 179             fsm_lowerup(f);
 180         }
 181         break;
 182     }
 183 }
 184
 185
 186 /*
 187  * fsm_close - Start closing connection.
 188  *
 189  * Cancel timeouts and either initiate close or possibly go directly to
 190  * the CLOSED state.
 191  */
 192 void
 193 fsm_close(f)
 194     fsm *f;
 195 {
 196     switch( f->state ){
 197     case STARTING:
 198         f->state = INITIAL;
 199         break;
 200     case STOPPED:
 201         f->state = CLOSED;
 202         break;
 203     case STOPPING:
 204         f->state = CLOSING;
 205         break;
 206
 207     case REQSENT:
 208     case ACKRCVD:
 209     case ACKSENT:
 210     case OPENED:
 211         if( f->state != OPENED )
 212             UNTIMEOUT(fsm_timeout, (caddr_t) f);        /* Cancel timeout */
 213         else if( f->callbacks->down )
 214             (*f->callbacks->down)(f);   /* Inform upper layers we're down */
 215
 216         /* Init restart counter, send Terminate-Request */
 217         f->retransmits = f->maxtermtransmits;
 218         fsm_sdata(f, TERMREQ, f->reqid = ++f->id, NULL, 0);
 219         TIMEOUT(fsm_timeout, (caddr_t) f, f->timeouttime);
 220         --f->retransmits;
 221
 222         f->state = CLOSING;
 223         break;
 224     }
 225 }
 226
 227
 228 /*
 229  * fsm_timeout - Timeout expired.
 230  */
 231 static void
 232 fsm_timeout(arg)
 233     caddr_t arg;
 234 {
 235     fsm *f = (fsm *) arg;
 236
 237     switch (f->state) {
 238     case CLOSING:
 239     case STOPPING:
 240         if( f->retransmits <= 0 ){
 241             /*
 242              * We've waited for an ack long enough.  Peer probably heard us.
 243              */
 244             f->state = (f->state == CLOSING)? CLOSED: STOPPED;
 245             if( f->callbacks->finished )
 246                 (*f->callbacks->finished)(f);
 247         } else {
 248             /* Send Terminate-Request */
 249             fsm_sdata(f, TERMREQ, f->reqid = ++f->id, NULL, 0);
 250             TIMEOUT(fsm_timeout, (caddr_t) f, f->timeouttime);
 251             --f->retransmits;
 252         }
 253         break;
 254
 255     case REQSENT:
 256     case ACKRCVD:
 257     case ACKSENT:
 258         if (f->retransmits <= 0) {
 259             syslog(LOG_WARNING, "%s: timeout sending Config-Requests",
 260                    PROTO_NAME(f));
 261             f->state = STOPPED;
 262             if( (f->flags & OPT_PASSIVE) == 0 && f->callbacks->finished )
 263                 (*f->callbacks->finished)(f);
 264
 265         } else {
 266             /* Retransmit the configure-request */
 267             if (f->callbacks->retransmit)
 268                 (*f->callbacks->retransmit)(f);
 269             fsm_sconfreq(f, 1);         /* Re-send Configure-Request */
 270             if( f->state == ACKRCVD )
 271                 f->state = REQSENT;
 272         }
 273         break;
 274
 275     default:
 276         FSMDEBUG((LOG_INFO, "%s: Timeout event in state %d!",
 277                   PROTO_NAME(f), f->state));
 278     }
 279 }
 280
 281
 282 /*
 283  * fsm_input - Input packet.
 284  */
 285 void
 286 fsm_input(f, inpacket, l)
 287     fsm *f;
 288     u_char *inpacket;
 289     int l;
 290 {
 291     u_char *inp, *outp;
 292     u_char code, id;
 293     int len;
 294
 295     /*
 296      * Parse header (code, id and length).
 297      * If packet too short, drop it.
 298      */
 299     inp = inpacket;
 300     if (l < HEADERLEN) {
 301         FSMDEBUG((LOG_WARNING, "fsm_input(%x): Rcvd short header.",
 302                   f->protocol));
 303         return;
 304     }
 305     GETCHAR(code, inp);
 306     GETCHAR(id, inp);
 307     GETSHORT(len, inp);
 308     if (len < HEADERLEN) {
 309         FSMDEBUG((LOG_INFO, "fsm_input(%x): Rcvd illegal length.",
 310                   f->protocol));
 311         return;
 312     }
 313     if (len > l) {
 314         FSMDEBUG((LOG_INFO, "fsm_input(%x): Rcvd short packet.",
 315                   f->protocol));
 316         return;
 317     }
 318     len -= HEADERLEN;           /* subtract header length */
 319
 320     if( f->state == INITIAL || f->state == STARTING ){
 321         FSMDEBUG((LOG_INFO, "fsm_input(%x): Rcvd packet in state %d.",
 322                   f->protocol, f->state));
 323         return;
 324     }
 325
 326     /*
 327      * Action depends on code.
 328      */
 329     switch (code) {
 330     case CONFREQ:
 331         fsm_rconfreq(f, id, inp, len);
 332         break;
 333
 334     case CONFACK:
 335         fsm_rconfack(f, id, inp, len);
 336         break;
 337
 338     case CONFNAK:
 339     case CONFREJ:
 340         fsm_rconfnakrej(f, code, id, inp, len);
 341         break;
 342
 343     case TERMREQ:
 344         fsm_rtermreq(f, id);
 345         break;
 346
 347     case TERMACK:
 348         fsm_rtermack(f);
 349         break;
 350
 351     case CODEREJ:
 352         fsm_rcoderej(f, inp, len);
 353         break;
 354
 355     default:
 356         if( !f->callbacks->extcode
 357            || !(*f->callbacks->extcode)(f, code, id, inp, len) )
 358             fsm_sdata(f, CODEREJ, ++f->id, inpacket, len + HEADERLEN);
 359         break;
 360     }
 361 }
 362
 363
 364 /*
 365  * fsm_rconfreq - Receive Configure-Request.
 366  */
 367 static void
 368 fsm_rconfreq(f, id, inp, len)
 369     fsm *f;
 370     u_char id;
 371     u_char *inp;
 372     int len;
 373 {
 374     u_char *outp;
 375     int code, reject_if_disagree;
 376
 377     FSMDEBUG((LOG_INFO, "fsm_rconfreq(%s): Rcvd id %d.", PROTO_NAME(f), id));
 378     switch( f->state ){
 379     case CLOSED:
 380         /* Go away, we're closed */
 381         fsm_sdata(f, TERMACK, id, NULL, 0);
 382         return;
 383     case CLOSING:
 384     case STOPPING:
 385         return;
 386
 387     case OPENED:
 388         /* Go down and restart negotiation */
 389         if( f->callbacks->down )
 390             (*f->callbacks->down)(f);   /* Inform upper layers */
 391         fsm_sconfreq(f, 0);             /* Send initial Configure-Request */
 392         break;
 393
 394     case STOPPED:
 395         /* Negotiation started by our peer */
 396         fsm_sconfreq(f, 0);             /* Send initial Configure-Request */
 397         f->state = REQSENT;
 398         break;
 399     }
 400
 401     /*
 402      * Pass the requested configuration options
 403      * to protocol-specific code for checking.
 404      */
 405     if (f->callbacks->reqci){           /* Check CI */
 406         reject_if_disagree = (f->nakloops >= f->maxnakloops);
 407         code = (*f->callbacks->reqci)(f, inp, &len, reject_if_disagree);
 408     } else if (len)
 409         code = CONFREJ;                 /* Reject all CI */
 410     else
 411         code = CONFACK;
 412
 413     /* send the Ack, Nak or Rej to the peer */
 414     fsm_sdata(f, code, id, inp, len);
 415
 416     if (code == CONFACK) {
 417         if (f->state == ACKRCVD) {
 418             UNTIMEOUT(fsm_timeout, (caddr_t) f);        /* Cancel timeout */
 419             f->state = OPENED;
 420             if (f->callbacks->up)
 421                 (*f->callbacks->up)(f); /* Inform upper layers */
 422         } else
 423             f->state = ACKSENT;
 424         f->nakloops = 0;
 425
 426     } else {
 427         /* we sent CONFACK or CONFREJ */
 428         if (f->state != ACKRCVD)
 429             f->state = REQSENT;
 430         if( code == CONFNAK )
 431             ++f->nakloops;
 432     }
 433 }
 434
 435
 436 /*
 437  * fsm_rconfack - Receive Configure-Ack.
 438  */
 439 static void
 440 fsm_rconfack(f, id, inp, len)
 441     fsm *f;
 442     int id;
 443     u_char *inp;
 444     int len;
 445 {
 446     FSMDEBUG((LOG_INFO, "fsm_rconfack(%s): Rcvd id %d.",
 447               PROTO_NAME(f), id));
 448
 449     if (id != f->reqid)         /* Expected id? */
 450         return;                 /* Nope, toss... */
 451     if( !(f->callbacks->ackci? (*f->callbacks->ackci)(f, inp, len): (len == 0)) ){
 452         /* Ack is bad - ignore it */
 453         FSMDEBUG((LOG_INFO, "%s: received bad Ack (length %d)",
 454                   PROTO_NAME(f), len));
 455         return;
 456     }
 457     f->reqid = -1;
 458
 459     switch (f->state) {
 460     case CLOSED:
 461     case STOPPED:
 462         fsm_sdata(f, TERMACK, id, NULL, 0);
 463         break;
 464
 465     case REQSENT:
 466         f->state = ACKRCVD;
 467         f->retransmits = f->maxconfreqtransmits;
 468         break;
 469
 470     case ACKRCVD:
 471         /* Huh? an extra Ack? oh well... */
 472         fsm_sconfreq(f, 0);
 473         f->state = REQSENT;
 474         break;
 475
 476     case ACKSENT:
 477         UNTIMEOUT(fsm_timeout, (caddr_t) f);    /* Cancel timeout */
 478         f->state = OPENED;
 479         f->retransmits = f->maxconfreqtransmits;
 480         if (f->callbacks->up)
 481             (*f->callbacks->up)(f);     /* Inform upper layers */
 482         break;
 483
 484     case OPENED:
 485         /* Go down and restart negotiation */
 486         if (f->callbacks->down)
 487             (*f->callbacks->down)(f);   /* Inform upper layers */
 488         fsm_sconfreq(f, 0);             /* Send initial Configure-Request */
 489         f->state = REQSENT;
 490         break;
 491     }
 492 }
 493
 494
 495 /*
 496  * fsm_rconfnakrej - Receive Configure-Nak or Configure-Reject.
 497  */
 498 static void
 499 fsm_rconfnakrej(f, code, id, inp, len)
 500     fsm *f;
 501     int code, id;
 502     u_char *inp;
 503     int len;
 504 {
 505     int (*proc)();
 506
 507     FSMDEBUG((LOG_INFO, "fsm_rconfnakrej(%s): Rcvd id %d.",
 508               PROTO_NAME(f), id));
 509
 510     if (id != f->reqid)         /* Expected id? */
 511         return;                 /* Nope, toss... */
 512     proc = (code == CONFNAK)? f->callbacks->nakci: f->callbacks->rejci;
 513     if( !proc || !proc(f, inp, len) ){
 514         /* Nak/reject is bad - ignore it */
 515         FSMDEBUG((LOG_INFO, "%s: received bad %s (length %d)",
 516                   PROTO_NAME(f), (code==CONFNAK? "Nak": "reject"), len));
 517         return;
 518     }
 519     f->reqid = -1;
 520
 521     switch (f->state) {
 522     case CLOSED:
 523     case STOPPED:
 524         fsm_sdata(f, TERMACK, id, NULL, 0);
 525         break;
 526
 527     case REQSENT:
 528     case ACKSENT:
 529         /* They didn't agree to what we wanted - try another request */
 530         UNTIMEOUT(fsm_timeout, (caddr_t) f);    /* Cancel timeout */
 531         fsm_sconfreq(f, 0);             /* Send Configure-Request */
 532         break;
 533
 534     case ACKRCVD:
 535         /* Got a Nak/reject when we had already had an Ack?? oh well... */
 536         fsm_sconfreq(f, 0);
 537         f->state = REQSENT;
 538         break;
 539
 540     case OPENED:
 541         /* Go down and restart negotiation */
 542         if (f->callbacks->down)
 543             (*f->callbacks->down)(f);   /* Inform upper layers */
 544         fsm_sconfreq(f, 0);             /* Send initial Configure-Request */
 545         f->state = REQSENT;
 546         break;
 547     }
 548 }
 549
 550
 551 /*
 552  * fsm_rtermreq - Receive Terminate-Req.
 553  */
 554 static void
 555 fsm_rtermreq(f, id)
 556     fsm *f;
 557     int id;
 558 {
 559     FSMDEBUG((LOG_INFO, "fsm_rtermreq(%s): Rcvd id %d.",
 560               PROTO_NAME(f), id));
 561
 562     switch (f->state) {
 563     case ACKRCVD:
 564     case ACKSENT:
 565         f->state = REQSENT;             /* Start over but keep trying */
 566         break;
 567
 568     case OPENED:
 569         syslog(LOG_INFO, "%s terminated at peer's request", PROTO_NAME(f));
 570         if (f->callbacks->down)
 571             (*f->callbacks->down)(f);   /* Inform upper layers */
 572         f->retransmits = 0;
 573         f->state = STOPPING;
 574         TIMEOUT(fsm_timeout, (caddr_t) f, f->timeouttime);
 575         break;
 576     }
 577
 578     fsm_sdata(f, TERMACK, id, NULL, 0);
 579 }
 580
 581
 582 /*
 583  * fsm_rtermack - Receive Terminate-Ack.
 584  */
 585 static void
 586 fsm_rtermack(f)
 587     fsm *f;
 588 {
 589     FSMDEBUG((LOG_INFO, "fsm_rtermack(%s).", PROTO_NAME(f)));
 590
 591     switch (f->state) {
 592     case CLOSING:
 593         f->state = CLOSED;
 594         if( f->callbacks->finished )
 595             (*f->callbacks->finished)(f);
 596         break;
 597     case STOPPING:
 598         f->state = STOPPED;
 599         if( f->callbacks->finished )
 600             (*f->callbacks->finished)(f);
 601         break;
 602
 603     case ACKRCVD:
 604         f->state = REQSENT;
 605         break;
 606
 607     case OPENED:
 608         if (f->callbacks->down)
 609             (*f->callbacks->down)(f);   /* Inform upper layers */
 610         fsm_sconfreq(f, 0);
 611         break;
 612     }
 613 }
 614
 615
 616 /*
 617  * fsm_rcoderej - Receive an Code-Reject.
 618  */
 619 static void
 620 fsm_rcoderej(f, inp, len)
 621     fsm *f;
 622     u_char *inp;
 623     int len;
 624 {
 625     u_char code, id;
 626
 627     FSMDEBUG((LOG_INFO, "fsm_rcoderej(%s).", PROTO_NAME(f)));
 628
 629     if (len < HEADERLEN) {
 630         FSMDEBUG((LOG_INFO, "fsm_rcoderej: Rcvd short Code-Reject packet!"));
 631         return;
 632     }
 633     GETCHAR(code, inp);
 634     GETCHAR(id, inp);
 635     syslog(LOG_WARNING, "%s: Rcvd Code-Reject for code %d, id %d",
 636            PROTO_NAME(f), code, id);
 637
 638     if( f->state == ACKRCVD )
 639         f->state = REQSENT;
 640 }
 641
 642
 643 /*
 644  * fsm_protreject - Peer doesn't speak this protocol.
 645  *
 646  * Treat this as a catastrophic error (RXJ-).
 647  */
 648 void
 649 fsm_protreject(f)
 650     fsm *f;
 651 {
 652     switch( f->state ){
 653     case CLOSING:
 654         UNTIMEOUT(fsm_timeout, (caddr_t) f);    /* Cancel timeout */
 655         /* fall through */
 656     case CLOSED:
 657         f->state = CLOSED;
 658         if( f->callbacks->finished )
 659             (*f->callbacks->finished)(f);
 660         break;
 661
 662     case STOPPING:
 663     case REQSENT:
 664     case ACKRCVD:
 665     case ACKSENT:
 666         UNTIMEOUT(fsm_timeout, (caddr_t) f);    /* Cancel timeout */
 667         /* fall through */
 668     case STOPPED:
 669         f->state = STOPPED;
 670         if( f->callbacks->finished )
 671             (*f->callbacks->finished)(f);
 672         break;
 673
 674     case OPENED:
 675         if( f->callbacks->down )
 676             (*f->callbacks->down)(f);
 677
 678         /* Init restart counter, send Terminate-Request */
 679         f->retransmits = f->maxtermtransmits;
 680         fsm_sdata(f, TERMREQ, f->reqid = ++f->id, NULL, 0);
 681         TIMEOUT(fsm_timeout, (caddr_t) f, f->timeouttime);
 682         --f->retransmits;
 683
 684         f->state = STOPPING;
 685         break;
 686
 687     default:
 688         FSMDEBUG((LOG_INFO, "%s: Protocol-reject event in state %d!",
 689                   PROTO_NAME(f), f->state));
 690     }
 691 }
 692
 693
 694 /*
 695  * fsm_sconfreq - Send a Configure-Request.
 696  */
 697 static void
 698 fsm_sconfreq(f, retransmit)
 699     fsm *f;
 700     int retransmit;
 701 {
 702     u_char *outp;
 703     int outlen, cilen;
 704
 705     if( f->state != REQSENT && f->state != ACKRCVD && f->state != ACKSENT ){
 706         /* Not currently negotiating - reset options */
 707         if( f->callbacks->resetci )
 708             (*f->callbacks->resetci)(f);
 709         f->nakloops = 0;
 710     }
 711
 712     if( !retransmit ){
 713         /* New request - reset retransmission counter, use new ID */
 714         f->retransmits = f->maxconfreqtransmits;
 715         f->reqid = ++f->id;
 716     }
 717
 718     /*
 719      * Make up the request packet
 720      */
 721     outp = outpacket_buf + DLLHEADERLEN + HEADERLEN;
 722     if( f->callbacks->cilen && f->callbacks->addci ){
 723         cilen = (*f->callbacks->cilen)(f);
 724         if( cilen > peer_mru[f->unit] - HEADERLEN )
 725             cilen = peer_mru[f->unit] - HEADERLEN;
 726         if (f->callbacks->addci)
 727             (*f->callbacks->addci)(f, outp, &cilen);
 728     } else
 729         cilen = 0;
 730
 731     /* send the request to our peer */
 732     fsm_sdata(f, CONFREQ, f->reqid, outp, cilen);
 733
 734     /* start the retransmit timer */
 735     --f->retransmits;
 736     TIMEOUT(fsm_timeout, (caddr_t) f, f->timeouttime);
 737
 738     FSMDEBUG((LOG_INFO, "%s: sending Configure-Request, id %d",
 739               PROTO_NAME(f), f->reqid));
 740 }
 741
 742
 743 /*
 744  * fsm_sdata - Send some data.
 745  *
 746  * Used for all packets sent to our peer by this module.
 747  */
 748 void
 749 fsm_sdata(f, code, id, data, datalen)
 750     fsm *f;
 751     u_char code, id;
 752     u_char *data;
 753     int datalen;
 754 {
 755     u_char *outp;
 756     int outlen;
 757
 758     /* Adjust length to be smaller than MTU */
 759     outp = outpacket_buf;
 760     if (datalen > peer_mru[f->unit] - HEADERLEN)
 761         datalen = peer_mru[f->unit] - HEADERLEN;
 762     if (datalen && data != outp + DLLHEADERLEN + HEADERLEN)
 763         BCOPY(data, outp + DLLHEADERLEN + HEADERLEN, datalen);
 764     outlen = datalen + HEADERLEN;
 765     MAKEHEADER(outp, f->protocol);
 766     PUTCHAR(code, outp);
 767     PUTCHAR(id, outp);
 768     PUTSHORT(outlen, outp);
 769     output(f->unit, outpacket_buf, outlen + DLLHEADERLEN);
 770
 771     FSMDEBUG((LOG_INFO, "fsm_sdata(%s): Sent code %d, id %d.",
 772               PROTO_NAME(f), code, id));
 773 }