INS/GPS Navigation Accuracy Improvement With Nonholonomic Constraints