Updated open loop speed control to be correct