Hello,
I am having a lot of troubles with Denavit Hartenberg parameters (used as a way to describe a kinematics chain made of revolute and prismatic joints) in an IK program. I am trying to compute the forward kinematics for a PUMA type robot arm and while I can get the good position for the first 3 links, the 4th one isn’t working as expected.
In more detail, I use the following DH parameters :
Link# Twist Length Offset Angle
1 0 0 0.5 0
2 -90 0 0 0
3 0 0.5 0.1 0
4 -90 0 0.4 0
5 90 0 0 0
6 -90 0 0 0
If I compute the matrix that give the position/orientation of the fourth link in the frame of the first link, I get the following position :
(0.5, 0.5, 0.5)
The “X” position is accurate, the “Y” isn’t and the “Z” isn’t either. The “Y” should be 0.1 and the “Z” should be 0.1. So it seems that the 0.4 length of the second part of the arm is going on the “wrong axis”, but I have no idea why : not only do the parameters look correct but I have found many different sources giving about the same…
So… This post is a cry for help for anyone comfortable enough with DH to see what is wrong !
Thank you ~
Guillaume