Add initial guess for solving inverse kinematics