三边测量法的MATLAB定位程序说明.docx
《三边测量法的MATLAB定位程序说明.docx》由会员分享，可在线阅读，更多相关《三边测量法的MATLAB定位程序说明.docx（11页珍藏版）》请在冰豆网上搜索。
三边测量法的MATLAB定位程序说明
三边测量法的MATLAB定位程序说明（MATLAB7.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点的位置坐标
%
symsxy %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）;
holdon;
plot（mx,my,'go'）;%盲节点图
%---------定位估计----------------------
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,xb,yb,db,xc,yc,dc）;%计算定位坐标
plot（locx（p）,locy（p）,'r*'）;
end
legend（'参考节点','盲节点','定位节点','Location','SouthEast'）;
title（'三边测量法的定位'）;
wdot=0;%统计定位正确的点数
forp=1:
mlen
dr（p）=sqrt（（locx（p）-mx（p））^2+（locy（p）-my（p））^2）;
ifdr（p） wdot=wdot+1;
end
end
disp（'未知节点定位准确率：
'）;
wdot/mlen
升级会员 