Skip to content
New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

Sequence Aborted with error 0:SUB_ERROR_NONE #202

Open
Louis2099 opened this issue Aug 25, 2024 · 5 comments
Open

Sequence Aborted with error 0:SUB_ERROR_NONE #202

Louis2099 opened this issue Aug 25, 2024 · 5 comments

Comments

@Louis2099
Copy link

HI I'm student using kinova kortex python API on a gen3 7dof robot arm, my settings are listed as following:
kortex 2.6.0.post3
frimware 2.5.2-1

The problem I've been experiencing is that, I'm using the sequence example "api_python/examples/102-Movement_high_level/02-sequence.py" by adding a series of "move to Cartesian position" actions, following is one of my example trajectories:
"""
example_traj = ([0.28747064, 0.04720456, 1.03254818]),
np.array([0.40148122, 0.01917565, 0.96486813]),
np.array([ 0.52025528, -0.02537908, 0.86594063]),
np.array([ 0.63002006, -0.08680653, 0.72415356]),
np.array([ 0.70775769, -0.16291518, 0.53187928]),
np.array([ 0.72229969, -0.24377655, 0.29120655]),
np.array([ 0.55527246, -0.35700423, 0.15574953])
"""
But I always got error message that shows:
"Sequence aborted with error 0:SUB_ERROR_NONE"

I cannot find useful information to resolve the issue, my guess is that the trajectory has certain kind of limitations, thus not all action sequences can be executed?

I'd be appreciated if you can help resolve this issue.

@martinleroux
Copy link
Collaborator

Hi @Louis2099 ,

There is currently a known bug which causes this that we unfortunately have yet to find a solution for, but we hope to solve for our next firmware release. In most cases, this happens at apparently random moments, after a few hours running. Is this the case for you? Does the error always seem to trigger at the same place in your sequence?

@Louis2099
Copy link
Author

For the example trajectory, the sequence is aborted at the beginning, so the arm is not able to perform any action.
And now the problem is persistent, despite rebooting the robot sequence still gets aborted every time.

@martinleroux
Copy link
Collaborator

What if you delete the very first point in your trajectory?
Also, are you sure the poses you are commanding are reachable by the robot? Is the gripper configured as installed? (this adds a Z component to the TCP which can make a pose reachable with a gripper but unreachable without).

What is the robot's starting pose when launching this sequence?
Can you play the trajectory backwards?

@Louis2099
Copy link
Author

The robot cannot execute individual waypoint, it shows executing action but never complete it, I assume the reason is the tool_pose and tool_theta cannot be met at the same time, I defined actions in following manner:
cartesian_pose = action.reach_pose.target_pose
cartesian_pose.x = control[0] # (meters)
cartesian_pose.y = control[1] # (meters)
cartesian_pose.z = control[2] # (meters)
cartesian_pose.theta_x = control_theta[0] # (degrees)
cartesian_pose.theta_y = control_theta[1] # (degrees)
cartesian_pose.theta_z = control_theta[2] # (degrees)
in the example trajectory for the first waypoint theta is set to [179.44644165039062, -0.06476558744907379, 90.08074951171875], and position is [0.28747064, 0.04720456, 1.03254818].
if this is causing the stall, I wanna ask it there way that define a trajectory action sequence without explicitly define the tool_theta, or is there a tool_theta value that fits all position.

@martinleroux
Copy link
Collaborator

With this orientation, there is no way the robot can reach a Z position of 1 m. This is very much out of the workspace of the robot. You can see this by trying to reach the pose using the joystick or hand-guiding.

Keeping the pose [0.287, 0.047, Z, 179, 0, 90], the maximum value of Z I can obtain on a robot is 0.583 (with a Robotiq 2F-85 pointing downwards). This makes the first three points in your trajectory unreachable.

The next points are also not reachable with this orientation. With X~0.7, the maximum Z value is around 0.21. And even then, the robot is essentially parked in an elbow singularity

So, in summary, your entire trajectory, with the exception of the very last point, is outside of the workspace of the robot. I suggest you check manually or with a simulator if your targets are reachable when you do your planning.

Hope this helps.

Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
None yet
Projects
None yet
Development

No branches or pull requests

2 participants