资源描述：
《三边测量法的MATLAB定位程序说明.doc》由会员上传分享，免费在线阅读，更多相关内容在应用文档-天天文库。
1、三边测量法的MATLAB定位程序说明（MATLAB7.0下）：一、由三个文件组成，分别是 1）triposition.m 2）find_three_p.m 3）locac3.m 三个源文件内容见后面二。 1、组成图示 图示如下（注意鼠标处分别打开了上面的三个源文件：）：2.运行主文件 首先切换到主程序locac3.m的界面，如下： 点击工具运行，等待一段时间，得到运行结果如下： 同时在MATLAB命令窗口得到： 二、三个源文件的内容%一、m函数triposition.m文件内容%一、m函数*****************tripositio
2、n.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符号变量%--------------求解方程
3、组------------------------------------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=p
4、x;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;
5、 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;%参
6、考节点数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');%盲节点图%---------定位估计-
7、---------------------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
8、,xb,yb,db,xc,yc,dc);%计算定位坐标 plot(loc
