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

1、三边测量法的MATLAB定位程序说明（MATLAB 7.0下）：一、由三个文件组成，分别是 1）triposition.m2）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,

2、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点的位置坐标%syms x y %f符号变量%-求解方程组-f1=2*x*(xa-xc)+xc2-xa2+2*y*(ya-yc)+yc2-ya2=dc2-da2;f2=2*x*(xb-xc)+xc2-xb2+2*y*(yb-yc)+yc2-yb2=dc2-db2;xx,yy=solve(f1,f2,x,y); %解关于x,y的符号方程组，得到

3、解的符号表示，并存入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

4、=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,l

5、en);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: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;%统计定位正确的点数for p=1:mlen dr(p)=sqrt(loc