An extended Kalman filter with adaptive gain was used to build a miniature attitude and heading reference system based on a stochastie model. The adaptive filter has six states with a time variable transition matrix. ...An extended Kalman filter with adaptive gain was used to build a miniature attitude and heading reference system based on a stochastie model. The adaptive filter has six states with a time variable transition matrix. When the system is in the non-acceleration mode, the accelerometer measurements of the gravity and the compass measurements of the heading have observability and yield good eslimates of the states. When the system is in the high dynamic mode and the bias has converged to an aceurate estimate, the attitude caleulation will be maintained for a long interval of time. The adaptive filter tunes its gain automatically based on the system dynamics sensed by the accelerometers to yield optimal performance,展开更多
Unique correct correspondence cannot be obtained only by use of gray correlation technique, which describes gray similar degree of feature points between the left and right images too unilaterally. The gray correlatio...Unique correct correspondence cannot be obtained only by use of gray correlation technique, which describes gray similar degree of feature points between the left and right images too unilaterally. The gray correlation technique is adopted to extract gray correlation peaks as a coarse matching set called multi-peak set. The disparity gradient limited constraint is utilized to optimize the multi-peak set. Unique match will be obtained by calculating the correlation of hybrid matrices consisting of reference differences and disparities from the multi-peak set. Two of the known corresponding points in the left and right images, respectively, are set as a pair of reference points to determine search direction and search scope at first. After the unique correspondence is obtained by calculating the correlation of the hybrid matrices from the multi-peak set, the obtained match is regarded as a new reference point till all feature points in the left (or right) image have been processed. Experimental results proved that the proposed algorithm was feasible and accurate.展开更多
MEMS (micro electro mechanical systems) inertial navigation system ~, Mll'~3) nas Been WllUly used in robots for its low-cost. The MINS and magnetometers are commonly the component parts of the attitude and headin...MEMS (micro electro mechanical systems) inertial navigation system ~, Mll'~3) nas Been WllUly used in robots for its low-cost. The MINS and magnetometers are commonly the component parts of the attitude and heading reference systems (AHRS), which provide pitch and roll angles relative to the earth gravity vector, and heading angle relative to the north. However, the performance of sen- sors with low cost AHRS is not so good. The gyros are not sensitive enough to observe the earth an- gular velocity, so the traditional technique like alignment algorithm is invalid. The measurements of gyros become useless to determine the initial attitude matrix from navigation frame to body frame. The alignment algorithm is computed by the accelerometers and magnetometers. The process is es- tablished as an optimization problem of finding the maximum eigenvector. Meanwhile the sensitive analysis with respect to the biases of accelerometers is proposed. Then the recursive least squares al- gorithm (RLSA) is introduced. The comparison between the proposed method and RLSA is provid- ed. The results demonstrate its accuracy favorably and verify the feasibility of the proposed algo- rithm.展开更多
文摘An extended Kalman filter with adaptive gain was used to build a miniature attitude and heading reference system based on a stochastie model. The adaptive filter has six states with a time variable transition matrix. When the system is in the non-acceleration mode, the accelerometer measurements of the gravity and the compass measurements of the heading have observability and yield good eslimates of the states. When the system is in the high dynamic mode and the bias has converged to an aceurate estimate, the attitude caleulation will be maintained for a long interval of time. The adaptive filter tunes its gain automatically based on the system dynamics sensed by the accelerometers to yield optimal performance,
文摘Unique correct correspondence cannot be obtained only by use of gray correlation technique, which describes gray similar degree of feature points between the left and right images too unilaterally. The gray correlation technique is adopted to extract gray correlation peaks as a coarse matching set called multi-peak set. The disparity gradient limited constraint is utilized to optimize the multi-peak set. Unique match will be obtained by calculating the correlation of hybrid matrices consisting of reference differences and disparities from the multi-peak set. Two of the known corresponding points in the left and right images, respectively, are set as a pair of reference points to determine search direction and search scope at first. After the unique correspondence is obtained by calculating the correlation of the hybrid matrices from the multi-peak set, the obtained match is regarded as a new reference point till all feature points in the left (or right) image have been processed. Experimental results proved that the proposed algorithm was feasible and accurate.
基金Supported by the National Natural Science Foundation of China(No.60905056)
文摘MEMS (micro electro mechanical systems) inertial navigation system ~, Mll'~3) nas Been WllUly used in robots for its low-cost. The MINS and magnetometers are commonly the component parts of the attitude and heading reference systems (AHRS), which provide pitch and roll angles relative to the earth gravity vector, and heading angle relative to the north. However, the performance of sen- sors with low cost AHRS is not so good. The gyros are not sensitive enough to observe the earth an- gular velocity, so the traditional technique like alignment algorithm is invalid. The measurements of gyros become useless to determine the initial attitude matrix from navigation frame to body frame. The alignment algorithm is computed by the accelerometers and magnetometers. The process is es- tablished as an optimization problem of finding the maximum eigenvector. Meanwhile the sensitive analysis with respect to the biases of accelerometers is proposed. Then the recursive least squares al- gorithm (RLSA) is introduced. The comparison between the proposed method and RLSA is provid- ed. The results demonstrate its accuracy favorably and verify the feasibility of the proposed algo- rithm.