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
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
|
#!/usr/bin/python
#UDP listener
import signal,sys
def signal_handler(signal, frame):
insock.close()
print "wim: tomorrowtheground: interrupted"
sys.exit(0)
signal.signal(signal.SIGINT, signal_handler)
from latLng import *
from layers import *
from xml2obj import *
if len(sys.argv)<2:
print "wim: usage: tomorrowtheground configfile [-D] (debug)][-T] (test)]"
debug=False
test=False
if len(sys.argv)>1:
if sys.argv[1]=="-D" or sys.argv[1]=="-d":
debug=True
print "wim: DEBUG mode"
if len(sys.argv)>2:
if sys.argv[2]=="-T" or sys.argv[2]=="-t":
test=True
print "wim: gps TEST mode"
doc=xml2obj(open(sys.argv[0]))
gpslayers=[]
#catch invalid xml
try:
for i in doc.gps.index:
#catch invalid xml
try:
g=indexlayer(i.file,i.ll1,i.ll2)
for t in i.trigger:
g.triggers.append(trigger(int(t.id),t.command,t.param))
gpslayers.append(g)
except:
print "wim: error parsing xml index entry"
except:
print "wim: no index layers found"
#catch invalid xml
try:
for i in doc.gps.scale:
#catch invalid xml
try:
g=scalelayer(i.file,i.ll1,i.ll2)
g.setcommand(i.command)
gpslayers.append(g)
except:
print "wim: error parsing xml index entry"
except:
print "wim: no scale layers found"
from gpspoller import *
gpsp=""
try:
gpsp = GpsPoller(doc.gpsdevice,test)
gpsp.start()
except:
print "wim: gps device not found"
from btscan import *
scan=scanner("127.0.0.1",5401,False)
for t in doc.bt.trigger:
scan.d.dm.triggers[t.id]=(t.command,t.param)
scan.start()
import socket
GUI_IP="0.0.0.0"
GUI_PORT=5400
insock = socket.socket( socket.AF_INET, socket.SOCK_DGRAM )
insock.bind( (GUI_IP,GUI_PORT) )
insock.settimeout(0.05) #non blocking, this sets the frame rate of checking
PD_IP="127.0.0.1"
PD_PORT=5401
outsock = socket.socket( socket.AF_INET,socket.SOCK_DGRAM )
pos=latLng()
posChanged=False
gpsfix=False
while True:
data=""
try:
data, addr = insock.recvfrom(128)
pos.parse(data)
if debug==True:
print "wim: received:",data
posChanged=True
except:
nothing=None
if gpsp!="": #gps available
if not gpsfix:
if gpsp.fix>1:
gpsfix=True
outsock.sendto( "gps status 1\n", (PD_IP, PD_PORT) )
if gpsfix:
if gpsp.fix<2:
gpsfix=False
outsock.sendto( "gps status 0\n", (PD_IP, PD_PORT) )
check=gpsp.check()
if check!=False:
if debug==True:
print "wim: received from gps",check[0],check[1]
outsock.sendto("gps data"+str(check[0])+" "+str(check[1])+"\n",(PD_IP, PD_PORT) )
pos=latLng(check[0],check[1])
posChanged=True
if posChanged:
posChanged=False
for layer in gpslayers:
r=layer.checkcoord(pos) #returns a message or None
if r!=None:
if debug==True:
print "wim: sending:",str(r[0]),str(r[1])
#pd needs \n at end of message
outsock.sendto( str(r[0])+' '+str(r[1])+'\n', (PD_IP, PD_PORT) )
|
