Velocity based gain adjustment based on dynamic presssure

This adds dynamic adjustment of stabilization gains based on the dynamic pressure.