多元信息融合报告扩展卡尔曼滤波Word格式.docx
- 文档编号:13611064
- 上传时间:2022-10-12
- 格式:DOCX
- 页数:11
- 大小:66.82KB
多元信息融合报告扩展卡尔曼滤波Word格式.docx
《多元信息融合报告扩展卡尔曼滤波Word格式.docx》由会员分享,可在线阅读,更多相关《多元信息融合报告扩展卡尔曼滤波Word格式.docx(11页珍藏版)》请在冰豆网上搜索。
与GPS定位方法比较,这些技术成熟度上还存在不足,但是这些技术有很好的应用前景,尤其是在小范围、小空间的室内定位中有很好的定位效果、精度也很高,目前也有很高的研究热度。
把这些技术和GPS方法结合起来,就可以发挥各自的优长,既可以提供较好的精度和响应速度,又可以覆盖较广的范围,实现无缝的、精确的定位,把这些不同来源的传感器信息综合起来,就需要依靠多源信息融合的方法实现。
本实验主要是对室内定位数据进行滤波,从而获取更好的定位效果。
实验数据是基于图像分析的方法获取的,以实验室天花板嵌入的灯罩作为地标,灯罩具有确定的分布以及确定的位置,可以把这些灯罩作为参考,解算出摄像头的位置,再把摄像头坐标系转换到车坐标系上,这样就实现了定位。
实验数据来自于老师提供的文件,文件数据导入到matlab中,使用matlab对数据进行处理,并绘图显示出处理效果。
本文使用扩展卡尔曼滤波EKF的方法,对从图像解析出来的数据进行处理。
扩展卡尔曼滤波的原理如下:
在非线性系统中,系统模型是这样的:
Xk+1=f(Xk)+wkzk=h(Xk)+vk
这与线性系统的区别在于非线性系统的状态向量和其系数是不能够分离的。
所谓扩展卡尔曼滤波器,就是适用于非线性系统的卡尔曼滤波器。
它与经典的线性卡尔曼滤波器很相似,算法步骤和结构都相同。
不同在于系统模型和矩阵A和H。
在扩展卡尔
曼滤波器当中用非线性系统模型方程代替线性系统墨香的系统方程;
将系统模型求偏导得到新的扩展卡尔曼滤波器当中的矩阵A和H,在偏导的求解过程中,也是就是线性化的过程
中用前一个时刻的估计值作为参考点。
通过这样的修改就得到了适用于非线性系统的扩展卡尔曼滤波器。
在使用的过程中我们要时刻牢记,扩展卡尔曼滤波会发散。
扩展卡尔曼滤波的算法结构如下图,注意,将非线性系统中的f对X求(Xk估计)处
的偏导得到A,同样的求h对x求(xk―)处的偏导得到H。
;
数据分别代表:
Figure1EKF的算法结构利用扩展卡尔曼滤波,就可以对我们的数据进行融合估计了。
下面对我们的matlab程序做一些说明:
1•数据存放在location.txt文件中,数据的存放格式如下:
0-0
71.5645199.2392.41.8
65.4946456.4132.42.4
3.102842.048781.54719
单位时间左右轮驶过的距离
特征点1的image坐标特征点1的world坐标特征点2的image坐标特征点2的world坐标真实坐标和角度
2.程序中的变量说明:
ru,rv:
pixelmagnificationfactors,像素放大因子
xf,yf:
worldframecoordinates,世界坐标
xfr,yfr:
robotframecoordinates,robot坐标
uO,vO:
imagecoordinatesofthecamera'
sprinc,a相机投影点的图像坐标
zfc:
distaneefromtheopticalcenterofthecameratoceilingplane,相机中心至U天花板平面的距离
d1,d2:
coordinatesofOcintherobotframe,相机中心在robot坐标系中的坐标
b:
distancebetweenthedrivingwheels,两轮距
P,Q:
论文中的测距法模型矩阵
W:
观测模型矩阵
u,v:
coordinatesofthefeatureintheimageplane,image坐标中的特征位置
3•程序中的变量定义以及融合过程完全按照文章中的步骤进行,最终将得到:
a.真实的路径
b.不加EKF计算出的路径
c.加EKF计算出的路径
d.不加EKF计算和真实值之间的误差
e.加EKF计算和真实值之间的误差
三、仿真结果
根据上述数据提取以及处理的方法与流程,得到了下面的结果:
1•真实路径
3.5
3
2.5
2
15
1
05
°
00.51
1522.53
2•不加EKF路径
Figure2真实路径
3•不加EKF的误差
0.35
0.3
Figure4不加EKF误差
4•加EKF的路径
0.5
0051
5•加EKF的误差
Figure6加EKF误差
6•真实路径、不加EKF路径、加EKF路径的综合对照
□
25
D
00.511522.5335
7•不加EKF和加EKF误差的综合对照
Figure8不加EKF、力廿EKF误差对比
四、总结
通过对比我们可以看出,加EKF后融合的数据要比不加EKF的数据好的多,无论是从路径图上还是从误差曲线上,都有明显的效果。
可见,使用滤波的方法对传感器数据进行处
理可以为我们很好地提高数据的精度,这对于我们更精确地完成一些操作是必须的。
本科阶段参加过一些比赛和小制作,也经常使用一些传感器,但总是被传感器精度不足困扰。
多源信息融合这门课给了我新的工具与思路,通过采用多个不同、或者相同的传感器数据进行融合,就可以很好地提高传感器精度,获得更好的数据。
这从我们这次仿真的图像中就可以看出来它的效果。
以后再进行一些工程或者项目的时候,会尽量使用信息融合的办法,采集不同来源的数
据以提高传感器精度。
这其实是对我思维的改变。
另外,这门课让我认识到自己的数学基础特别薄弱,而且面对文献耐心不足,这也是以
后需要着力提升的方面。
最后,感谢老师宽限我晚交报告~
附录:
matlab代码:
clearall;
clc;
tic
data=importdata('
location.txt'
);
ru=902.13283;
rv=902.50141;
u0=347.20436;
v0=284.34705;
zfc=2.1050;
d1=-0.0668;
d2=0.0536;
b=0.328;
I=eye(3);
P=[0.00300;
00.0030;
000.01];
Q_value=0.1*[0.050;
00.05];
W=0.01*[25000;
02500;
00250;
00025];
k0(1,1:
2)=data(6,:
);
k0(1,3)=data(7,1);
d_s=zeros(2,2);
route_real=zeros(2,3);
dataf=zeros(2,2,2);
datat=zeros(2,2,2);
count=1;
fori=1:
size(data,1)
ifmod(i,7)==3
dataf(count,:
1)=data(i,:
end
ifmod(i,7)==5
2)=data(i,:
ifmod(i,7)==6route_real(count,1:
2)=data(i,:
end
ifmod(i,7)==0route_real(count,3)=data(i,1);
count=count+1;
ifmod(i,7)==2
datat(count,:
ifmod(i,7)==4
ifmod(i,7)==1
d_s(count,:
)=data(i,:
X=k0(1,:
)'
;
count=2;
size(d_s,1)
k0(count,1)=k0(count-1,1)+(d_s(i,1)+d_s(i,2))/2*cos(k0(count-1,3));
k0(count,2)=k0(count-1,2)+(d_s(i,1)+d_s(i,2))/2*sin(k0(count-1,3));
k0(count,3)=k0(count-1,3)+(d_s(i,1)-d_s(i,2))/b;
route_fusion=zeros(size(d_s,1),2);
X_estimate=[X(1,1)+(d_s(i,1)+d_s(i,2))/2*cos(X(3,1));
X(2,1)+(d_s(i,1)+d_s(i,2))/2*sin(X(3,1));
X(3,1)+(d_s(i,1)-d_s(i,2))/b];
hx=zeros(3,3);
hx(1,1)=1;
hx(2,2)=1;
hx(3,3)=1;
hx(1,3)=-(d_s(i,1)+d_s(i,2))/2*sin(X(3,1));
hx(2,3)=(d_s(i,1)+d_s(i,2))/2*cos(X(3,1));
hu=1/b*ones(3,2);
hu(3,2)=0-hu(3,2);
hu(1,1)=0.5*cos(X(3,1));
hu(2,1)=0.5*sin(X(3,1));
hu(1,2)=0.5*cos(X(3,1));
hu(2,2)=0.5*sin(X(3,1));
Q=Q_value;
Q(1,1)=Q(1,1)*abs(d_s(i,1));
Q(2,2)=Q(2,2)*abs(d_s(i,2));
P_estimate=hx*P*hx'
+hu*Q*hu'
z_estimate=[-ru/zfc*(-(dataf(i,1,1)-X_estimate(1,1))*sin(X_estimate(3,1))+(dataf(i,2,1)-X_estimate(2,1))*cos(X_estimate(3,1))-d2)+u0;
-rv/zfc*(-(dataf(i,1,1)-X_estimate(1,1))*cos(X_estimate(3,1))-(dataf(
i,2,1)-X_estimate(2
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 多元 信息 融合 报告 扩展 卡尔 滤波
![提示](https://static.bdocx.com/images/bang_tan.gif)