搜索
三边测量法的MATLAB定位程序说明（MATLAB7.0下）：一、由三个文件组成，分别是1）triposition.m2）find_three_p.m3）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,yypx=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;endend%取第三点while(1)t=fix(len*rand(1,1))+1;if(t~=ma)&&(t~=mb)mc=t;xc=x(t);yc=y(t);break;endend%三、主文件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*');endlegend('参考节点','盲节点','定位节点','Location','SouthEast');title('三边测量法的定位');wdot=0;%统计定位正确的点数forp=1:mlendr(p)=sqrt((locx(p)-mx(p))^2+(locy(p)-my(p))^2);ifdr(p)wucha_pwdot=wdot+1;endenddisp('未知节点定位准确率：');wdot/mlen