1*ed397113SDavid du Colombier #include <u.h>
2*ed397113SDavid du Colombier #include <libc.h>
3*ed397113SDavid du Colombier #include <ip.h>
4*ed397113SDavid du Colombier #include "dat.h"
5*ed397113SDavid du Colombier #include "protos.h"
6*ed397113SDavid du Colombier
7*ed397113SDavid du Colombier typedef struct Hdr
8*ed397113SDavid du Colombier {
9*ed397113SDavid du Colombier uchar desc;
10*ed397113SDavid du Colombier } Hdr;
11*ed397113SDavid du Colombier
12*ed397113SDavid du Colombier typedef struct Rc4KeyDesc
13*ed397113SDavid du Colombier {
14*ed397113SDavid du Colombier uchar ln[2];
15*ed397113SDavid du Colombier uchar replay[8];
16*ed397113SDavid du Colombier uchar iv[16];
17*ed397113SDavid du Colombier uchar idx;
18*ed397113SDavid du Colombier uchar md[16];
19*ed397113SDavid du Colombier } Rc4KeyDesc;
20*ed397113SDavid du Colombier
21*ed397113SDavid du Colombier enum
22*ed397113SDavid du Colombier {
23*ed397113SDavid du Colombier HDR= 1, /* sizeof(Hdr) */
24*ed397113SDavid du Colombier RC4KEYDESC= 43, /* sizeof(Rc4KeyDesc) */
25*ed397113SDavid du Colombier
26*ed397113SDavid du Colombier DescTpRC4= 1,
27*ed397113SDavid du Colombier };
28*ed397113SDavid du Colombier
29*ed397113SDavid du Colombier enum
30*ed397113SDavid du Colombier {
31*ed397113SDavid du Colombier Odesc,
32*ed397113SDavid du Colombier };
33*ed397113SDavid du Colombier
34*ed397113SDavid du Colombier static Mux p_mux[] =
35*ed397113SDavid du Colombier {
36*ed397113SDavid du Colombier { "rc4keydesc", DescTpRC4, },
37*ed397113SDavid du Colombier { 0 }
38*ed397113SDavid du Colombier };
39*ed397113SDavid du Colombier
40*ed397113SDavid du Colombier static Mux p_muxrc4[] =
41*ed397113SDavid du Colombier {
42*ed397113SDavid du Colombier { "dump", 0, },
43*ed397113SDavid du Colombier { 0 }
44*ed397113SDavid du Colombier };
45*ed397113SDavid du Colombier
46*ed397113SDavid du Colombier static void
p_compile(Filter * f)47*ed397113SDavid du Colombier p_compile(Filter *f)
48*ed397113SDavid du Colombier {
49*ed397113SDavid du Colombier Mux *m;
50*ed397113SDavid du Colombier
51*ed397113SDavid du Colombier for(m = p_mux; m->name != nil; m++)
52*ed397113SDavid du Colombier if(strcmp(f->s, m->name) == 0){
53*ed397113SDavid du Colombier f->pr = m->pr;
54*ed397113SDavid du Colombier f->ulv = m->val;
55*ed397113SDavid du Colombier f->subop = Odesc;
56*ed397113SDavid du Colombier return;
57*ed397113SDavid du Colombier }
58*ed397113SDavid du Colombier sysfatal("unknown eap_key field or type: %s", f->s);
59*ed397113SDavid du Colombier }
60*ed397113SDavid du Colombier
61*ed397113SDavid du Colombier static int
p_filter(Filter * f,Msg * m)62*ed397113SDavid du Colombier p_filter(Filter *f, Msg *m)
63*ed397113SDavid du Colombier {
64*ed397113SDavid du Colombier Hdr *h;
65*ed397113SDavid du Colombier
66*ed397113SDavid du Colombier if(m->pe - m->ps < HDR)
67*ed397113SDavid du Colombier return 0;
68*ed397113SDavid du Colombier
69*ed397113SDavid du Colombier h = (Hdr*)m->ps;
70*ed397113SDavid du Colombier m->ps += HDR;
71*ed397113SDavid du Colombier
72*ed397113SDavid du Colombier switch(f->subop){
73*ed397113SDavid du Colombier case Odesc:
74*ed397113SDavid du Colombier return h->desc == f->ulv;
75*ed397113SDavid du Colombier }
76*ed397113SDavid du Colombier return 0;
77*ed397113SDavid du Colombier }
78*ed397113SDavid du Colombier
79*ed397113SDavid du Colombier static char*
op(int i)80*ed397113SDavid du Colombier op(int i)
81*ed397113SDavid du Colombier {
82*ed397113SDavid du Colombier static char x[20];
83*ed397113SDavid du Colombier
84*ed397113SDavid du Colombier switch(i){
85*ed397113SDavid du Colombier case DescTpRC4:
86*ed397113SDavid du Colombier return "RC4KeyDesc";
87*ed397113SDavid du Colombier default:
88*ed397113SDavid du Colombier sprint(x, "%1d", i);
89*ed397113SDavid du Colombier return x;
90*ed397113SDavid du Colombier }
91*ed397113SDavid du Colombier }
92*ed397113SDavid du Colombier
93*ed397113SDavid du Colombier static int
p_seprint(Msg * m)94*ed397113SDavid du Colombier p_seprint(Msg *m)
95*ed397113SDavid du Colombier {
96*ed397113SDavid du Colombier Hdr *h;
97*ed397113SDavid du Colombier
98*ed397113SDavid du Colombier if(m->pe - m->ps < HDR)
99*ed397113SDavid du Colombier return -1;
100*ed397113SDavid du Colombier
101*ed397113SDavid du Colombier h = (Hdr*)m->ps;
102*ed397113SDavid du Colombier m->ps += HDR;
103*ed397113SDavid du Colombier
104*ed397113SDavid du Colombier /* next protocol depending on type*/
105*ed397113SDavid du Colombier demux(p_mux, h->desc, h->desc, m, &dump);
106*ed397113SDavid du Colombier
107*ed397113SDavid du Colombier m->p = seprint(m->p, m->e, "desc=%s", op(h->desc));
108*ed397113SDavid du Colombier return 0;
109*ed397113SDavid du Colombier }
110*ed397113SDavid du Colombier
111*ed397113SDavid du Colombier static int
p_seprintrc4(Msg * m)112*ed397113SDavid du Colombier p_seprintrc4(Msg *m)
113*ed397113SDavid du Colombier {
114*ed397113SDavid du Colombier Rc4KeyDesc *h;
115*ed397113SDavid du Colombier int len;
116*ed397113SDavid du Colombier
117*ed397113SDavid du Colombier if(m->pe - m->ps < RC4KEYDESC)
118*ed397113SDavid du Colombier return -1;
119*ed397113SDavid du Colombier
120*ed397113SDavid du Colombier h = (Rc4KeyDesc*)m->ps;
121*ed397113SDavid du Colombier m->ps += RC4KEYDESC;
122*ed397113SDavid du Colombier m->pr = nil;
123*ed397113SDavid du Colombier len = m->pe - m->ps;
124*ed397113SDavid du Colombier
125*ed397113SDavid du Colombier m->p = seprint(m->p, m->e, "keylen=%1d replay=%1d iv=%1d idx=%1d md=%1d",
126*ed397113SDavid du Colombier NetS(h->ln), NetS(h->replay), NetS(h->iv), h->idx, NetS(h->md));
127*ed397113SDavid du Colombier m->p = seprint(m->p, m->e, " dataln=%d", len);
128*ed397113SDavid du Colombier if (len > 0)
129*ed397113SDavid du Colombier m->p = seprint(m->p, m->e, " data=%.*H", len, m->ps);
130*ed397113SDavid du Colombier return 0;
131*ed397113SDavid du Colombier }
132*ed397113SDavid du Colombier
133*ed397113SDavid du Colombier Proto eapol_key =
134*ed397113SDavid du Colombier {
135*ed397113SDavid du Colombier "eapol_key",
136*ed397113SDavid du Colombier p_compile,
137*ed397113SDavid du Colombier p_filter,
138*ed397113SDavid du Colombier p_seprint,
139*ed397113SDavid du Colombier p_mux,
140*ed397113SDavid du Colombier "%lud",
141*ed397113SDavid du Colombier nil,
142*ed397113SDavid du Colombier defaultframer,
143*ed397113SDavid du Colombier };
144*ed397113SDavid du Colombier
145*ed397113SDavid du Colombier Proto rc4keydesc =
146*ed397113SDavid du Colombier {
147*ed397113SDavid du Colombier "rc4keydesc",
148*ed397113SDavid du Colombier p_compile,
149*ed397113SDavid du Colombier nil,
150*ed397113SDavid du Colombier p_seprintrc4,
151*ed397113SDavid du Colombier nil,
152*ed397113SDavid du Colombier nil,
153*ed397113SDavid du Colombier nil,
154*ed397113SDavid du Colombier defaultframer,
155*ed397113SDavid du Colombier };
156