baro height locked,but yaw not stable, also errors in baro height