forked from sampork/go-sniffer
/
dispatch.go
102 lines (86 loc) · 2.19 KB
/
dispatch.go
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
98
99
100
101
102
package core
import (
"fmt"
"github.com/google/gopacket"
"github.com/google/gopacket/layers"
"github.com/google/gopacket/pcap"
"github.com/google/gopacket/tcpassembly"
"github.com/google/gopacket/tcpassembly/tcpreader"
"log"
"time"
)
type Dispatch struct {
device string
payload []byte
Plug *Plug
}
func NewDispatch(plug *Plug, cmd *Cmd) *Dispatch {
return &Dispatch {
Plug: plug,
device:cmd.Device,
}
}
func (d *Dispatch) Capture() {
//init device
handle, err := pcap.OpenLive(d.device, 65535, false, pcap.BlockForever)
if err != nil {
log.Fatal(err)
return
}
//set filter
fmt.Println(d.Plug.BPF)
err = handle.SetBPFFilter(d.Plug.BPF)
if err != nil {
log.Fatal(err)
}
//capture
src := gopacket.NewPacketSource(handle, handle.LinkType())
packets := src.Packets()
//set up assembly
streamFactory := &ProtocolStreamFactory{
dispatch:d,
}
streamPool := NewStreamPool(streamFactory)
assembler := NewAssembler(streamPool)
ticker := time.Tick(time.Minute)
//loop until ctrl+z
for {
select {
case packet := <-packets:
if packet.NetworkLayer() == nil ||
packet.TransportLayer() == nil ||
packet.TransportLayer().LayerType() != layers.LayerTypeTCP {
fmt.Println("ERR : Unknown Packet -_-")
continue
}
tcp := packet.TransportLayer().(*layers.TCP)
assembler.AssembleWithTimestamp(
packet.NetworkLayer().NetworkFlow(),
tcp, packet.Metadata().Timestamp,
)
case <-ticker:
assembler.FlushOlderThan(time.Now().Add(time.Minute * -2))
}
}
}
type ProtocolStreamFactory struct {
dispatch *Dispatch
}
type ProtocolStream struct {
net, transport gopacket.Flow
r tcpreader.ReaderStream
}
func (m *ProtocolStreamFactory) New(net, transport gopacket.Flow) tcpassembly.Stream {
//init stream struct
stm := &ProtocolStream {
net: net,
transport: transport,
r: tcpreader.NewReaderStream(),
}
//new stream
fmt.Printf("\n%s %s:%s->%s:%s\n", time.Now().Format("2006-01-02 15:04:05.000000"), net.Src().String(), transport.Src().String(), net.Dst().String(), transport.Dst().String())
fmt.Println("# Start new stream")
//decode packet
go m.dispatch.Plug.ResolveStream(net, transport, &(stm.r))
return &(stm.r)
}