/
gpstcp.go
115 lines (97 loc) · 2.1 KB
/
gpstcp.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
103
104
105
106
107
108
109
110
111
112
113
114
115
/*
Package implements a binary for read serial port nmea.
*/
package gpsnmea
import (
"bufio"
"log"
"net"
"strings"
"time"
)
type DeviceTCP struct {
server net.Listener
// filter []string
ok bool
}
const (
timeoutDeadLine = 20 * time.Second
)
func NewDeviceTCP(socket string) (*DeviceTCP, error) {
log.Println("listen server ...")
// sentencesFilter := make([]string, 0)
// sentencesFilter = append(sentencesFilter, filters...)
server, err := net.Listen("tcp", socket)
if err != nil {
return nil, err
}
dev := &DeviceTCP{
// conn: conn,
server: server,
// filter: sentencesFilter,
ok: false,
}
log.Println("create server TCP!")
return dev, nil
}
func (dev *DeviceTCP) Accept() (net.Conn, error) {
tcplistener := dev.server.(*net.TCPListener)
tcplistener.SetDeadline(time.Now().Add(timeoutDeadLine))
conn, err := dev.server.Accept()
if err != nil {
log.Println(err)
return nil, err
}
dev.ok = true
return conn, nil
}
func (dev *DeviceTCP) Close() bool {
dev.ok = false
if err := dev.server.Close(); err != nil {
log.Println(err)
return false
}
return true
}
func ReadTCP(conn net.Conn, filters ...string) chan string {
sentencesFilter := make([]string, 0)
sentencesFilter = append(sentencesFilter, filters...)
// if !dev.ok {
// log.Println("Device server gps is closed")
// return nil
// }
// tcplistener := dev.server.(*net.TCPListener)
// tcplistener.SetDeadline(time.Now().Add(timeoutDeadLine))
// conn, err := dev.server.Accept()
// if err != nil {
// return nil
// }
ch := make(chan string)
//buf := make([]byte, 128)
countError := 0
go func() {
defer close(ch)
bf := bufio.NewReader(conn)
for {
conn.SetDeadline(time.Now().Add(timeoutDeadLine))
b, err := bf.ReadBytes('\n')
if err != nil {
log.Println(err)
if countError > 3 {
conn.Close()
return
}
time.Sleep(1 * time.Second)
countError++
continue
}
data := string(b[:])
//log.Printf("serial reading: %q\n", data)
if isSentence(data, sentencesFilter) {
ch <- strings.TrimSpace(data)
}
}
}()
log.Println("reading conn")
return ch
}