数据融合

  • 格式:pdf
  • 大小:1.90 MB
  • 文档页数:5

·1 0 3 6 ·
合的改进 E K F定姿算法。
计 算 机 应 用 研 究
第3 1卷
其中: h 为更新的步长。代入欧拉角公式得到姿态角:
= a r c s i n (- T ) θ 3 1
γ= ψ=
整体实现方法
在姿态载体运动的短时间内, 陀螺仪测量的数据精度高, 但长时间工作会产生累积误差, 降低精度; 加速度计和磁力计 提供更准确的静态角度, 但是动态参数性能差, 误差大。本文 采用三轴加速度计、 磁力计和三轴陀螺仪进行组合姿态测量, 运用信息融合的方法, 将彼此的优缺点进行互补, 建立全新卡 尔曼滤波融合方法, 确定相应的误差融合参数, 计算出准确的 姿态角。 整体实现方法如图 1所示。首先对读取的传感器数据进 行误差补偿和滤波, 然后采用适当的算法计算出相应的姿态 角。利用加速度计和磁力计计算姿态角, 将其作为测量数据; a l m a n滤波来 将陀螺仪的角度估计作为过程数据, 然后通过 K 校正姿态 角 估 计 的 误 差, 最终得到精确的姿态角( 姿态角 估计) 。 速度值为
5 ] 人[ 提出了一种基于中心差分的 E K F改进算法, 它继承了
E K F实时递推结构, 利用基于 S t i r l i n g 插值公式的差分方法代 替E K F中非线性函数导数的计算, 降低了计算复杂度, 并改善
6 ] 了E K F算法中泰勒展开线性化造成的误差。 Q u等人 [ 提出
K F的改进非线性姿态估计方法, 通过多传感器 了一种基于 E K F进行姿态估计, 有效地提高了姿态角估计 互补, 采用连续 E 的动态性能和稳态性能, 降低了实际系统中的干扰。 已提出的各种不同卡尔曼滤波算法, 在计算姿态角的精度 上有所提高, 计算复杂度也有所降低, 但都是针对单一传感器 的改进算法, 其精度和复杂度仍不能满足高精度和低复杂度的 要求。为解决这些问题, 本文介绍一种全新的多传感器信息融
元素的扩展卡尔曼滤波( E K F ) 方法, 它采用四元数, 而不是使 用欧拉角来计算姿态角, 从而消除了姿态估计长期存在的奇点
3 ] 问题, 并降低了计算复杂度, 提高了实时性。 I v a n j k o 等人 [ 针
对移动机器人姿态跟踪提出了一种基于栅格的卡尔曼滤波方
收稿日期:2 0 1 3 0 6 2 3 ;修回日期: 2 0 1 3 0 8 0 8 基金 项目: 核能 开发 科 研项 目 ( [ 2 0 1 1 ] 1 1 3 7 ) ; 国防 重 点学 科 实验 室 开放 基 金课 题 ( 1 1 z x n k 0 2 ) ; 四川省科技支撑计划项目( 2 0 1 2 G Z 0 0 2 3 ) 作者简介: 邹波( 1 9 8 9 ) , 男, 四川遂宁人, 硕士研究生, 主要研究方向为惯性导航、 R F I D导航定位、 机器人视觉( c h i n a z o u b @g m a i l . c o m ) ; 张华 ( 1 9 6 9 ) , 男, 四川绵阳人, 教授, 博士, 主要研究方向为智能机器人及其应用、 智能控制技术; 姜军( 1 9 8 7 ) , 男, 四川达州人, 硕士, 主要研究方向为 图像特征匹配、 惯性导航.
第3 1卷第 4期 2 0 1 4 年 4月
计 算 机 应 用 研 究 A p p l i c a t i o nR e s e a r c ho f C o m p u t e r s
V o l . 3 1N o . 4 A p r . 2 0 1 4
多传感信息融合的改进扩展卡尔曼滤波定姿
邹 波,张 华,姜 军
1 ] 2 ] 滤波方法常被用于此类计算 [ 。M a r i n s 等人 [ 提出了一种四
合, 提高姿态估计的精度。针对传统滤波器的不稳定, 马瑞平
4 ] 等人 [ 提出了一种新的自适应卡尔曼滤波技术, 利用自适应
过程测量新息序列和状态修正序列在估计移动窗内是分段静 态的, 直接估计系统噪声协方差和测量噪声协方差。 H a n等
T 3 2 a r c t a n ( ) T 0 3 3> T 3 3 T 3 2 ·s i nT a r c t a n ( )T 0 π 3 2+ 3 3< T 3 3 T 2 1 a r c t a n ( ) T 0 1 1> T 1 1 T 2 1 ·s i nT a r c t a n ( )T 0 π 2 1+ 1 1< T 1 1
Z O UB o ,Z H A N GH u a ,J I A N GJ u n
( S p e c i a l E n v i r o n m e n t R o b o t i c s K e y L a b o r a t o r i y o f S i c h u a nP r o v i n c e ,S o u t h w e s t U n i v e r s i t y o f S c i e n c e &T e c h n o l o g y ,M i a n y a n gS i c h u a n 6 2 1 0 1 0 , C h i n a )
( 5 )
9 , 1 0 ] 2 ) 加速度计和磁力计定姿算法 [
当载体处于非加速运动状态时, 将加速度和磁力计采集的
k : 原始数据经过卡尔曼滤波处理, 计算出姿态角 θ a k k k θ θ ε a= T+ a
( 6 )
当载体处于任意姿态时, 假设载体坐标系三轴上测量的加
M u l t i s e n s o r i n f o r m a t i o nf u s i o n ’ s i m p r o v e de x t e n d e d K a l m a nf i l t e r a t t i t u d ed e t e r m i n a t i o n
U K F ) 的融 法, 通过采用扩展卡尔曼滤波和无迹卡尔曼滤波(
- 引言
准确、 可靠的定位和测姿是移动机器人自主导航的首要条 件。在众多自主导航技术中, 惯性导航系统( i n e r t i an a v i g a t i o n s y s t e m , I N S ) 以其适用范围广、 动态性好、 短时精度高而被广泛 采用。 在惯性航向姿态系统中, 常用的姿态测量方法有: a ) 基于 b ) 基于三轴加速度计和三轴 三轴陀螺信号, 积分求得姿态角; 磁力计, 利用大地磁场和重力磁场在地理坐标系和载体坐标系 之间的方向余弦转换进行绝对角度解算, 得到姿态角。但不论 哪种方法计算的姿态角都面临噪声干扰的问题, 因此, 卡尔曼
A b s t r a c t :I nv i e wo f t h e e x i s t i n g m u l t i s e n s o r f u s i o n m e t h o d ’ s l o wp r e c i s i o n a n dc o m p u t a t i o n a l c o m p l e x i t y , t h i s p a p e r s t u d i e d ,a c c e l e r o m e t e r a n dm a g n e t o m e t e r c o m b i n e da t t i t u d e d e t e r m i n a t i o na l g o u s i n g m i c r oi n e r t i a l A H R Sp r e c i s i o ns e n s o r g y r o s c o p e r i t h m .E r r o r c o m p e n s a t i o na n df i l t e r i n g t h e r a wd a t a ,i t r e d u c e dt h en o i s eo f t h es e n s o r i t s e l f ,u s e df o u r e l e m e n t s f o u r o r d e r R u n g e K u t t a m e t h o dt o s o l v e t h e g y r o a n g l e , e l i m i n a t e dt h e p r o b l e mo f s i n g u l a r i t i e s . T h e g y r o s c o p e d a t a a s f o r e c a s t d a t a t o e s Q . A c c e l e r o m e t e r a n d m a g n e t o m e t e r d a t a a s o b s e r v e d d a t a , c o m b i n e d g y r o e r r o r e s t i m a t e t i m a t et h e K a l m a n p r o c e s s c o v a r i a n c e o f t h e m e a s u r e m e n t n o i s e c o v a r i a n c e R , t h r o u g h K a l m a n f i l t e r t o c o m p l e t e t h e m u l t i s e n s o r i n f o r m a t i o n f u s i o n , a c h i e v e d a n a c c u r a t e a t t i t u d ed e t e r m i n a t i o n .E x p e r i m e n t a l a n a l y s i s o f e r r o r s o f d i f f e r e n t a l g o r i t h m s ,p r o v e t h e a c c u r a c ya n dr e l i a b i l i t yo f t h e a l g o r i t h m . K e yw o r d s :e x t e n dK a l m a nf i l t e r ;g y r o s c o p e ;a c c e l e r o m e t e r ;m a g n e t o m e t e r ;c o v a r i a n c e ;a t t i t u d e a n g l e e s t i m a t e