Skip to content
Snippets Groups Projects
Commit 9d938cf5 authored by m-guberina's avatar m-guberina
Browse files

this should be the fix. i am 100% on this. just move it closer and it will work

parent de140127
No related branches found
No related tags found
No related merge requests found
THERE WAS A NORM IN THE ERROR TERM IN MOVEJ THAT'S WHY IT KEPT GOING FORWARD
GOD DAMN IT
thank you jesus for showing me that one, good lord thank you
1. i'm pretty sure why it goes so far with movej is because you gave it a tight error. 1. i'm pretty sure why it goes so far with movej is because you gave it a tight error.
well, give it a lax error then. atm there is a single instance where you're running this command, well, give it a lax error then. atm there is a single instance where you're running this command,
so it's fine, you cares. bottom line is, be above the starting point, and then go down with so it's fine, you cares. bottom line is, be above the starting point, and then go down with
......
...@@ -25,13 +25,15 @@ def moveJControlLoop(q_desired, robot, i, past_data): ...@@ -25,13 +25,15 @@ def moveJControlLoop(q_desired, robot, i, past_data):
q = q[:6] q = q[:6]
q_error = q_desired - q q_error = q_desired - q
# STOP MUCH BEFORE YOU NEED TO # STOP MUCH BEFORE YOU NEED TO FOR THE DEMO
# EVEN THIS MIGHT BE TOO MUCH # EVEN THIS MIGHT BE TOO MUCH
if np.linalg.norm(q_error) < 1e-1: # TODO fix later obviously
if np.linalg.norm(q_error) < 1e-3:
breakFlag = True breakFlag = True
# stupid hack, for the love of god remove this # stupid hack, for the love of god remove this
# but it should be small enough lel # but it should be small enough lel
qd = q_error / (np.linalg.norm(q_error) *14) # there. fixed. tko radi taj i grijesi, al jebemu zivot sta je to bilo
qd = q_error * robot.dt
robot.sendQd(qd) robot.sendQd(qd)
return breakFlag, {}, {} return breakFlag, {}, {}
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Please register or to comment