ref: 61cc0694649a4d4b109d168032f431751f57f083
dir: /sys/src/cmd/ip/snoopy/ppp.c/
#include <u.h>
#include <libc.h>
#include <ip.h>
#include <libsec.h>
#include "dat.h"
#include "protos.h"
/* PPP stuff */
enum {
PPP_addr= 0xff,
PPP_ctl= 0x3,
PPP_period= 3*1000, /* period of retransmit process (in ms) */
};
/* PPP protocols */
enum {
PPP_ip= 0x21, /* internet */
PPP_vjctcp= 0x2d, /* compressing van jacobson tcp */
PPP_vjutcp= 0x2f, /* uncompressing van jacobson tcp */
PPP_ml= 0x3d, /* multi link */
PPP_comp= 0xfd, /* compressed packets */
PPP_ipcp= 0x8021, /* ip control */
PPP_ccp= 0x80fd, /* compression control */
PPP_passwd= 0xc023, /* passwd authentication */
PPP_lcp= 0xc021, /* link control */
PPP_lqm= 0xc025, /* link quality monitoring */
PPP_chap= 0xc223, /* challenge/response */
};
/* LCP protocol (and IPCP) */
typedef struct Lcppkt Lcppkt;
struct Lcppkt
{
uchar code;
uchar id;
uchar len[2];
uchar data[1];
};
typedef struct Lcpopt Lcpopt;
struct Lcpopt
{
uchar type;
uchar len;
uchar data[1];
};
enum
{
/* LCP codes */
Lconfreq= 1,
Lconfack= 2,
Lconfnak= 3,
Lconfrej= 4,
Ltermreq= 5,
Ltermack= 6,
Lcoderej= 7,
Lprotorej= 8,
Lechoreq= 9,
Lechoack= 10,
Ldiscard= 11,
Lresetreq= 14, /* for ccp only */
Lresetack= 15, /* for ccp only */
/* Lcp configure options */
Omtu= 1,
Octlmap= 2,
Oauth= 3,
Oquality= 4,
Omagic= 5,
Opc= 7,
Oac= 8,
/* authentication protocols */
APmd5= 5,
APmschap= 128,
/* Chap codes */
Cchallenge= 1,
Cresponse= 2,
Csuccess= 3,
Cfailure= 4,
/* ipcp configure options */
Oipaddrs= 1,
Oipcompress= 2,
Oipaddr= 3,
Oipdns= 129,
Oipwins= 130,
Oipdns2= 131,
Oipwins2= 132,
};
char *
lcpcode[] = {
0,
"confreq",
"confack",
"confnak",
"confrej",
"termreq",
"termack",
"coderej",
"protorej",
"echoreq",
"echoack",
"discard",
"id",
"timeremain",
"resetreq",
"resetack",
};
static Mux p_mux[] =
{
{"ip", PPP_ip, },
{"ppp_vjctcp", PPP_vjctcp, },
{"ppp_vjutcp", PPP_vjutcp, },
{"ppp_ml", PPP_ml, },
{"ppp_comp", PPP_comp, },
{"ppp_ipcp", PPP_ipcp, },
{"ppp_ccp", PPP_ccp, },
{"ppp_passwd", PPP_passwd, },
{"ppp_lcp", PPP_lcp, },
{"ppp_lqm", PPP_lqm, },
{"ppp_chap", PPP_chap, },
{0},
};
enum
{
OOproto,
};
static void
p_compile(Filter *f)
{
Mux *m;
for(m = p_mux; m->name != nil; m++)
if(strcmp(f->s, m->name) == 0){
f->pr = m->pr;
f->ulv = m->val;
f->subop = OOproto;
return;
}
sysfatal("unknown ppp field or protocol: %s", f->s);
}
static int
p_filter(Filter *f, Msg *m)
{
int proto;
int len;
if(f->subop != OOproto)
return 0;
len = m->pe - m->ps;
if(len < 3)
return -1;
if(m->ps[0] == PPP_addr && m->ps[1] == PPP_ctl)
m->ps += 2;
proto = *m->ps++;
if((proto&1) == 0)
proto = (proto<<8) | *m->ps++;
if(proto == f->ulv)
return 1;
return 0;
}
static int
p_seprint(Msg *m)
{
int proto;
int len;
len = m->pe - m->ps;
if(len < 3)
return -1;
if(m->ps[0] == PPP_addr && m->ps[1] == PPP_ctl)
m->ps += 2;
proto = *m->ps++;
if((proto&1) == 0)
proto = (proto<<8) | *m->ps++;
m->p = seprint(m->p, m->e, "pr=%ud len=%d", proto, len);
demux(p_mux, proto, proto, m, &dump);
return 0;
}
static int
p_seprintchap(Msg *m)
{
Lcppkt *lcp;
char *p, *e;
int len;
if(m->pe-m->ps < 4)
return -1;
p = m->p;
e = m->e;
m->pr = nil;
/* resize packet */
lcp = (Lcppkt*)m->ps;
len = NetS(lcp->len);
if(m->ps+len < m->pe)
m->pe = m->ps+len;
else if(m->ps+len > m->pe)
return -1;
p = seprint(p, e, "id=%d code=%d", lcp->id, lcp->code);
switch(lcp->code) {
default:
p = seprint(p, e, " data=%.*H", len>64?64:len, lcp->data);
break;
case 1:
case 2:
if(lcp->data[0] > len-4){
p = seprint(p, e, "%.*H", len-4, lcp->data);
} else {
p = seprint(p, e, " %s=", lcp->code==1?"challenge ":"response ");
p = seprint(p, e, "%.*H", lcp->data[0], lcp->data+1);
p = seprint(p, e, " name=");
p = seprint(p, e, "%.*H", len-4-lcp->data[0]-1, lcp->data+lcp->data[0]+1);
}
break;
case 3:
case 4:
if(len > 64)
len = 64;
p = seprint(p, e, " %s=%.*H", lcp->code==3?"success ":"failure",
len>64?64:len, lcp->data);
break;
}
m->p = seprint(p, e, " len=%d", len);
return 0;
}
static char*
seprintlcpopt(char *p, char *e, void *a, int len)
{
Lcpopt *o;
int proto, x, period;
uchar *cp, *ecp;
cp = a;
ecp = cp+len;
for(; cp < ecp; cp += o->len){
o = (Lcpopt*)cp;
if(cp + o->len > ecp || o->len == 0){
p = seprint(p, e, " bad-opt-len=%d", o->len);
return p;
}
switch(o->type){
default:
p = seprint(p, e, " (type=%d len=%d)", o->type, o->len);
break;
case Omtu:
p = seprint(p, e, " mtu=%d", NetS(o->data));
break;
case Octlmap:
p = seprint(p, e, " ctlmap=%ux", NetL(o->data));
break;
case Oauth:
proto = NetS(o->data);
switch(proto) {
default:
p = seprint(p, e, " auth=%d", proto);
break;
case PPP_passwd:
p = seprint(p, e, " auth=passwd");
break;
case PPP_chap:
p = seprint(p, e, " (auth=chap data=%2.2ux)", o->data[2]);
break;
}
break;
case Oquality:
proto = NetS(o->data);
switch(proto) {
default:
p = seprint(p, e, " qproto=%d", proto);
break;
case PPP_lqm:
x = NetL(o->data+2)*10;
period = (x+(PPP_period-1))/PPP_period;
p = seprint(p, e, " (qproto=lqm period=%d)", period);
break;
}
case Omagic:
p = seprint(p, e, " magic=%ux", NetL(o->data));
break;
case Opc:
p = seprint(p, e, " protocol-compress");
break;
case Oac:
p = seprint(p, e, " addr-compress");
break;
}
}
return p;
}
static int
p_seprintlcp(Msg *m)
{
Lcppkt *lcp;
char *p, *e;
int len;
if(m->pe-m->ps < 4)
return -1;
p = m->p;
e = m->e;
m->pr = nil;
lcp = (Lcppkt*)m->ps;
len = NetS(lcp->len);
if(m->ps+len < m->pe)
m->pe = m->ps+len;
else if(m->ps+len > m->pe)
return -1;
p = seprint(p, e, "id=%d code=%d", lcp->id, lcp->code);
switch(lcp->code) {
default:
p = seprint(p, e, " data=%.*H", len>64?64:len, lcp->data);
break;
case Lconfreq:
case Lconfack:
case Lconfnak:
case Lconfrej:
p = seprint(p, e, "=%s", lcpcode[lcp->code]);
p = seprintlcpopt(p, e, lcp->data, len-4);
break;
case Ltermreq:
case Ltermack:
case Lcoderej:
case Lprotorej:
case Lechoreq:
case Lechoack:
case Ldiscard:
p = seprint(p, e, "=%s", lcpcode[lcp->code]);
break;
}
m->p = seprint(p, e, " len=%d", len);
return 0;
}
static char*
seprintipcpopt(char *p, char *e, void *a, int len)
{
Lcpopt *o;
uchar *cp, *ecp;
cp = a;
ecp = cp+len;
for(; cp < ecp; cp += o->len){
o = (Lcpopt*)cp;
if(cp + o->len > ecp){
p = seprint(p, e, " bad opt len %ux", o->type);
return p;
}
switch(o->type){
default:
p = seprint(p, e, " (type=%d len=%d)", o->type, o->len);
break;
case Oipaddrs:
p = seprint(p, e, " ipaddrs(deprecated)");
break;
case Oipcompress:
p = seprint(p, e, " ipcompress");
break;
case Oipaddr:
p = seprint(p, e, " ipaddr=%V", o->data);
break;
case Oipdns:
p = seprint(p, e, " dnsaddr=%V", o->data);
break;
case Oipwins:
p = seprint(p, e, " winsaddr=%V", o->data);
break;
case Oipdns2:
p = seprint(p, e, " dns2addr=%V", o->data);
break;
case Oipwins2:
p = seprint(p, e, " wins2addr=%V", o->data);
break;
}
}
return p;
}
static int
p_seprintipcp(Msg *m)
{
Lcppkt *lcp;
char *p, *e;
int len;
if(m->pe-m->ps < 4)
return -1;
p = m->p;
e = m->e;
m->pr = nil;
lcp = (Lcppkt*)m->ps;
len = NetS(lcp->len);
if(m->ps+len < m->pe)
m->pe = m->ps+len;
else if(m->ps+len > m->pe)
return -1;
p = seprint(p, e, "id=%d code=%d", lcp->id, lcp->code);
switch(lcp->code) {
default:
p = seprint(p, e, " data=%.*H", len>64?64:len, lcp->data);
break;
case Lconfreq:
case Lconfack:
case Lconfnak:
case Lconfrej:
p = seprint(p, e, "=%s", lcpcode[lcp->code]);
p = seprintipcpopt(p, e, lcp->data, len-4);
break;
case Ltermreq:
case Ltermack:
p = seprint(p, e, "=%s", lcpcode[lcp->code]);
break;
}
m->p = seprint(p, e, " len=%d", len);
return 0;
}
static char*
seprintccpopt(char *p, char *e, void *a, int len)
{
Lcpopt *o;
uchar *cp, *ecp;
cp = a;
ecp = cp+len;
for(; cp < ecp; cp += o->len){
o = (Lcpopt*)cp;
if(cp + o->len > ecp){
p = seprint(p, e, " bad opt len %ux", o->type);
return p;
}
switch(o->type){
default:
p = seprint(p, e, " type=%d ", o->type);
break;
case 0:
p = seprint(p, e, " OUI=(%d %.2ux%.2ux%.2ux) ", o->type,
o->data[0], o->data[1], o->data[2]);
break;
case 17:
p = seprint(p, e, " Stac-LZS");
break;
case 18:
p = seprint(p, e, " Microsoft-PPC=%ux", NetL(o->data));
break;
}
}
return p;
}
static int
p_seprintccp(Msg *m)
{
Lcppkt *lcp;
char *p, *e;
int len;
if(m->pe-m->ps < 4)
return -1;
p = m->p;
e = m->e;
m->pr = nil;
lcp = (Lcppkt*)m->ps;
len = NetS(lcp->len);
if(m->ps+len < m->pe)
m->pe = m->ps+len;
else if(m->ps+len > m->pe)
return -1;
p = seprint(p, e, "id=%d code=%d", lcp->id, lcp->code);
switch(lcp->code) {
default:
p = seprint(p, e, " data=%.*H", len>64?64:len, lcp->data);
break;
case Lconfreq:
case Lconfack:
case Lconfnak:
case Lconfrej:
p = seprint(p, e, "=%s", lcpcode[lcp->code]);
p = seprintccpopt(p, e, lcp->data, len-4);
break;
case Ltermreq:
case Ltermack:
case Lresetreq:
case Lresetack:
p = seprint(p, e, "=%s", lcpcode[lcp->code]);
break;
}
m->p = seprint(p, e, " len=%d", len);
return 0;
}
static int
p_seprintcomp(Msg *m)
{
char compflag[5];
ushort x;
int i;
int len;
len = m->pe-m->ps;
if(len < 2)
return -1;
x = NetS(m->ps);
m->ps += 2;
i = 0;
if(x & (1<<15))
compflag[i++] = 'r';
if(x & (1<<14))
compflag[i++] = 'f';
if(x & (1<<13))
compflag[i++] = 'c';
if(x & (1<<12))
compflag[i++] = 'e';
compflag[i] = 0;
m->p = seprint(m->p, m->e, "flag=%s count=%.3ux", compflag, x&0xfff);
m->p = seprint(m->p, m->e, " data=%.*H", len>64?64:len, m->ps);
m->pr = nil;
return 0;
}
Proto ppp =
{
"ppp",
p_compile,
p_filter,
p_seprint,
p_mux,
"%#.4lux",
nil,
defaultframer,
};
Proto ppp_ipcp =
{
"ppp_ipcp",
p_compile,
p_filter,
p_seprintipcp,
nil,
nil,
nil,
defaultframer,
};
Proto ppp_lcp =
{
"ppp_lcp",
p_compile,
p_filter,
p_seprintlcp,
nil,
nil,
nil,
defaultframer,
};
Proto ppp_ccp =
{
"ppp_ccp",
p_compile,
p_filter,
p_seprintccp,
nil,
nil,
nil,
defaultframer,
};
Proto ppp_chap =
{
"ppp_chap",
p_compile,
p_filter,
p_seprintchap,
nil,
nil,
nil,
defaultframer,
};
Proto ppp_comp =
{
"ppp_comp",
p_compile,
p_filter,
p_seprintcomp,
nil,
nil,
nil,
defaultframer,
};