max/new_thea
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Update

Browse Source
This commit is contained in:
Max 2021-09-21 13:12:20 +01:00
parent 62425d4e6f
commit f3ecc67c8d
1 changed files with 9 additions and 8 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

17
Control/Jetson/main.py
View File

@ -42,14 +42,15 @@ executor_logger.setLevel(logging.DEBUG)
#--- <Pseudoprivate methods
def __go_to_gps_waypoints(vehicle_ctrl, waypoints: list):
for ix, waypoint in enumerate(waypoints):
target_lat = waypoint['lat']
target_lon = waypoint['lon']
executor_logger.info(f"Going to waypoint {ix} at lat: {target_lat}, lon: {target_lon}")
success = __go_to_gps(vehicle_ctrl, lat=target_lat, lon=target_lon)
if not success:
executor_logger.error("Navigate to gps watpoint func returned error, chack logs, aborting")
return False
if len(waypoints) > 0:
for ix, waypoint in enumerate(waypoints):
target_lat = waypoint['lat']
target_lon = waypoint['lon']
executor_logger.info(f"Going to waypoint {ix} at lat: {target_lat}, lon: {target_lon}")
success = __go_to_gps(vehicle_ctrl, lat=target_lat, lon=target_lon)
if not success:
executor_logger.error("Navigate to gps watpoint func returned error, chack logs, aborting")
return False
return True
def __go_to_gps(vehicle_ctrl, lat: float, lon: float):