1 87a52e04 2005-12-26 devnull #include <u.h>
2 87a52e04 2005-12-26 devnull #include <libc.h>
3 87a52e04 2005-12-26 devnull #include <ip.h>
4 87a52e04 2005-12-26 devnull #include "dat.h"
5 87a52e04 2005-12-26 devnull #include "protos.h"
7 87a52e04 2005-12-26 devnull typedef struct Hdr Hdr;
8 87a52e04 2005-12-26 devnull struct Hdr {
9 87a52e04 2005-12-26 devnull uchar d[6];
10 87a52e04 2005-12-26 devnull uchar s[6];
11 87a52e04 2005-12-26 devnull uchar type[2];
12 87a52e04 2005-12-26 devnull char data[1500];
14 87a52e04 2005-12-26 devnull #define ETHERMINTU 60 /* minimum transmit size */
15 87a52e04 2005-12-26 devnull #define ETHERMAXTU 1514 /* maximum transmit size */
16 87a52e04 2005-12-26 devnull #define ETHERHDRSIZE 14 /* size of an ethernet header */
18 87a52e04 2005-12-26 devnull static Mux p_mux[] =
20 87a52e04 2005-12-26 devnull {"ip", 0x0800, } ,
21 87a52e04 2005-12-26 devnull {"arp", 0x0806, } ,
22 87a52e04 2005-12-26 devnull {"rarp", 0x0806, } ,
23 87a52e04 2005-12-26 devnull {"ip6", 0x86dd, } ,
24 87a52e04 2005-12-26 devnull {"pppoe_disc", 0x8863, },
25 87a52e04 2005-12-26 devnull {"pppoe_sess", 0x8864, },
26 a38a1836 2006-02-14 devnull {"eapol", 0x888e, },
32 87a52e04 2005-12-26 devnull Os, // source
33 87a52e04 2005-12-26 devnull Od, // destination
34 87a52e04 2005-12-26 devnull Oa, // source or destination
35 87a52e04 2005-12-26 devnull Ot, // type
38 87a52e04 2005-12-26 devnull static Field p_fields[] =
40 87a52e04 2005-12-26 devnull {"s", Fether, Os, "source address", } ,
41 87a52e04 2005-12-26 devnull {"d", Fether, Od, "destination address", } ,
42 87a52e04 2005-12-26 devnull {"a", Fether, Oa, "source|destination address" } ,
43 87a52e04 2005-12-26 devnull {"sd", Fether, Oa, "source|destination address" } ,
44 87a52e04 2005-12-26 devnull {"t", Fnum, Ot, "type" } ,
48 87a52e04 2005-12-26 devnull static void
49 87a52e04 2005-12-26 devnull p_compile(Filter *f)
53 87a52e04 2005-12-26 devnull if(f->op == '='){
54 87a52e04 2005-12-26 devnull compile_cmp(ether.name, f, p_fields);
57 87a52e04 2005-12-26 devnull for(m = p_mux; m->name != nil; m++)
58 87a52e04 2005-12-26 devnull if(strcmp(f->s, m->name) == 0){
59 87a52e04 2005-12-26 devnull f->pr = m->pr;
60 87a52e04 2005-12-26 devnull f->ulv = m->val;
61 87a52e04 2005-12-26 devnull f->subop = Ot;
64 87a52e04 2005-12-26 devnull sysfatal("unknown ethernet field or protocol: %s", f->s);
67 87a52e04 2005-12-26 devnull static int
68 87a52e04 2005-12-26 devnull p_filter(Filter *f, Msg *m)
72 87a52e04 2005-12-26 devnull if(m->pe - m->ps < ETHERHDRSIZE)
73 87a52e04 2005-12-26 devnull return 0;
75 87a52e04 2005-12-26 devnull h = (Hdr*)m->ps;
76 87a52e04 2005-12-26 devnull m->ps += ETHERHDRSIZE;
78 87a52e04 2005-12-26 devnull switch(f->subop){
80 87a52e04 2005-12-26 devnull return !memcmp(h->s, f->a, 6);
82 87a52e04 2005-12-26 devnull return !memcmp(h->d, f->a, 6);
84 87a52e04 2005-12-26 devnull return memcmp(h->s, f->a, 6) == 0 || memcmp(h->d, f->a, 6) == 0;
86 87a52e04 2005-12-26 devnull return NetS(h->type) == f->ulv;
88 87a52e04 2005-12-26 devnull return 0;
91 87a52e04 2005-12-26 devnull static int
92 87a52e04 2005-12-26 devnull p_seprint(Msg *m)
98 87a52e04 2005-12-26 devnull len = m->pe - m->ps;
99 87a52e04 2005-12-26 devnull if(len < ETHERHDRSIZE)
100 87a52e04 2005-12-26 devnull return -1;
102 87a52e04 2005-12-26 devnull h = (Hdr*)m->ps;
103 87a52e04 2005-12-26 devnull m->ps += ETHERHDRSIZE;
105 87a52e04 2005-12-26 devnull t = NetS(h->type);
106 87a52e04 2005-12-26 devnull demux(p_mux, t, t, m, &dump);
108 87a52e04 2005-12-26 devnull m->p = seprint(m->p, m->e, "s=%E d=%E pr=%4.4ux ln=%d", h->s, h->d,
109 87a52e04 2005-12-26 devnull t, len);
110 87a52e04 2005-12-26 devnull return 0;
113 87a52e04 2005-12-26 devnull Proto ether =
115 87a52e04 2005-12-26 devnull "ether",
116 87a52e04 2005-12-26 devnull p_compile,
117 87a52e04 2005-12-26 devnull p_filter,
118 87a52e04 2005-12-26 devnull p_seprint,
120 a38a1836 2006-02-14 devnull "%#.4lux",
121 87a52e04 2005-12-26 devnull p_fields,
122 87a52e04 2005-12-26 devnull defaultframer