Changed all PID controllers to use PIDController_Claire library. Added PID for outer speed to angle setpoint loop.