1、精選優質文檔-傾情為你奉上三邊測量法的MATLAB定位程序說明（MATLAB 7.0下）：一、由三個文件組成，分別是  1）triposition.m  2）find_three_p.m  3）locac3.m  三個源文件內容見后面二。 1、組成圖示 圖示如下（注意鼠標處分別打開了上面的三個源文件：）：2.運行主文件  首先切換到主程序locac3.m的界面，如下： 點擊工具 運行，等待一段時間，得到運行結果如下：   同時在MATLAB命令窗口得到：  

2、0; 二、三個源文件的內容%一、m函數triposition.m文件內容%一、m函數*triposition.m*%function locx,locy=triposition(xa,ya,da,xb,yb,db,xc,yc,dc)%              三點定位法               

3、0;          %輸入：%   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=

4、'2*x*(xb-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點中隨機選出不同的

5、三點% 輸入：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; 

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、          mc=t;      xc=x(t);      yc=y(t);           break;    end   end %三、主文件locac3.m文件內容%*locac3.m*%-采用三邊定位法對未知節點定位-

8、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);hold on;plot(mx,my,'go'); %盲節點圖%-定位估計-wucha_p=0.00001;  

9、 %定位誤差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);    

10、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(locx(p)-mx(p)2+(locy(p)-my(p)2);       if