VZ added

Added gps vertical velocity
This is incorrect. Simply remove this, should be ok.