三边测量法的MATLAB定位程序说明.docx
《三边测量法的MATLAB定位程序说明.docx》由会员分享,可在线阅读,更多相关《三边测量法的MATLAB定位程序说明.docx(11页珍藏版)》请在冰豆网上搜索。
三边测量法的MATLAB定位程序说明
三边测量法的MATLAB定位程序说明(MATLAB7.0下):
一、由三个文件组成,分别是
1)triposition.m
2)find_three_p.m
3)locac3.m
三个源文件内容见后面二。
1、组成图示
图示如下(注意鼠标处分别打开了上面的三个源文件:
):
2.运行主文件
首先切换到主程序locac3.m的界面,如下:
点击工具运行,等待一段时间,得到运行结果如下:
同时在MATLAB命令窗口得到:
二、三个源文件的内容
%一、m函数triposition.m文件内容
%一、m函数*****************triposition.m**************************%
function[locx,locy]=triposition(xa,ya,da,xb,yb,db,xc,yc,dc)
% 三点定位法 %
%输入:
% 1.参考节点A(xa,ya),B(xb,yb),C(xc,yc)
% 2.定位节点D(locx,locy)到这三点的距离分别为da,db,dc
%返回:
% (locx,locy)为计算的定位节点D点的位置坐标
%
symsxy %f符号变量
%--------------求解方程组------------------------------------
f1='2*x*(xa-xc)+xc^2-xa^2+2*y*(ya-yc)+yc^2-ya^2=dc^2-da^2';
f2='2*x*(xb-xc)+xc^2-xb^2+2*y*(yb-yc)+yc^2-yb^2=dc^2-db^2';
[xx,yy]=solve(f1,f2,x,y);%解关于x,y的符号方程组,得到解的符号表示,并存入xx,yy
px=eval_r(xx); %解的数值px
(1),px
(2)
py=eval_r(yy); %解的数值py
(1),py
(2)
locx=px;
locy=py;
%二、m函数find_three_p.m文件内容
function[xa,ya,xb,yb,xc,yc]=find_three_p(x,y)
%从N点中随机选出不同的三点
%输入:
x,y是N点的坐标
%输出:
xa,ya,xb,yb,xc,yc
% 为选出的任意三点的坐标
len=length(x);
%取一点
t=fix(len*rand(1,1))+1;
ma=t;
xa=x(t);
ya=y(t);
%取第二点
while
(1)
t=fix(len*rand(1,1))+1;
if(t~=ma)
mb=t;
xb=x(t);
yb=y(t);
break;
end
end
%取第三点
while
(1)
t=fix(len*rand(1,1))+1;
if(t~=ma)&&(t~=mb)
mc=t;
xc=x(t);
yc=y(t);
break;
end
end
%三、主文件locac3.m文件内容
%*********locac3.m****************
%---采用三边定位法对未知节点定位---------
clear;
len=1000;%参考节点数
maxx=1000;%参考节点分布的最大横坐标
maxy=1000;%参考节点分布的最大纵坐标
%------参考点[cx,cy]-----------------
cx=maxx*rand(1,len);
cy=maxy*rand(1,len);
plot(cx,cy,'k^');%参考节点图
%--------未知节点(mx,my)-----------
mlen=200; %未知点数
mx=maxx*rand(1,mlen);
my=maxy*rand(1,mlen);
holdon;
plot(mx,my,'go');%盲节点图
%---------定位估计----------------------
wucha_p=0.00001; %定位误差
forp=1:
mlen%对每个未知盲节点
[xa,ya,xb,yb,xc,yc]=find_three_p(cx,cy);%从参考点中任意选出三点
da=sqrt((mx(p)-xa)^2+(my(p)-ya)^2);
db=sqrt((mx(p)-xb)^2+(my(p)-yb)^2);
dc=sqrt((mx(p)-xc)^2+(my(p)-yc)^2);
[locx(p),locy(p)]=triposition(xa,ya,da,xb,yb,db,xc,yc,dc);%计算定位坐标
plot(locx(p),locy(p),'r*');
end
legend('参考节点','盲节点','定位节点','Location','SouthEast');
title('三边测量法的定位');
wdot=0;%统计定位正确的点数
forp=1:
mlen
dr(p)=sqrt((locx(p)-mx(p))^2+(locy(p)-my(p))^2);
ifdr(p) wdot=wdot+1;
end
end
disp('未知节点定位准确率:
');
wdot/mlen