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

版权声明：https://blog.csdn.net/CAIYUNFREEDOM https://blog.csdn.net/CAIYUNFREEDOM/article/details/90764178

位置评估：假如有两种算法估算定位。定位算法一，算得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.')
 

扫描二维码关注公众号，回复： 6416238 查看本文章