Added velocity adjustment to stabilization.
Merge pull request #266 from jgoppert/vel_adjust

Velocity based gain adjustment based on dynamic presssure