Fixed bug for the forward kinematics approach