计算机研究与发展
計算機研究與髮展
계산궤연구여발전
JOURNAL OF COMPUTER RESEARCH AND DEVELOPMENT
2010年
z2期
235-240
,共6页
姿态估计%微型惯性和磁传感单元%四元数%自适应Kalman滤波
姿態估計%微型慣性和磁傳感單元%四元數%自適應Kalman濾波
자태고계%미형관성화자전감단원%사원수%자괄응Kalman려파
融合微型惯性和磁传感器数据能够用于实时跟踪人体肢体运动、或估计某一运动刚体姿态.这里,三维加速计被用来测量传感器坐标系下的重力向量,用于确定相对于水平面的方向;三维磁力计测量得到传感器坐标系下的磁场强度向量,用来确定垂直轴上的旋转;三维陀螺仪测量角速度,通过积分可以得到角度.重力向量受人体运动加速度的干扰,磁场强度受周围环境磁感物质的干扰,而角速度在积分过程中也会引入随时间增长的漂移,所以需要融合这3种观测量.提出了一种自适应Kalman滤波的姿态估计算法AKF,通过加速度与磁场强度计算得到的姿态来做观测量与角速度融合,将非线性观测方程线性化,从而降低了计算复杂度;磁场的干扰不会影响Pitch和Roll两个角的估计;而对于运动加速度的干扰,通过自适应调整滤波器中的观测噪声协方差矩阵来抵除.算法的稳定性和精确性在实验中得到了有效验证.
融閤微型慣性和磁傳感器數據能夠用于實時跟蹤人體肢體運動、或估計某一運動剛體姿態.這裏,三維加速計被用來測量傳感器坐標繫下的重力嚮量,用于確定相對于水平麵的方嚮;三維磁力計測量得到傳感器坐標繫下的磁場彊度嚮量,用來確定垂直軸上的鏇轉;三維陀螺儀測量角速度,通過積分可以得到角度.重力嚮量受人體運動加速度的榦擾,磁場彊度受週圍環境磁感物質的榦擾,而角速度在積分過程中也會引入隨時間增長的漂移,所以需要融閤這3種觀測量.提齣瞭一種自適應Kalman濾波的姿態估計算法AKF,通過加速度與磁場彊度計算得到的姿態來做觀測量與角速度融閤,將非線性觀測方程線性化,從而降低瞭計算複雜度;磁場的榦擾不會影響Pitch和Roll兩箇角的估計;而對于運動加速度的榦擾,通過自適應調整濾波器中的觀測譟聲協方差矩陣來牴除.算法的穩定性和精確性在實驗中得到瞭有效驗證.
융합미형관성화자전감기수거능구용우실시근종인체지체운동、혹고계모일운동강체자태.저리,삼유가속계피용래측량전감기좌표계하적중력향량,용우학정상대우수평면적방향;삼유자력계측량득도전감기좌표계하적자장강도향량,용래학정수직축상적선전;삼유타라의측량각속도,통과적분가이득도각도.중력향량수인체운동가속도적간우,자장강도수주위배경자감물질적간우,이각속도재적분과정중야회인입수시간증장적표이,소이수요융합저3충관측량.제출료일충자괄응Kalman려파적자태고계산법AKF,통과가속도여자장강도계산득도적자태래주관측량여각속도융합,장비선성관측방정선성화,종이강저료계산복잡도;자장적간우불회영향Pitch화Roll량개각적고계;이대우운동가속도적간우,통과자괄응조정려파기중적관측조성협방차구진래저제.산법적은정성화정학성재실험중득도료유효험증.