mirror of
https://github.com/AtsushiSakai/PythonRobotics.git
synced 2026-04-22 03:00:41 -04:00
Replaced sqrt(x**2+y**2) with hypot in PathTracking/lqr_speed_steer_control/lqr_speed_steer_control.py
This commit is contained in:
@@ -212,7 +212,7 @@ def do_simulation(cx, cy, cyaw, ck, speed_profile, goal):
|
||||
# check goal
|
||||
dx = state.x - goal[0]
|
||||
dy = state.y - goal[1]
|
||||
if math.sqrt(dx ** 2 + dy ** 2) <= goal_dis:
|
||||
if math.hypot(dx, dy) <= goal_dis:
|
||||
print("Goal")
|
||||
break
|
||||
|
||||
|
||||
Reference in New Issue
Block a user