For the navigation algorithm of the strapdown inertial navigation system, by comparing to the equations of the dual quaternion and quaternion, the superiority of the attitude algorithm based on dual quaternion over th...For the navigation algorithm of the strapdown inertial navigation system, by comparing to the equations of the dual quaternion and quaternion, the superiority of the attitude algorithm based on dual quaternion over the ones based on rotation vector in accuracy is analyzed in the case of the rotation of navigation frame. By comparing the update algorithm of the gravitational velocity in dual quaternion solution with the compensation algorithm of the harmful acceleration in traditional velocity solution, the accuracy advantage of the gravitational velocity based on dual quaternion is addressed. In view of the idea of the attitude and velocity algorithm based on dual quaternion, an improved navigation algorithm is proposed, which is as much as the rotation vector algorithm in computational complexity. According to this method, the attitude quaternion does not require compensating as the navigation frame rotates. In order to verify the correctness of the theoretical analysis, simulations are carried out utilizing the software, and the simulation results show that the accuracy of the improved algorithm is approximately equal to the dual quaternion algorithm.展开更多
Gravity/inertial combination navigation is a leading issue in realizing passive navigation onboard a submarine. A new rotation-fitting gravity matching algorithm, based on the Terrain Contour Matching (TERCOM) algorit...Gravity/inertial combination navigation is a leading issue in realizing passive navigation onboard a submarine. A new rotation-fitting gravity matching algorithm, based on the Terrain Contour Matching (TERCOM) algorithm, is proposed in this paper. The algorithm is based on the principle of least mean-square-error criterion, and searches for a certain matched trajectory that runs parallel to a trace indicated by an inertial navigation system on a gravity base map. A rotation is then made clockwise or counterclockwise through a certain angle around the matched trajectory to look for an optimal matched trajectory within a certain angle span range, and through weighted fitting with another eight suboptimal matched trajectories, the endpoint of the fitted trajectory is considered the optimal matched position. In analysis of the algorithm reliability and matching error, the results from simulation indicate that the optimal position can be obtained effectively in real time, and the positioning accuracy improves by 35% and up to 1.05 nautical miles using the proposed algorithm compared with using the widely employed TERCOM and SITAN methods. Current gravity-aided navigation can benefit from implementation of this new algorithm in terms of better reliability and positioning accuracy.展开更多
基金supported by the National Natural Science Foundation of China (No. 61174126)
文摘For the navigation algorithm of the strapdown inertial navigation system, by comparing to the equations of the dual quaternion and quaternion, the superiority of the attitude algorithm based on dual quaternion over the ones based on rotation vector in accuracy is analyzed in the case of the rotation of navigation frame. By comparing the update algorithm of the gravitational velocity in dual quaternion solution with the compensation algorithm of the harmful acceleration in traditional velocity solution, the accuracy advantage of the gravitational velocity based on dual quaternion is addressed. In view of the idea of the attitude and velocity algorithm based on dual quaternion, an improved navigation algorithm is proposed, which is as much as the rotation vector algorithm in computational complexity. According to this method, the attitude quaternion does not require compensating as the navigation frame rotates. In order to verify the correctness of the theoretical analysis, simulations are carried out utilizing the software, and the simulation results show that the accuracy of the improved algorithm is approximately equal to the dual quaternion algorithm.
基金supported by National Natural Science Foundation of China (Grant Nos. 41074051, 41021003 and 40874037)
文摘Gravity/inertial combination navigation is a leading issue in realizing passive navigation onboard a submarine. A new rotation-fitting gravity matching algorithm, based on the Terrain Contour Matching (TERCOM) algorithm, is proposed in this paper. The algorithm is based on the principle of least mean-square-error criterion, and searches for a certain matched trajectory that runs parallel to a trace indicated by an inertial navigation system on a gravity base map. A rotation is then made clockwise or counterclockwise through a certain angle around the matched trajectory to look for an optimal matched trajectory within a certain angle span range, and through weighted fitting with another eight suboptimal matched trajectories, the endpoint of the fitted trajectory is considered the optimal matched position. In analysis of the algorithm reliability and matching error, the results from simulation indicate that the optimal position can be obtained effectively in real time, and the positioning accuracy improves by 35% and up to 1.05 nautical miles using the proposed algorithm compared with using the widely employed TERCOM and SITAN methods. Current gravity-aided navigation can benefit from implementation of this new algorithm in terms of better reliability and positioning accuracy.
