视觉(3)blepo
视觉(3)blepo
把matlab转成c程序有好办法了,从网上下载了一个函数库blepo,转换为c几乎是一行对一行,openCv经常涉及到的内存申请和释放这里都不用管。高兴!
看看这段程序比较一下差别
matlab的
%ART Factorize camera matrix into intrinsic and extrinsic matrices
%
% [A,R,t] = art(P,fsign) factorize the projection matrix P
% as P=A*[R;t] and enforce the sign of the focal lenght to be fsign.
% By defaukt fsign=1.
% Author: A. Fusiello, 1999
%
% fsign tells the position of the image plane wrt the focal plane. If it is
% negative the image plane is behind the focal plane.
% by default assume POSITIVE focal lenght
if nargin == 1
fsign = 1;
end
s = P(1:3,4);
Q = inv(P(1:3, 1:3));
[U,B] = qr(Q);
% fix the sign of B(3,3). This can possibly change the sign of the resulting matrix,
% which is defined up to a scale factor, however.
sig = sign(B(3,3));
B=B*sig;
s=s*sig;
% if the sign of the focal lenght is not the required one,
% change it, and change the rotation accordingly.
if fsign*B(1,1) < 0
E= [-1 0 0
0 1 0
0 0 1];
B = E*B;
U = U*E;
end
if fsign*B(2,2) < 0
E= [1 0 0
0 -1 0
0 0 1];
B = E*B;
U = U*E;
end
% if U is not a rotation, fix the sign. This can possibly change the sign
% of the resulting matrix, which is defined up to a scale factor, however.
if det(U)< 0
U = -U;
s= - s;
end
% sanity check
if (norm(Q-U*B)>1e-10) & (norm(Q+U*B)>1e-10)
error('Something wrong with the QR factorization.'); end
R = U';
t = B*s;
A = inv(B);
A = A ./A(3,3);
% sanity check
if det(R) < 0 error('R is not a rotation matrix'); end
if A(3,3) < 0 error('Wrong sign of A(3,3)'); end
% this guarantee that the result *is* a factorization of the given P, up to a scale factor
W = A*[R,t];
if (rank([P(:), W(:)]) ~= 1 )
error('Something wrong with the ART factorization.'); end
c++的:
//A,R 3*3,T 3*1
void art(MatDbl P,
OUT MatDbl *A,OUT MatDbl *R,OUT MatDbl *T,
int fsign=1)
{
MatDbl s;
MatDbl Q;
s=P.GetSubMat(0,3,3,1);
Q=Inverse(P.GetSubMat(0,0,3,3));
// Display(s,"s");
// Display(Q,"Q");
MatDbl U,B;
Qr(Q,&U,&B);
// PrintF(U,"U");
// PrintF(B,"B");
// PrintF(U*B-Q,"U*B-Q");
// PrintF(U*Transpose(U),"U*U'");
if(B(2,2)<0)
{
Negate(B,&B);
Negate(s,&s);
}
if(fsign*B(0,0)<0)
{
double E[9]={-1 ,0 ,0 ,0 ,1 ,0 ,0 ,0 ,1};
MatDbl _E;
_E.FromArray(E,3,3);
B=_E*B;
U=U*_E;
}
if(fsign*B(1,1)<0)
{
double E[9]={1 ,0 ,0 ,0 ,-1 ,0 ,0 ,0 ,1};
MatDbl _E;
_E.FromArray(E,3,3);
B=_E*B;
U=U*_E;
}
if(Determinant(U)<0)
{
Negate(U,&U);
Negate(s,&s);
}
// if(Norm((Q-U*B))>1e-10 && Norm((Q+U*B).ToVector)>1e-10)
// printf("'Something wrong with the QR factorization.'\n") ;
*R=Transpose(U);
*T=B*s;
*A=Inverse(B);
*A= *A * (1.0 / (*A)(2,2));
// PrintF(*A,"A");
// PrintF(*R,"R");
// PrintF(*T,"T");
// PrintF((*A) * (*R),"A*R");
// PrintF((*A) * (*T),"A*T");
}
//[T1,T2,Pn1,Pn2] = rectify(Po1,Po2,d1,d2)
void Rectify(MatDbl Po1,MatDbl Po2,
OUT MatDbl &T1,OUT MatDbl &T2,OUT MatDbl &Pn1,OUT MatDbl &Pn2
/*double d1=0,double d2=0*/)
{
MatDbl A1,R1,t1;
MatDbl A2,R2,t2;
art(Po1,&A1,&R1,&t1);
art(Po2,&A2,&R2,&t2);
MatDbl c1,c2;
c1=-Transpose(R1)*Inverse(A1)*Po1.GetSubMat(0,3,3,1);
c2=-Transpose(R2)*Inverse(A2)*Po2.GetSubMat(0,3,3,1);
// PrintF(c1,"c1");
// PrintF(c2,"c2");
MatDbl v1,v2,v3;
v1=c2-c1;
v2=CrossProduct(Transpose(R1.GetSubMat(2,0,1,3)),v1);
v3=CrossProduct(v1,v2);
// Display(v1,"v1");
// Display(v2,"v2");
// Display(v3,"v3");
v1=(v1 * (1.0/Norm(v1)));
v2=(v2 * (1.0/Norm(v2)));
v3=(v3 * (1.0/Norm(v3)));
double r[9]={v1(0),v1(1),v1(2),
v2(0),v2(1),v2(2),
v3(0),v3(1),v3(2)};
MatDbl R;
R.FromArray(r,3,3);
//Display(R,"R");
MatDbl An1=A2;
An1(1,0)=0;
MatDbl An2=An1;
//PrintF(An1,"An1");
// Display(An1 *(-1.0) * R * c1,"An1 *(-1.0) * R * c1");
Pn1=An1 * PackX(R, (-1.0) * R * c1);
Pn2=An2 * PackX(R, (-1.0) * R * c2);
PrintF(Pn1,"Pn1");
PrintF(Pn2,"Pn2");
T1=Pn1.GetSubMat(0,0,3,3) * Inverse(Po1.GetSubMat(0,0,3,3));
T2=Pn2.GetSubMat(0,0,3,3) * Inverse(Po2.GetSubMat(0,0,3,3));
PrintF(T1,"T1");
PrintF(T2,"T2");
}
视觉(3)blepo的更多相关文章
- 理解CSS视觉格式化
前面的话 CSS视觉格式化这个词可能比较陌生,但说起盒模型可能就恍然大悟了.实际上,盒模型只是CSS视觉格式化的一部分.视觉格式化分为块级和行内两种处理方式.理解视觉格式化,可以确定得到的效果是应 ...
- CSS学习笔记——视觉格式化模型 visual formatting model
CSS 视觉格式化模型(visual formatting model)是用来处理文档并将它显示在视觉媒体上的机制.他有一套既定的规则(也就是W3C规范),规定了浏览器该怎么处理每一个盒子.以下内容翻 ...
- 【原】为什么选择iPhone5的分辨率作为H5视觉稿尺寸
[20160105更新:可以用iPhone6分辨率为视觉稿尺寸啦] 又是一年的520网络情人节,深圳这边却下了大雨,这雨只能是单身汉的泪,而对于我来说这一天具有特别的意义,一来怀念父亲,二来对我这种结 ...
- 怪物AI之发现玩家(视觉范围发现系列)
在网上找到一些资料参考,然后写写自己的想法. 这里感谢MOMO等大神. 我们用玩家检测怪物的方法来测,这样比较试用与弱联网游戏,每次在同步玩家的时候来判断玩家与怪物的位置. 这里给出两个处理方式: 1 ...
- 【转】Caffe初试(五)视觉层及参数
本文只讲解视觉层(Vision Layers)的参数,视觉层包括Convolution, Pooling, Local Response Normalization (LRN), im2col等层. ...
- 视觉机器学习笔记------CNN学习
卷积神经网络是第一个被成功训练的多层神经网络结构,具有较强的容错.自学习及并行处理能力. 一.基本原理 1.CNN算法思想 卷积神经网络可以看作为前馈网络的特例,主要在网络结构上对前馈网络进行简化和改 ...
- 视觉机器学习------K-means算法
K-means(K均值)是基于数据划分的无监督聚类算法. 一.基本原理 聚类算法可以理解为无监督的分类方法,即样本集预先不知所属类别或标签,需要根据样本之间的距离或相似程度自动进行分类.聚 ...
- MG--滚动的视觉差效果
#几句代码完成tableView滚动的视觉差 - 效果图 (失帧严重)![](http://upload-images.jianshu.io/upload_images/1429890-f2c8577 ...
- 大前端学习笔记整理【二】CSS视觉格式化模型
1. 概念 在视觉格式化模型中,文档树中的每个元素都将会根据盒模型产生零到多个盒子.这些盒子的布局由如下因素决定: 盒子的尺寸和类型 定位策略(正常文档流,浮动或者绝对定位) 和文档树中其他元素的关系 ...
随机推荐
- NPC AI驱动最基本过程
NPC AI驱动最基本过程 NPCmgr中比较重要的是加载NPC和一个NPCAI的一个指针 他利用map那个线程的定时到底做了啥呢 void NPCmgr::npcAITimer() { time_t ...
- BZOJ: 1084: [SCOI2005]最大子矩阵
NICE 的DP 题,明白了题解真是不错. Time Limit: 10 Sec Memory Limit: 162 MBSubmit: 1228 Solved: 622[Submit][Stat ...
- Asp.net MVC 实现图片上传剪切
使用技术:Asp.net MVC与jquery.uploadify,Jcrop 首先上页面 01 <strong><!DOCTYPE html> 02 <html> ...
- codeforces 430A Points and Segments (easy)(理解能力有待提高……)
题目 //终于看懂题目了,,,, //一条线段里面不是每个坐标上都有要染色的点,所以为了满足条件,只能考虑那些给出坐标的点 //所以就要排序一下了,不能直接根据坐标0 1 0 1…… #include ...
- 安装DirectX SDK (June 2010) 失败(Error Code S1023)(转)
解决: 在控制面板里面搜索“Microsoft Visual C++*”,然后卸载,这个工具的名字大概是: Microsoft Visual C++ 2010 x86/x64 redistribuab ...
- ExtJs之Ext.util.ClickRepeater
<!DOCTYPE html> <html> <head> <title>ExtJs</title> <meta http-equiv ...
- WCF分布式开发步步为赢(8):使用数据集(DataSet)、数据表(DataTable)、集合(Collection)传递数据
数据集(DataSet).数据表(DataTable).集合(Collection)概念是.NET FrameWork里提供数据类型,在应用程序编程过程中会经常使用其来作为数据的载体,属于ADO.NE ...
- JS初学的一些易错的知识点
1. false ,0 , "" ,undefined , null 在Boolean 环境下当成 false: null 在数值环境下当成 0: undefined 在数值 ...
- 使用dnsmasq快速搭建内网DNS
背景介绍公司有一批测试服务器,之间希望通过自定义的域名进行访问,这样比较方便,但每个人每台机器都维护一个hosts的话会非常麻烦,于是想搭建一个内部的DNS服务器,对自定义的域名进行解析,同时缓存公网 ...
- ffmpeg转码MPEG2-TS的音视频同步机制分析
http://blog.chinaunix.net/uid-26000296-id-3483782.html 一.FFmpeg忽略了adaptation_field()数据 FFmpeg忽略了包含PC ...