Remove vel reset
Merge pull request #1520 from mhkabir/inav_fix

Remove velocity reset