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