CubeSatSim-UTD/gps_client.py at master · syssec-utd/CubeSatSim-UTD · GitHub

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
#! /usr/bin/env python3
"""
example  Python gpsd client
run this way: python3 example1.py.txt
"""

# from https://gpsd.gitlab.io/gpsd/gpsd-client-example-code.html

# this client is for the CubeSatSim Lite which does not have a Pico microcontroller

try:

    import gps               # the gpsd interface module
    import time

    mode = -1
    lat = 0
    lon = 0
    alt = 0

    session = gps.gps(mode=gps.WATCH_ENABLE)

    start = time.perf_counter()

    try:
#        while (session.read() == 0) and ((time.perf_counter() - start) < 2) and (mode < 2):
        while ((time.perf_counter() - start) < 2) and (mode < 2):
            if session.waiting(2.0):
                session.read()

    #        print(gps.MODE_SET)
     #       print(session.valid)
            if (session.valid):
                # not useful, probably not a TPV message
    #            continue

    #        print('Mode: %s(%d) Time: ' %
    #              (("Invalid", "NO_FIX", "2D", "3D")[session.fix.mode],
    #               session.fix.mode), end="")
            # print time, if we have it
#                print("%d " % session.fix.mode, end="")
                if (session.fix.mode > mode):
                    mode = session.fix.mode
        #        if gps.TIME_SET & session.valid:
        #            print(session.fix.time, end="")
        #        else:
        #            print('n/a', end="")

                if gps.isfinite(session.fix.latitude):
                    lat = session.fix.latitude
                if gps.isfinite(session.fix.longitude):
                    lon = session.fix.longitude
                if gps.isfinite(session.fix.altitude):
                    alt = session.fix.altitude
#                print("%.6f %.6f %.6f" % (session.fix.latitude, session.fix.longitude, session.fix.altitude))

    #            else:
    #                print(" 0 0 0")

    except KeyboardInterrupt:
        # got a ^C.  Say bye, bye
        print('')

    # Got ^C, or fell out of the loop.  Cleanup, and leave.
    session.close()
    print("%d %.6f %.6f %.1f" % (mode, lat, lon, alt))
#    exit(0)

except:
    print("-1 0 0 0")
    exit(0)