Replaced sqrt(x**2+y**2) with hypot in PathTracking/rear_wheel_feedback/rear_wheel_feedback.py

This commit is contained in:
Guillaume Jacquenot
2019-12-07 22:14:48 +01:00
parent 02f14e425e
commit 41bcdf8573

View File

@@ -136,7 +136,7 @@ def closed_loop_prediction(cx, cy, cyaw, ck, speed_profile, goal):
# check goal # check goal
dx = state.x - goal[0] dx = state.x - goal[0]
dy = state.y - goal[1] dy = state.y - goal[1]
if math.sqrt(dx ** 2 + dy ** 2) <= goal_dis: if math.hypot(dx, dy) <= goal_dis:
print("Goal") print("Goal")
goal_flag = True goal_flag = True
break break