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

Forward Kinematics matrix obtained using fkine method for a model created using DH Table has different values compared to analytical derivations #429

Open
anshul-hri opened this issue Apr 6, 2024 · 0 comments

Comments

@anshul-hri
Copy link

Hi,

I was working on creating a 4DOF anthromorphic exoskeleton model using the DH Link. I have attached the arm model below. I face discrepancy between what robotic tool box symbolically computes the forward kinematics for end effector using fkine to that of the analytic equations as provided by the paper Link . Below the code, I have compared both the symbolic expressions for forward kinematics as computed by (a) robotics tool box fkine method (b) analytical from paper

       # Dynamic Parameters:
        mass = [1.38, 0.88]
        I = [0.015, 0.013]
        length = [0.33, 0.37]
  

        L = [
            RevoluteDH(
                d = 0,
                a = 0,
                alpha = pi/2,
                offset = pi/2,
                flip = True,
            ),

            RevoluteDH(
                d = length[0],
                a = 0,
                alpha = pi/2,
                offset = pi,
            ),

            RevoluteDH(
                d = 0,
                a = 0,
                alpha = -pi/2,
            ),

            RevoluteDH(
                d = length[1],
                a = 0,
                alpha = 0,
  
            ),

        ]

        super().__init__(
            L,
            name="human_arm_4DOF",
            manufacturer="",
            keywords=("dynamics", "symbolic", "mesh"),
            symbolic=symbolic,
            meshdir="",
        )

Robotics tool box fkine:

 1st rotation term : T[0] = (sin(q_0)*cos(q_1)*cos(q_2) + sin(q_2)*cos(q_0))*cos(q_3) - sin(q_0)*sin(q_1)*sin(q_3)

Analytical paper equation:

cos(q3) * (sin(q0) * sin(q2) + cos(q0) * cos(q1) * cos(q2)) − cos(q0) * sin(q1) * sin(q3)  

can anyone help me with this query, Do I need to modify the D-H table from what the paper presents when I use that in roboticstoolbox, because I have faced similar issues with other models as well ?

Regards
Anshul

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

1 participant