三边测量法定位的MATLAB程序 matlab测量图片中距离

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

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

1)triposition.m

2)find_three_p.m

3)locac3.m

三个源文件内容见后面二。

1、组成图示

图示如下(注意鼠标处分别打开了上面的三个源文件:):


2.运行主文件

首先切换到主程序locac3.m的界面,如下:


点击工具 运行,等待一段时间,得到运行结果如下:



三边测量法定位的MATLAB程序 matlab测量图片中距离

同时在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'); %盲节点图

%---------定位估计----------------------

wu cha_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*');

end

legend('参考节点','盲节点','定位节点','Location','SouthEast');

title('三边测量法的定位');

wdot=0;%统计定位正确的点数

for p=1:mlen

dr(p)=sqrt((locx(p)-mx(p))^2+(locy(p)-my(p))^2);

ifdr(p)<wucha_p

wdot=wdot+1;

end

end

disp('未知节点定位准确率:');

wdot/mlen

  

爱华网本文地址 » http://www.aihuau.com/a/25101015/275916.html

更多阅读

毕业论文答辩的一般程序及常见问题 研究生毕业论文答辩

毕业论文答辩不会太严,如果差得不是太出格都可以毕业。毕业论文不是自己写的也不用太紧张,一般都不会有什么事,不需要全部背下来,主要的观点记住就可以了,只要你把自己论文的重点内容熟悉了就可以了。 毕业论文答辩的一般程序及常见问题

中国的离婚程序 起诉离婚的程序

中国的离婚程序——步骤/方法中国的离婚程序 1、协议离婚的条件1、双方当事人系合法登记的夫妻;2、双方当事人离婚是完全自愿的;3、双方当事人对子女抚养、财产和债务处理等事项达成协议;4、一方或双方当事人的户口是本辖区内的常住户

怎么删除手机本身自带的应用程序软件 乐视max2删除自带程序

怎么删除手机本身自带的应用程序软件——简介手机在出厂时,里面会安装很多装序那么要怎么才能册掉那些不用的程式呢!怎么删除手机本身自带的应用程序软件——方法/步骤怎么删除手机本身自带的应用程序软件 1、手机本手自带的程序的话

怎样才能提取图片中的文字 怎样提取图片上的文字

现在数码照相技术越来越发达,如果您到图书馆或者新华书店看到了好的文章或者图书,想把书本上需要的内容输入到电脑中,就会想到用手机或相机拍下来,但是拍摄图片中的文字是无法编辑的,怎样才能提取图片中的文字,将图片中的文字转换为可以编

声明:《三边测量法定位的MATLAB程序 matlab测量图片中距离》为网友堇墨浮华分享!如侵犯到您的合法权益请联系我们删除