Fix recalc bugs associated with vtol state, speed, vehicle/gimbal yaw