-
Notifications
You must be signed in to change notification settings - Fork 1
/
Copy pathcommu_multi.py
46 lines (39 loc) · 1.11 KB
/
commu_multi.py
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
import time
import serial
import string
import pynmea2
import threading
import RPi.GPIO as gpio
import rockBlock
from rockBlock import rockBlockProtocol
class Iridium (rockBlockProtocol):
def write(self, msg):
rb = rockBlock.rockBlock("/dev/ttyS0", self)
rb.sendMessage(msg)
rb.close()
def rockBlockTxFailed(self):
print "RockBlockTxFailed"
def rockBlockTxSuccess(self, momsn):
print "rockBLockTxSuccess " + str(momsn)
def Subthread(ini, top, GPS_ser):
i = 0
while i<5:
data = GPS_ser.readline()
if data[0:6] == '$GPGGA':
msg = pynmea2.parse(data)
latval = str(msg.lat)
concatlat = "lat:" + str(latval)
longval = str(msg.lon)
print data
tmp = str(i) + " xx " +latval+" yy "+longval
Iridium().write(tmp)
i += 1
GPS_port = "/dev/ttyUSB0"
GPS_ser = serial.Serial(GPS_port, baudrate = 9600, timeout = 0.5)
t = threading.Thread(target = Subthread, args = (1, 100, GPS_ser))
t.start()
flag = 0
while 1:
time.sleep(1)
flag += 1
print("MainMain")