Fix gyro measurement noise variance
Hotfix missing yaw deadzone default (leads to continuous turns since zero speed is never commanded)