热门标签 | HotTags
当前位置:  开发笔记 > 编程语言 > 正文

MATLAB实现DLT(DirectLinearTransform)算法

MATLAB实现DLT(DirectLinearTransform)算法转载备用作者:My_CSDN_Bo_Ke来源:CSDN原文:htt
MATLAB实现DLT(Direct Linear Transform)算法

转载备用
作者:My_CSDN_Bo_Ke 
来源:CSDN 
原文:https://blog.csdn.net/weixin_40327927/article/details/81020798 


% DLT算法主程序
Left_image=load('left_image.txt');
[Left_L,Left_x0,Left_y0]=Computer_L(Left_image);
Right_image=load('right_image.txt');
[Right_L,Right_x0,Right_y0]=Computer_L(Right_image);
UnknownPoint=load('test2.txt');
Coordinate=Computer_UnknownPoint( UnknownPoint,Left_L,Left_x0,Left_y0,Right_L,Right_x0,Right_y0 );function [ L,x0,y0] = Computer_L( Points )
%功能:计算L系数的近似值和精确值
%输入:Points为控制点的像点坐标及物方坐标%格式为:点号 x y X Y Z
%输出:L系数的精确值,像主点坐标x0,y0%计算L系数近似值
X=zeros(2*size(Points,1),11);
B=zeros(2*size(Points,1),1);
for i=1:size(Points,1);X(2*i-1,1:3)=Points(i,4:6);X(2*i-1,4)=1;X(2*i-1,9:11)=Points(i,2)*Points(i,4:6);X(2*i,5:8)=X(2*i-1,1:4);X(2*i,9:11)=Points(i,3)*Points(i,4:6);B(2*i-1,1)=Points(i,2);B(2*i,1)=Points(i,3);
end
L=X(1:11,:)\(-B(1:11,1));
%计算像主点近似值x0,y0
x0=-(L(1)*L(9)+L(2)*L(10)+L(3)*L(11))/(L(9)*L(9)+L(10)*L(10)+L(11)*L(11));
y0=-(L(5)*L(9)+L(6)*L(10)+L(7)*L(11))/(L(9)*L(9)+L(10)*L(10)+L(11)*L(11));
%计算L系数精确值
M=zeros(2*size(Points,1),12);
W=zeros(2*size(Points,1),1);
n=0;                     %迭代次数统计
while n<10;              %设置L迭代次数为10for i&#61;1:6;A&#61;L(9)*Points(i,4)&#43;L(10)*Points(i,5)&#43;L(11)*Points(i,6)&#43;1;M(2*i-1,1:4)&#61;[Points(i,4:6) 1]/A;M(2*i-1,9:11)&#61;Points(i,2)* M(2*i-1,1:3);R&#61;(Points(i,2)-x0)^2&#43;(Points(i,3)-y0)^2;M(2*i-1,12)&#61;(Points(i,2)-x0)*R;M(2*i,5:8)&#61;M(2*i-1,1:4);M(2*i,9:11)&#61;Points(i,3)* M(2*i-1,1:3);M(2*i,12)&#61;(Points(i,3)-y0)*R;W(2*i-1,1)&#61;Points(i,2)/A;W(2*i,1)&#61;Points(i,3)/A;endM&#61;-M;L&#61;(M&#39;*M)\M&#39;*W;x0&#61;-(L(1)*L(9)&#43;L(2)*L(10)&#43;L(3)*L(11))/(L(9)*L(9)&#43;L(10)*L(10)&#43;L(11)*L(11));y0&#61;-(L(5)*L(9)&#43;L(6)*L(10)&#43;L(7)*L(11))/(L(9)*L(9)&#43;L(10)*L(10)&#43;L(11)*L(11));n&#61;n&#43;1;
end
endfunction [ Coordinate ] &#61; Computer_UnknownPoint( UnknownPoint,Left_L,Left_x0,Left_y0,Right_L,Right_x0,Right_y0 )
%功能&#xff1a;计算待定点物方坐标
%输入&#xff1a;UnknownPoint为待定点在左右片的像点坐标%格式为&#xff1a;点号 左片坐标x y 右片坐标x y%Left_L、Left_x0、Left_y0为左片L系数及像主点坐标%Right_L、Right_x0、Right_y0为右片L系数及像主点坐标
%输出&#xff1a;Coordinate为待定点物方坐标%格式为&#xff1a;点号 X Y Z%Error为计算出的待定点坐标与真实坐标之差%格式为&#xff1a;点号 delta_X delta_Y delta_ZLeft_R&#61;(UnknownPoint(:,2)-Left_x0).^2&#43;(UnknownPoint(:,3)-Left_y0).^2;Left_xx&#61;UnknownPoint(:,2)&#43;(UnknownPoint(:,2)-Left_x0).*Left_R*Left_L(12);Left_yy&#61;UnknownPoint(:,3)&#43;(UnknownPoint(:,3)-Left_y0).*Left_R*Left_L(12);Right_R&#61;(UnknownPoint(:,4)-Right_x0).^2&#43;(UnknownPoint(:,5)-Right_y0).^2;Right_xx&#61;UnknownPoint(:,4)&#43;(UnknownPoint(:,4)-Right_x0).*Right_R*Right_L(12);Right_yy&#61;UnknownPoint(:,5)&#43;(UnknownPoint(:,5)-Right_y0).*Right_R*Right_L(12);%计算待定点物方坐标近似值B&#61;zeros(3,3);C&#61;zeros(3,1);XYZ&#61;zeros(size(UnknownPoint,1),3);for i&#61;1:size(UnknownPoint,1);B(1,1)&#61;Left_L(1)&#43;Left_xx(i)*Left_L(9);B(1,2)&#61;Left_L(2)&#43;Left_xx(i)*Left_L(10);B(1,3)&#61;Left_L(3)&#43;Left_xx(i)*Left_L(11);B(2,1)&#61;Left_L(5)&#43;Left_yy(i)*Left_L(9);B(2,2)&#61;Left_L(6)&#43;Left_yy(i)*Left_L(10);B(2,3)&#61;Left_L(7)&#43;Left_yy(i)*Left_L(11);B(3,1)&#61;Right_L(1)&#43;Right_xx(i)*Right_L(9);B(3,2)&#61;Right_L(2)&#43;Right_xx(i)*Right_L(10);B(3,3)&#61;Right_L(3)&#43;Right_xx(i)*Right_L(11);C(1,1)&#61;Left_L(4)&#43;Left_xx(i);C(2,1)&#61;Left_L(8)&#43;Left_yy(i);C(3,1)&#61;Right_L(4)&#43;Right_xx(i);XYZ(i,:)&#61;(B\(-C))&#39;;end%计算待定点物方坐标精确值N&#61;zeros(4,3);Q&#61;zeros(4,1);delta_XYZ&#61;100*ones(1,3);            %相邻两次迭代差值for i&#61;1:size(UnknownPoint,1);n&#61;0;                            %统计迭代次数while max(abs(delta_XYZ))>0.000001;A_L&#61;Left_L(9)*XYZ(i,1)&#43;Left_L(10)*XYZ(i,2)&#43;Left_L(11)*XYZ(i,3)&#43;1;N(1,1)&#61;-(Left_L(1)&#43;Left_xx(i)*Left_L(9))/A_L;N(1,2)&#61;-(Left_L(2)&#43;Left_xx(i)*Left_L(10))/A_L;N(1,3)&#61;-(Left_L(3)&#43;Left_xx(i)*Left_L(11))/A_L;N(2,1)&#61;-(Left_L(5)&#43;Left_yy(i)*Left_L(9))/A_L;N(2,2)&#61;-(Left_L(6)&#43;Left_yy(i)*Left_L(10))/A_L;N(2,3)&#61;-(Left_L(7)&#43;Left_yy(i)*Left_L(11))/A_L;A_R&#61;Right_L(9)*XYZ(i,1)&#43;Right_L(10)*XYZ(i,2)&#43;Right_L(11)*XYZ(i,3)&#43;1;N(3,1)&#61;-(Right_L(1)&#43;Right_xx(i)*Right_L(9))/A_R;N(3,2)&#61;-(Right_L(2)&#43;Right_xx(i)*Right_L(10))/A_R;N(3,3)&#61;-(Right_L(3)&#43;Right_xx(i)*Right_L(11))/A_R;N(4,1)&#61;-(Right_L(5)&#43;Right_yy(i)*Right_L(9))/A_R;N(4,2)&#61;-(Right_L(6)&#43;Right_yy(i)*Right_L(10))/A_R;N(4,3)&#61;-(Right_L(7)&#43;Right_yy(i)*Right_L(11))/A_R;Q(1,1)&#61;(Left_L(4)&#43;Left_xx(i))/A_L;Q(2,1)&#61;(Left_L(8)&#43;Left_yy(i))/A_L;Q(3,1)&#61;(Right_L(4)&#43;Right_xx(i))/A_R;Q(4,1)&#61;(Right_L(8)&#43;Right_yy(i))/A_R;XYZ_new&#61;((N&#39;*N)\N&#39;*Q)&#39;;delta_XYZ&#61;XYZ_new-XYZ(i,:);XYZ(i,:)&#61;XYZ_new;n&#61;n&#43;1;endendCoordinate&#61;zeros(size(UnknownPoint,1),4);Coordinate(:,1)&#61;UnknownPoint(:,1);Coordinate(:,2:4)&#61;XYZ;
end

 


