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

三边测量法的MATLAB定位程序说明(MATLAB 7.0下)：

一、由三个文件组成，分别是

? 1)triposition.m

??2)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,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)+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,yy

px=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;

??? 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; %参考节点数

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: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)