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
|
#!/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)>2:
if sys.argv[2]=="-D" or sys.argv[2]=="-d":
debug=True
print "wim: DEBUG mode"
if len(sys.argv)>3:
if sys.argv[3]=="-T" or sys.argv[3]=="-t":
test=True
print "wim: gps TEST mode"
doc=xml2obj(open(sys.argv[1]))
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 gpsp.fix>1:
gpsfix=True
outsock.sendto( "gps status 1\n", (PD_IP, PD_PORT) )
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) )
time.sleep(1.0)
|
