1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
|
#include <u.h>
#include <libc.h>
#include <ip.h>
#include "dat.h"
#include "protos.h"
typedef struct {
uchar res;
uchar cmd;
uchar ea[6];
} Hdr;
enum {
Ocmd,
Oea,
Hsize = 8,
};
static Field p_fields[] = {
{"cmd", Fnum, Ocmd, "command", },
{"ea", Fnum, Oea, "ethernet addr", },
nil
};
static void
p_compile(Filter *f)
{
if(f->op == '='){
compile_cmp(aoemd.name, f, p_fields);
return;
}
sysfatal("unknown aoemd field: %s", f->s);
}
static int
p_filter(Filter *f, Msg *m)
{
uchar buf[6];
int i;
Hdr *h;
if(m->pe - m->ps < Hsize)
return 0;
h = (Hdr*)m->ps;
m->ps += Hsize;
switch(f->subop){
case Ocmd:
return h->cmd == f->ulv;
case Oea:
for(i = 0; i < 6; i++)
buf[i] = f->ulv >> ((5 - i)*8);
return memcmp(buf, h->ea, 6) == 0;
}
return 0;
}
static char *ctab[] = {
" ",
" +",
" -",
};
static int
p_seprint(Msg *m)
{
char *s;
Hdr *h;
if(m->pe - m->ps < Hsize)
return 0;
h = (Hdr*)m->ps;
m->ps += Hsize;
/* no next protocol */
m->pr = nil;
s = "unk";
if(h->cmd < nelem(ctab))
s = ctab[h->cmd];
m->p = seprint(m->p, m->e, "cmd=%d%s ea=%E\n", h->cmd, s, h->ea);
return 0;
}
Proto aoemd = {
"aoemd",
p_compile,
p_filter,
p_seprint,
nil,
nil,
p_fields,
defaultframer,
};
|
