三边测量法的MATLAB定位程序说明

1、三边测量法的MATLAB定位程序说明（MATLAB 7.0下）：一、由三个文件组成，分别是  1）triposition.m  2）find_three_p.m  3）locac3.m  三个源文件内容见后面二。 1、组成图示 图示如下（注意鼠标处分别打开了上面的三个源文件：）：2.运行主文件  首先切换到主程序locac3.m的界面，如下： 点击工具 运行，等待一段时间，得到运行结果如下：   同时在MATLAB命令窗口得到：    二、三个源

2、文件的内容%一、m函数triposition.m文件内容%一、m函数*triposition.m*%function locx,locy=triposition(xa,ya,da,xb,yb,db,xc,yc,dc)%              三点定位法                  

3、;        %输入：%   1.参考节点A（xa,ya）,B(xb,yb),C(xc,yc)%   2.定位节点D(locx,locy)到这三点的距离分别为da,db,dc%返回：%   （locx，locy)为计算的定位节点D点的位置坐标%syms x y   %f符号变量%-求解方程组-f1='2*x*(xa-xc)+xc2-xa2+2*y*(ya-yc)+yc2-ya2=dc2-da2'f2='2*x*(xb-

4、xc)+xc2-xb2+2*y*(yb-yc)+yc2-yb2=dc2-db2'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点

5、的坐标%输出：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;   

6、   xb=x(t);      yb=y(t);            break;    end   end%取第三点while(1)    t=fix(len*rand(1,1)+1;    if (t=ma)&&(t=mb)     &

7、#160;       mc=t;      xc=x(t);      yc=y(t);           break;    end   end %三、主文件locac3.m文件内容%*locac3.m*%-采用三边定位法对未知节点定位-clear;len=100

8、0; %参考节点数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);hold on;plot(mx,my,'go'); %盲节点图%-定位估计-wucha_p=0.00001;   %定位误差for p=1

9、: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(

10、p)=triposition(xa,ya,da,xb,yb,db,xc,yc,dc); %计算定位坐标             plot(locx(p),locy(p),'r*');endlegend('参考节点','盲节点','定位节点','Location','SouthEast');  title('三边测量法的定位');wdot=0;%统计定位正确的点数for p=1:mlen    dr(p)=sqrt(locx(p)-mx(p)2+(locy(p)-my(p)2);