diff --git a/python/ur_simple_control/basics/basics.py b/python/ur_simple_control/basics/basics.py index 25985b2996051ce85b3106a346f202be91f7d093..20189aba72e996c68b77df0fa2e23b97744c7b39 100644 --- a/python/ur_simple_control/basics/basics.py +++ b/python/ur_simple_control/basics/basics.py @@ -25,7 +25,9 @@ def moveJControlLoop(q_desired, robot, i, past_data): q = q[:6] q_error = q_desired - q - if np.linalg.norm(q_error) < 1e-4: + # STOP MUCH BEFORE YOU NEED TO + # EVEN THIS MIGHT BE TOO MUCH + if np.linalg.norm(q_error) < 1e-1: breakFlag = True # stupid hack, for the love of god remove this # but it should be small enough lel