44 lines
1.4 KiB
Python
44 lines
1.4 KiB
Python
#!/usr/bin/python3
|
|
import logging
|
|
import time
|
|
import datetime
|
|
import sys, select
|
|
|
|
from dronekit_server_client import DroneKitComms
|
|
|
|
# class DroneKitComms:
|
|
# def __init__(self) -> None:
|
|
# pass
|
|
# def get_gps(self):
|
|
# return (11.2, 33.2)
|
|
|
|
if __name__ == "__main__":
|
|
FORKLIFT = DroneKitComms()
|
|
gps_file = open(f"gps_log__{datetime.datetime.now().strftime('%H.%M.%S')}.txt", "w+")
|
|
while True:
|
|
time.sleep(0.5)
|
|
current_gps_coords = FORKLIFT.get_gps()
|
|
print(f"Current coords: {current_gps_coords} | s for save and q to exit")
|
|
i, o, e = select.select( [sys.stdin], [], [], 1 )
|
|
if i:
|
|
in_text = sys.stdin.readline().strip()
|
|
print(f"input: {in_text}")
|
|
if in_text in ['s', 'S']:
|
|
print(f"Saving {current_gps_coords}")
|
|
gps_file.writelines([f'{datetime.datetime.now().strftime("%H:%M:%S")} | {{"lat": {current_gps_coords[0]}, "lon": {current_gps_coords[1]}}},\n'])
|
|
elif in_text in ['q', 'Q']:
|
|
print("Quitting...")
|
|
gps_file.close()
|
|
exit(0)
|
|
i = o = e = None
|
|
|
|
|
|
{"lat": 51.5136859, "lon": -1.9877412},
|
|
{"lat": 51.5136561, "lon": -1.9877741},
|
|
{"lat": 51.5135884, "lon": -1.9878123},
|
|
{"lat": 51.5135033, "lon": -1.9878121},
|
|
{"lat": 51.5134414, "lon": -1.9877873},
|
|
{"lat": 51.5133871, "lon": -1.9877211},
|
|
{"lat": 51.5133487, "lon": -1.9876391},
|
|
{"lat": 51.5133224, "lon": -1.9875018}
|