An improved filter for high order integrated GPS/INS based on the U-D factorization