著者
大和 秀彰 古田 貴之 富山 健
出版者
一般社団法人 日本機械学会
雑誌
日本機械学会論文集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.