#include <stdio.h>
#include <string.h>
#include <sys/types.h>
#include <stdarg.h>
#include <syslog.h>
#include <stdlib.h>
#include <sys/time.h>
#include <sys/socket.h>
#include <netinet/in.h>
#include <net/if_dl.h>
#include <time.h>
#include <event.h>
#include "debugutil.h"
#include "npppd.h"
#include "fsm.h"
#ifdef FSM_DEBUG
#define FSMDEBUG(x) fsm_log x
#define FSM_ASSERT(x) ASSERT(x)
#else
#define FSMDEBUG(x)
#define FSM_ASSERT(x)
#endif
#define HEADERLEN 4
#ifdef RCSID
static const char rcsid[] = RCSID;
#endif
static void fsm_timeout(void *);
static void fsm_rconfreq(fsm *, u_char, u_char *, int len);
static void fsm_rconfack(fsm *, int, u_char *, int);
static void fsm_rconfnakrej(fsm *, int, int, u_char *, int);
static void fsm_rtermreq(fsm *, int, u_char *, int);
static void fsm_rtermack(fsm *);
static void fsm_rcoderej(fsm *, u_char *, int);
static void fsm_sconfreq(fsm *, int);
#define PROTO_NAME(f) ((f)->callbacks->proto_name)
void
fsm_evtimer_timeout(int fd, short evtype, void *ctx)
{
struct evtimer_wrap *wrap;
wrap = ctx;
wrap->func(wrap->ctx);
}
void
fsm_init(fsm *f)
{
f->state = INITIAL;
f->flags = 0;
f->id = 0;
f->timeouttime = DEFTIMEOUT;
f->maxconfreqtransmits = DEFMAXCONFREQS;
f->maxtermtransmits = DEFMAXTERMREQS;
f->maxnakloops = DEFMAXNAKLOOPS;
f->term_reason_len = 0;
memset(&f->timerctx, 0, sizeof(f->timerctx));
f->timerctx.ctx = f;
}
void
fsm_lowerup(fsm *f)
{
switch( f->state ){
case INITIAL:
f->state = CLOSED;
break;
case STARTING:
if( f->flags & OPT_SILENT )
f->state = STOPPED;
else {
fsm_sconfreq(f, 0);
f->state = REQSENT;
}
break;
default:
FSMDEBUG((f, LOG_DEBUG, "Up event in state %d!", f->state));
}
}
void
fsm_lowerdown(fsm *f)
{
switch( f->state ){
case CLOSED:
f->state = INITIAL;
break;
case STOPPED:
f->state = STARTING;
if( f->callbacks->starting )
(*f->callbacks->starting)(f);
break;
case CLOSING:
f->state = INITIAL;
UNTIMEOUT(fsm_timeout, f);
break;
case STOPPING:
case REQSENT:
case ACKRCVD:
case ACKSENT:
f->state = STARTING;
UNTIMEOUT(fsm_timeout, f);
break;
case OPENED:
if( f->callbacks->down )
(*f->callbacks->down)(f);
f->state = STARTING;
break;
default:
FSMDEBUG((f, LOG_DEBUG, "Down event in state %d!", f->state));
}
}
void
fsm_open(fsm *f)
{
switch( f->state ){
case INITIAL:
f->state = STARTING;
if( f->callbacks->starting )
(*f->callbacks->starting)(f);
break;
case CLOSED:
if( f->flags & OPT_SILENT )
f->state = STOPPED;
else {
fsm_sconfreq(f, 0);
f->state = REQSENT;
}
break;
case CLOSING:
f->state = STOPPING;
case STOPPED:
case OPENED:
if( f->flags & OPT_RESTART ){
fsm_lowerdown(f);
fsm_lowerup(f);
}
break;
}
}
void
fsm_close(fsm *f, const char *reason)
{
f->term_reason = (char *)reason;
f->term_reason_len = (reason == NULL? 0: strlen(reason));
switch( f->state ){
case STARTING:
f->state = INITIAL;
break;
case STOPPED:
f->state = CLOSED;
break;
case STOPPING:
f->state = CLOSING;
break;
case REQSENT:
case ACKRCVD:
case ACKSENT:
case OPENED:
if( f->state != OPENED )
UNTIMEOUT(fsm_timeout, f);
else if( f->callbacks->down )
(*f->callbacks->down)(f);
f->retransmits = f->maxtermtransmits;
fsm_sdata(f, TERMREQ, f->reqid = ++f->id,
(u_char *) f->term_reason, f->term_reason_len);
TIMEOUT(fsm_timeout, f, f->timeouttime);
--f->retransmits;
f->state = CLOSING;
break;
}
}
static void
fsm_timeout(void *arg)
{
fsm *f = (fsm *) arg;
switch (f->state) {
case CLOSING:
case STOPPING:
if( f->retransmits <= 0 ){
f->state = (f->state == CLOSING)? CLOSED: STOPPED;
if( f->callbacks->finished )
(*f->callbacks->finished)(f);
} else {
fsm_sdata(f, TERMREQ, f->reqid = ++f->id,
(u_char *) f->term_reason, f->term_reason_len);
TIMEOUT(fsm_timeout, f, f->timeouttime);
--f->retransmits;
}
break;
case REQSENT:
case ACKRCVD:
case ACKSENT:
if (f->retransmits <= 0) {
fsm_log(f, LOG_WARNING, "timeout sending Config-Requests\n");
f->state = STOPPED;
if( (f->flags & OPT_PASSIVE) == 0 && f->callbacks->finished )
(*f->callbacks->finished)(f);
} else {
if (f->callbacks->retransmit)
(*f->callbacks->retransmit)(f);
fsm_sconfreq(f, 1);
if( f->state == ACKRCVD )
f->state = REQSENT;
}
break;
default:
FSMDEBUG((f, LOG_DEBUG, "Timeout event in state %d!", f->state));
}
}
void
fsm_input(fsm *f, u_char *inpacket, int l)
{
u_char *inp;
u_char code, id;
int len;
inp = inpacket;
if (l < HEADERLEN) {
FSMDEBUG((f, LOG_DEBUG, "fsm_input(): Rcvd short header."));
return;
}
GETCHAR(code, inp);
GETCHAR(id, inp);
GETSHORT(len, inp);
if (len < HEADERLEN) {
FSMDEBUG((f, LOG_DEBUG, "fsm_input(): Rcvd illegal length."));
return;
}
if (len > l) {
FSMDEBUG((f, LOG_DEBUG, "fsm_input(): Rcvd short packet."));
return;
}
len -= HEADERLEN;
if( f->state == INITIAL || f->state == STARTING ){
FSMDEBUG((f, LOG_DEBUG, "fsm_input(): Rcvd packet in state %d.",
f->state));
return;
}
switch (code) {
case CONFREQ:
fsm_rconfreq(f, id, inp, len);
break;
case CONFACK:
fsm_rconfack(f, id, inp, len);
break;
case CONFNAK:
case CONFREJ:
fsm_rconfnakrej(f, code, id, inp, len);
break;
case TERMREQ:
fsm_rtermreq(f, id, inp, len);
break;
case TERMACK:
fsm_rtermack(f);
break;
case CODEREJ:
fsm_rcoderej(f, inp, len);
break;
default:
if( !f->callbacks->extcode
|| !(*f->callbacks->extcode)(f, code, id, inp, len) )
fsm_sdata(f, CODEREJ, ++f->id, inpacket, len + HEADERLEN);
break;
}
}
static void
fsm_rconfreq(fsm *f, u_char id, u_char *inp, int len)
{
int code, reject_if_disagree;
switch( f->state ){
case CLOSED:
fsm_sdata(f, TERMACK, id, NULL, 0);
return;
case CLOSING:
case STOPPING:
return;
case OPENED:
if( f->callbacks->down )
(*f->callbacks->down)(f);
fsm_sconfreq(f, 0);
break;
case STOPPED:
fsm_sconfreq(f, 0);
f->state = REQSENT;
break;
}
if (f->callbacks->reqci){
reject_if_disagree = (f->nakloops >= f->maxnakloops);
code = (*f->callbacks->reqci)(f, inp, &len, reject_if_disagree);
} else if (len)
code = CONFREJ;
else
code = CONFACK;
fsm_sdata(f, code, id, inp, len);
if (code == CONFACK) {
if (f->state == ACKRCVD) {
UNTIMEOUT(fsm_timeout, f);
f->state = OPENED;
if (f->callbacks->up)
(*f->callbacks->up)(f);
} else
f->state = ACKSENT;
f->nakloops = 0;
} else {
if (f->state != ACKRCVD)
f->state = REQSENT;
if( code == CONFNAK )
++f->nakloops;
}
}
static void
fsm_rconfack(fsm *f, int id, u_char *inp, int len)
{
if (id != f->reqid || f->seen_ack)
return;
if( !(f->callbacks->ackci? (*f->callbacks->ackci)(f, inp, len):
(len == 0)) ){
fsm_log(f, LOG_ERR, "Received bad configure-ack: %p(%d)", inp, len);
return;
}
f->seen_ack = 1;
switch (f->state) {
case CLOSED:
case STOPPED:
fsm_sdata(f, TERMACK, id, NULL, 0);
break;
case REQSENT:
f->state = ACKRCVD;
f->retransmits = f->maxconfreqtransmits;
break;
case ACKRCVD:
UNTIMEOUT(fsm_timeout, f);
fsm_sconfreq(f, 0);
f->state = REQSENT;
break;
case ACKSENT:
UNTIMEOUT(fsm_timeout, f);
f->state = OPENED;
f->retransmits = f->maxconfreqtransmits;
if (f->callbacks->up)
(*f->callbacks->up)(f);
break;
case OPENED:
if (f->callbacks->down)
(*f->callbacks->down)(f);
fsm_sconfreq(f, 0);
f->state = REQSENT;
break;
}
}
static void
fsm_rconfnakrej(fsm *f, int code, int id, u_char *inp, int len)
{
int (*proc)(fsm *, u_char *, int);
int ret;
if (id != f->reqid || f->seen_ack)
return;
proc = (code == CONFNAK)? f->callbacks->nakci: f->callbacks->rejci;
if (!proc || !(ret = proc(f, inp, len))) {
fsm_log(f, LOG_INFO, "Received bad configure-%s: %p(%d)",
(code == CONFNAK)? "nak" : "rej", inp, len);
return;
}
f->seen_ack = 1;
switch (f->state) {
case CLOSED:
case STOPPED:
fsm_sdata(f, TERMACK, id, NULL, 0);
break;
case REQSENT:
case ACKSENT:
UNTIMEOUT(fsm_timeout, f);
if (ret < 0)
f->state = STOPPED;
else
fsm_sconfreq(f, 0);
break;
case ACKRCVD:
UNTIMEOUT(fsm_timeout, f);
fsm_sconfreq(f, 0);
f->state = REQSENT;
break;
case OPENED:
if (f->callbacks->down)
(*f->callbacks->down)(f);
fsm_sconfreq(f, 0);
f->state = REQSENT;
break;
}
}
static void
fsm_rtermreq(fsm *f, int id, u_char *p, int len)
{
switch (f->state) {
case ACKRCVD:
case ACKSENT:
f->state = REQSENT;
break;
case OPENED:
fsm_log(f, LOG_INFO, "terminated by peer");
if (f->callbacks->down)
(*f->callbacks->down)(f);
f->retransmits = 0;
f->state = STOPPING;
TIMEOUT(fsm_timeout, f, f->timeouttime);
break;
}
fsm_sdata(f, TERMACK, id, NULL, 0);
}
static void
fsm_rtermack(fsm *f)
{
switch (f->state) {
case CLOSING:
UNTIMEOUT(fsm_timeout, f);
f->state = CLOSED;
if( f->callbacks->finished )
(*f->callbacks->finished)(f);
break;
case STOPPING:
UNTIMEOUT(fsm_timeout, f);
f->state = STOPPED;
if( f->callbacks->finished )
(*f->callbacks->finished)(f);
break;
case ACKRCVD:
f->state = REQSENT;
break;
case OPENED:
if (f->callbacks->down)
(*f->callbacks->down)(f);
fsm_sconfreq(f, 0);
f->state = REQSENT;
break;
}
}
static void
fsm_rcoderej(fsm *f, u_char *inp, int len)
{
u_char code, id;
if (len < HEADERLEN) {
FSMDEBUG((f, LOG_DEBUG,
"fsm_rcoderej: Rcvd short Code-Reject packet!"));
return;
}
GETCHAR(code, inp);
GETCHAR(id, inp);
fsm_log(f, LOG_INFO,
"%s: Rcvd Code-Reject for code %d, id %d", PROTO_NAME(f), code, id);
if( f->state == ACKRCVD )
f->state = REQSENT;
}
void
fsm_protreject(fsm *f)
{
switch( f->state ){
case CLOSING:
UNTIMEOUT(fsm_timeout, f);
case CLOSED:
f->state = CLOSED;
if( f->callbacks->finished )
(*f->callbacks->finished)(f);
break;
case STOPPING:
case REQSENT:
case ACKRCVD:
case ACKSENT:
UNTIMEOUT(fsm_timeout, f);
case STOPPED:
f->state = STOPPED;
if( f->callbacks->finished )
(*f->callbacks->finished)(f);
break;
case OPENED:
if( f->callbacks->down )
(*f->callbacks->down)(f);
f->retransmits = f->maxtermtransmits;
fsm_sdata(f, TERMREQ, f->reqid = ++f->id,
(u_char *) f->term_reason, f->term_reason_len);
TIMEOUT(fsm_timeout, f, f->timeouttime);
--f->retransmits;
f->state = STOPPING;
break;
default:
FSMDEBUG((f, LOG_DEBUG,
"Protocol-reject event in state %d!", f->state));
}
}
static void
fsm_sconfreq(fsm *f, int retransmit)
{
u_char *outp;
int cilen;
if( f->state != REQSENT && f->state != ACKRCVD && f->state != ACKSENT ){
if( f->callbacks->resetci )
(*f->callbacks->resetci)(f);
f->nakloops = 0;
}
if( !retransmit ){
f->retransmits = f->maxconfreqtransmits;
f->reqid = ++f->id;
}
f->seen_ack = 0;
outp = f->ppp->outpacket_buf + PPP_HDRLEN + HEADERLEN;
if( f->callbacks->cilen && f->callbacks->addci ){
cilen = (*f->callbacks->cilen)(f);
if( cilen > f->ppp->mru - HEADERLEN )
cilen = f->ppp->mru - HEADERLEN;
if (f->callbacks->addci)
(*f->callbacks->addci)(f, outp, &cilen);
} else
cilen = 0;
fsm_sdata(f, CONFREQ, f->reqid, outp, cilen);
--f->retransmits;
TIMEOUT(fsm_timeout, f, f->timeouttime);
}
void
fsm_sdata(fsm *f, u_char code, u_char id, u_char *data, int datalen)
{
ppp_output(f->ppp, f->protocol, code, id, data, datalen);
}
void
fsm_log(fsm *f, uint32_t prio, const char *fmt, ...)
{
char logbuf[BUFSIZ];
va_list ap;
FSM_ASSERT(f != NULL);
FSM_ASSERT(f->callbacks != NULL);
va_start(ap, fmt);
snprintf(logbuf, sizeof(logbuf), "ppp id=%u layer=%s %s", f->ppp->id,
PROTO_NAME(f), fmt);
vlog_printf(prio, logbuf, ap);
va_end(ap);
}