两点间分段一种融合滤波算法

最新推荐文章于 2023-12-30 17:43:52 发布

原创最新推荐文章于 2023-12-30 17:43:52 发布 · 465 阅读

0 ·

CC 4.0 BY-SA版权

文章标签：

#融合两种定位算法

无人驾驶同时被 2 个专栏收录

42 篇文章

订阅专栏

matlab

10 篇文章

订阅专栏

本文探讨了两种定位算法的估算结果，并通过简单的线性融合方法实现了算法结果的结合。使用了从0到1的权重参数a，对两个算法的坐标结果进行加权平均，生成了一系列融合后的坐标点。

位置评估：假如有两种算法估算定位。定位算法一，算得A点。算法二，算得B点。对两种算法进行简单的融合。

step = 1
x1=2
y1=6
x2=-2
y2=16
x=[]
y=[]

for a = [0:0.1:1]
    x3=a*x1+(1-a)*x2
    x4=a*y1+(1-a)*y2
      x(step)=x3
       y(step)=x4
       step=step+1
end
plot([x(1),x(11)],[y(1),y(11)],'green')
hold on
plot(x,y,'r.')

step = 1
x1=2
y1=6
x2=-2
y2=16
x=[]
y=[]

for a = [0:0.1:1]
x3=a*x1+(1-a)*x2
x4=a*y1+(1-a)*y2
x(step)=x3
y(step)=x4
step=step+1
end
plot([x(1),x(11)],[y(1),y(11)],'green')
hold on
plot(x,y,'r.')