推荐阅读
  • 本文探讨了如何在给定整数N的情况下,找到两个不同的整数a和b,使得它们的和最大,并且满足特定的数学条件。 ... [详细]
  • 使用Numpy实现无外部库依赖的双线性插值图像缩放
    本文介绍如何仅使用Numpy库,通过双线性插值方法实现图像的高效缩放,避免了对OpenCV等图像处理库的依赖。文中详细解释了算法原理,并提供了完整的代码示例。 ... [详细]
  • 本文详细介绍了如何在Linux系统上安装和配置Smokeping,以实现对网络链路质量的实时监控。通过详细的步骤和必要的依赖包安装,确保用户能够顺利完成部署并优化其网络性能监控。 ... [详细]
  • 探讨一个显示数字的故障计算器,它支持两种操作:将当前数字乘以2或减去1。本文将详细介绍如何用最少的操作次数将初始值X转换为目标值Y。 ... [详细]
  • 基因组浏览器中的Wig格式解析
    本文详细介绍了Wiggle(Wig)格式及其在基因组浏览器中的应用,涵盖variableStep和fixedStep两种主要格式的特点、适用场景及具体使用方法。同时,还提供了关于数据值和自定义参数的补充信息。 ... [详细]
  • 毕业设计:基于机器学习与深度学习的垃圾邮件(短信)分类算法实现
    本文详细介绍了如何使用机器学习和深度学习技术对垃圾邮件和短信进行分类。内容涵盖从数据集介绍、预处理、特征提取到模型训练与评估的完整流程,并提供了具体的代码示例和实验结果。 ... [详细]
  • 利用决策树预测NBA比赛胜负的Python数据挖掘实践
    本文通过使用2013-14赛季NBA赛程与结果数据集以及2013年NBA排名数据,结合《Python数据挖掘入门与实践》一书中的方法,展示如何应用决策树算法进行比赛胜负预测。我们将详细讲解数据预处理、特征工程及模型评估等关键步骤。 ... [详细]
  • 本文探讨了如何在 F# Interactive (FSI) 中通过 AddPrinter 和 AddPrintTransformer 方法自定义类型(尤其是集合类型)的输出格式,提供了详细的指南和示例代码。 ... [详细]
  • 本文详细介绍了IBM DB2数据库在大型应用系统中的应用,强调其卓越的可扩展性和多环境支持能力。文章深入分析了DB2在数据利用性、完整性、安全性和恢复性方面的优势,并提供了优化建议以提升其在不同规模应用程序中的表现。 ... [详细]
  • 优化ListView性能
    本文深入探讨了如何通过多种技术手段优化ListView的性能,包括视图复用、ViewHolder模式、分批加载数据、图片优化及内存管理等。这些方法能够显著提升应用的响应速度和用户体验。 ... [详细]
  • 本文详细介绍了如何构建一个高效的UI管理系统,集中处理UI页面的打开、关闭、层级管理和页面跳转等问题。通过UIManager统一管理外部切换逻辑,实现功能逻辑分散化和代码复用,支持多人协作开发。 ... [详细]
  • 自学编程与计算机专业背景者的差异分析
    本文探讨了自学编程者和计算机专业毕业生在技能、知识结构及职业发展上的不同之处,结合实际案例分析两者的优势与劣势。 ... [详细]
  • 本文深入探讨了 Python 列表切片的基本概念和实际应用,通过具体示例展示了不同切片方式的使用方法及其背后的逻辑。 ... [详细]
  • 本文探讨了 C++ 中普通数组和标准库类型 vector 的初始化方法。普通数组具有固定长度,而 vector 是一种可扩展的容器,允许动态调整大小。文章详细介绍了不同初始化方式及其应用场景,并提供了代码示例以加深理解。 ... [详细]
  • 本实验主要探讨了二叉排序树(BST)的基本操作,包括创建、查找和删除节点。通过具体实例和代码实现,详细介绍了如何使用递归和非递归方法进行关键字查找,并展示了删除特定节点后的树结构变化。 ... [详细]
author-avatar
花非花红非红
这个家伙很懒,什么也没留下!
PHP1.CN | 中国最专业的PHP中文社区 | DevBox开发工具箱 | json解析格式化 |PHP资讯 | PHP教程 | 数据库技术 | 服务器技术 | 前端开发技术 | PHP框架 | 开发工具 | 在线工具
Copyright © 1998 - 2020 PHP1.CN. All Rights Reserved | 京公网安备 11010802041100号 | 京ICP备19059560号-4 | PHP1.CN 第一PHP社区 版权所有