计算机工程与应用 ›› 2008, Vol. 44 ›› Issue (35): 25-27.DOI: 10.3778/j.issn.1002-8331.2008.35.007

• 博士论坛 • 上一篇    下一篇

基于四元数的姿态非线性跟踪

尹慧琳1,王 磊1,农 静2   

  1. 1.同济大学 中德学院电子信息系,上海 200092
    2.同济大学 电子与信息工程学院,上海 200092
  • 收稿日期:2008-06-20 修回日期:2008-09-23 出版日期:2008-12-11 发布日期:2008-12-11
  • 通讯作者: 尹慧琳

Quaternion-based algorithm for pose nonliear tracking

YIN Hui-lin1,WANG Lei1,NONG Jing2   

  1. 1.Department of Electronics and Information in CDHK,Tongji University,Shanghai 200092,China
    2.School of Electronics and Information Engineering,Tongji University,Shanghai 200092,China
  • Received:2008-06-20 Revised:2008-09-23 Online:2008-12-11 Published:2008-12-11
  • Contact: YIN Hui-lin

摘要: 计算机图形学中物体三维旋转通常用矩阵、欧拉角、四元数表示,用矩阵及欧拉角存在计算繁琐、旋转不均匀性及平衡环锁定等局限,四元数可以避免这些局限,并且几何意义明确,计算简单。研究用四元数表示物体的姿态,在四元数基本运算法则基础上提出并证明了“基于四元数的多个旋转运动合成规则”,然后将此规则为依据,推导出一种用来计算姿态非线性状态方程系数的方法,对非线性状态转移函数进行线性化,并且研究了测量方程函数的确定及线性化,借助扩展Kalman滤波实现了对姿态的跟踪。最后给出一滤波跟踪实例,验证此种方法是有效的。

关键词: 四元数, 姿态跟踪, 非线性Kalman滤波, 旋转运动合成

Abstract: The matrix representation,Euler angles and quaternions are commonly used in computer graphics.There are weaknesses by matrix representation and Euler angles,such as high computational cost,gimbal lock and so on.Quaternions are well-suited for the representation of rotations as they are free from singularities,numerically well-conditioned.In this paper,pose representation by quaternions are researched.With the basic quaternion algebra,the “quaternion based rotations combination theorem” is introduced and proved theoretically.On the basis of this theorem,a method for compute of pose nonliear state transfer function and its linearization is purposed.Then,the computing of the measurement function and the linearization is studied.With the Extended Kalman Filter(EKF),the pose is tracked and estimated.Finally,the experiment results show this quaternion-based algorithm for pose nonliear tracking is effective.

Key words: quaternion, pose tracking, nonlinear Kalman filter, combination of rotations