Allowing throttle to be down during autonomous.

Readback on setpoints. This means that nav setpoints update when changed
in control graph view.

Now they do a good job of defaulting to the right setpoints

Refactored velocity configuration in control algorithm. Made default PID constants the good ones. Corrected the velocity sign. There might be sign errors with the velocity PID constants.