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.展开更多
In this paper, we first introduce a concept of companion vector, and studythe Jordan canonical forms of quaternion matrices by using the methods of complex representation and companion vector, not only give out a prac...In this paper, we first introduce a concept of companion vector, and studythe Jordan canonical forms of quaternion matrices by using the methods of complex representation and companion vector, not only give out a practical algorithm for Jordancanonical form J of a quaternion matrix A, but also provide a practical algorithm forcorresponding nonsingular matrix P with P- 1 AP = J.展开更多
Quatemions complementary filter attitude algorithm was conducted on the unmanned aerial vehicle （UAV） platform. This introduces traditional attitude algorithm and attitude quaternion complementary filter algorithm d...Quatemions complementary filter attitude algorithm was conducted on the unmanned aerial vehicle （UAV） platform. This introduces traditional attitude algorithm and attitude quaternion complementary filter algorithm difference, and the attitude quatemion complementary filter algorithm realization are introduced in details展开更多
An iterative method is introduced successfully to solve the inverse kinematics of a 6-DOF manipulator of a tunnel drilling rig based on dual quaternion, which is difficult to get the solution by Denavit-Hartenberg(D-H...An iterative method is introduced successfully to solve the inverse kinematics of a 6-DOF manipulator of a tunnel drilling rig based on dual quaternion, which is difficult to get the solution by Denavit-Hartenberg(D-H) based methods. By the intuitive expression of dual quaternion to the orientation of rigid body, the coordinate frames assigned to each joint are established all in the same orientation, which does not need to use the D-H procedure. The compact and simple form of kinematic equations, consisting of position equations and orientation equations, is also the consequence of dual quaternion calculations. The iterative process is basically of two steps which are related to solving the position equations and orientation equations correspondingly. First, assume an initial value of the iterative variable; then, the position equations can be solved because of the reduced number of unknown variables in the position equations and the orientation equations can be solved by applying the solution from the position equations, which obtains an updated value for the iterative variable; finally, repeat the procedure by using the updated iterative variable to the position equations till the prescribed accuracy is obtained. The method proposed has a clear geometric meaning, and the algorithm is simple and direct. Simulation for 100 poses of the end frame shows that the average running time of inverse kinematics calculation for each demanded pose of end-effector is 7.2 ms on an ordinary laptop, which is good enough for practical use. The iteration counts 2-4 cycles generally, which is a quick convergence. The method proposed here has been successfully used in the project of automating a hydraulic rig.展开更多
A gradient descent algorithm with adjustable parameter for attitude estimation is developed,aiming at the attitude measurement for small unmanned aerial vehicle(UAV)in real-time flight conditions.The accelerometer and...A gradient descent algorithm with adjustable parameter for attitude estimation is developed,aiming at the attitude measurement for small unmanned aerial vehicle(UAV)in real-time flight conditions.The accelerometer and magnetometer are introduced to construct an error equation with the gyros,thus the drifting characteristics of gyroscope can be compensated by solving the error equation utilized by the gradient descent algorithm.Performance of the presented algorithm is evaluated using a self-proposed micro-electro-mechanical system(MEMS)based attitude heading reference system which is mounted on a tri-axis turntable.The on-ground,turntable and flight experiments indicate that the estimation attitude has a good accuracy.Also,the presented system is compared with an open-source flight control system which runs extended Kalman filter(EKF),and the results show that the attitude control system using the gradient descent method can estimate the attitudes for UAV effectively.展开更多
基金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 the National Natural Science Foudnation of China and Shanghai Priority Academic Discipline Foundation,Shanghai,China.
文摘In this paper, we first introduce a concept of companion vector, and studythe Jordan canonical forms of quaternion matrices by using the methods of complex representation and companion vector, not only give out a practical algorithm for Jordancanonical form J of a quaternion matrix A, but also provide a practical algorithm forcorresponding nonsingular matrix P with P- 1 AP = J.
基金supported by the National Science and Technology(2015BAK06B04)
文摘Quatemions complementary filter attitude algorithm was conducted on the unmanned aerial vehicle （UAV） platform. This introduces traditional attitude algorithm and attitude quaternion complementary filter algorithm difference, and the attitude quatemion complementary filter algorithm realization are introduced in details
基金Project(2013CB035504)supported by the National Basic Research Program of China
文摘An iterative method is introduced successfully to solve the inverse kinematics of a 6-DOF manipulator of a tunnel drilling rig based on dual quaternion, which is difficult to get the solution by Denavit-Hartenberg(D-H) based methods. By the intuitive expression of dual quaternion to the orientation of rigid body, the coordinate frames assigned to each joint are established all in the same orientation, which does not need to use the D-H procedure. The compact and simple form of kinematic equations, consisting of position equations and orientation equations, is also the consequence of dual quaternion calculations. The iterative process is basically of two steps which are related to solving the position equations and orientation equations correspondingly. First, assume an initial value of the iterative variable; then, the position equations can be solved because of the reduced number of unknown variables in the position equations and the orientation equations can be solved by applying the solution from the position equations, which obtains an updated value for the iterative variable; finally, repeat the procedure by using the updated iterative variable to the position equations till the prescribed accuracy is obtained. The method proposed has a clear geometric meaning, and the algorithm is simple and direct. Simulation for 100 poses of the end frame shows that the average running time of inverse kinematics calculation for each demanded pose of end-effector is 7.2 ms on an ordinary laptop, which is good enough for practical use. The iteration counts 2-4 cycles generally, which is a quick convergence. The method proposed here has been successfully used in the project of automating a hydraulic rig.
基金supported by the Fundamental Research Funds for the Central Universities(No.56XAA17075)
文摘A gradient descent algorithm with adjustable parameter for attitude estimation is developed,aiming at the attitude measurement for small unmanned aerial vehicle(UAV)in real-time flight conditions.The accelerometer and magnetometer are introduced to construct an error equation with the gyros,thus the drifting characteristics of gyroscope can be compensated by solving the error equation utilized by the gradient descent algorithm.Performance of the presented algorithm is evaluated using a self-proposed micro-electro-mechanical system(MEMS)based attitude heading reference system which is mounted on a tri-axis turntable.The on-ground,turntable and flight experiments indicate that the estimation attitude has a good accuracy.Also,the presented system is compared with an open-source flight control system which runs extended Kalman filter(EKF),and the results show that the attitude control system using the gradient descent method can estimate the attitudes for UAV effectively.
