modified forward kinematics example