forward kinematics chapter bug fixes