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

jacobian of manipulator with fixed base #96

Open
AlessiaFusco99 opened this issue Aug 26, 2024 · 1 comment
Open

jacobian of manipulator with fixed base #96

AlessiaFusco99 opened this issue Aug 26, 2024 · 1 comment

Comments

@AlessiaFusco99
Copy link

Hi,
I am trying to use the jacobian_fun on an arm with seven degrees of freedom. As the manipulator has a fixed base the jacobian should have a dimension of 6x7 but I obtained a 6x13 matrix, could you suggest to me how I can fix the issue?
This is the code I am currently using.
Thank you.


import casadi as cs
from adam.casadi import KinDynComputations
import numpy as np

file_id = "human_arm.urdf"
root_link = "RightUpperArm_f1"
joints_names_list = ["jRightShoulder_rotx", "jRightShoulder_roty",
                     "jRightShoulder_rotz", "jRightElbow_rotx",
                     "jRightWrist_rotx", "jRightWrist_roty", "jRightWrist_rotz"]
kindyn = KinDynComputations(urdfstring=file_id, joints_name_list=joints_names_list, root_link=root_link)
frame = 'RightHand'
base_transform = np.eye(4)
J_fun = kindyn.jacobian_fun(frame)
q = [cs.SX.sym(f'q{i+1}') for i in range(7)]  # joint angles
J = J_fun( base_transform, cs.vertcat(*q[6:]))
@traversaro
Copy link
Contributor

You can just drop the first six columns, see #77 (comment) for more details on this.

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

3 participants
@traversaro @AlessiaFusco99 and others