Cleaned up and removed overshoot code, removed extra ros_param call for pid_gains.