- 著者
-
大和 秀彰
古田 貴之
富山 健
- 出版者
- 一般社団法人 日本機械学会
- 雑誌
- 日本機械学会論文集C編 (ISSN:18848354)
- 巻号頁・発行日
- vol.77, no.776, pp.1441-1453, 2011 (Released:2011-04-25)
- 参考文献数
- 27
This paper presents a new methodology of attitude estimation for cost-effective and small-size inertial measurement units, consisting of tri-axial gyroscope sensors, accelerometers and geo-magnetometers. Introduced for the algorithm development is a quaternion feedback structure, where bias terms in the gyroscope rate information, appearing in the phase-locked loop, are identified with the theoretical guarantee of the global and asymptotical stability. The bias-term identification and modification process is performed continuously without the influence of the disturbance by applying the proposed disturbance detection scheme and a conventional vector matching method. Practical validity of the presented framework is fully evaluated by experiments. The evaluation result shows that the approach in this paper can offer superior drift-free performance with property of disturbance rejection under arbitrary high-frequency test motion of spatial rotation and translation.