SLAM中“camera类中坐标转换方法解读

/*
p_p : position_pexil  ;  p_c：position_camera  ; p_w : position_world ; T_c_w : 欧式矩阵(包含R,t信息) from camera to world cpp功能：实现关于pexil,camera,world的任意两者间的坐标转换。pixel2world的实现是能过两步实现的： pixel -> camera ,进而 camera -> world ，反之， world2pixel 也一样。
*/
#include "myslam/camera.h"namespace myslam
{Camera::Camera()
{}Vector3d Camera::world2camera ( const Vector3d& p_w, const SE3& T_c_w )
{return T_c_w*p_w; // T_c_w即欧式矩阵，包含R,t的信息，公式为 T * P_world
}Vector3d Camera::camera2world ( const Vector3d& p_c, const SE3& T_c_w )
{return T_c_w.inverse() *p_c;
}//为什么p_c用两个值来索引，它不是一维向量吗?
//the convenience Vector3f is a (column) vector of 3 floats. It is defined as follows by Eigen:   Matrix<float, 3, 1> Vector3f;
//We also offer convenience typedefs for row-vectors, for example: Matrix<int, 1, 2> RowVector2i;
//so Vector3d is a  column vector ,they have 3 rows;
Vector2d Camera::camera2pixel ( const Vector3d& p_c )
{return Vector2d (//参照书本5.5的公式fx_ * p_c ( 0,0 ) / p_c ( 2,0 ) + cx_,fy_ * p_c ( 1,0 ) / p_c ( 2,0 ) + cy_);
}Vector3d Camera::pixel2camera ( const Vector2d& p_p, double depth )
{return Vector3d (//参照书本5.5的公式，depth 即为公式的Z。( p_p ( 0,0 )-cx_ ) *depth/fx_,( p_p ( 1,0 )-cy_ ) *depth/fy_,depth);
}Vector2d Camera::world2pixel ( const Vector3d& p_w, const SE3& T_c_w )
{return camera2pixel ( world2camera ( p_w, T_c_w ) );
}Vector3d Camera::pixel2world ( const Vector2d& p_p, const SE3& T_c_w, double depth )
{return camera2world ( pixel2camera ( p_p, depth ), T_c_w );
}}

SLAM中“camera类中坐标转换方法解读相关推荐

idea中查看类中所有方法列表(Alt+7)(亲测)
idea中查看类中所有方法列表当我们在开发中,或者在读别人代码时,如何能快速定位到想看的方法: 我们以activiti中的RepositoryService为例,如下图,RepositoryServ ...
C++中若类中没有默认构造函数，如何使用对象数组
前言: 如果定义一个类,有其默认的构造函数,则使用new动态实例化一个对象数组,不是件难事,如下代码: 1 #include <memory> 2 #include <iostrea ...
python中同一个类中方法之间的变量怎么调用
class A:A = "你好"def test_a(self):self.m = "hello" #实例变量def test_b(self):self.tes ...
C++中模板类中的成员函数以及模板函数在类外定义
在C++中,类中的成员函数可以在类外完成定义,从而显得类中的成员函数看起来简洁明了.但是模板类里的成员函数和模板函数与普通的成员函数在类外定义不同. 先定义一个模板类以及成员函数和模板函数: 接下我们 ...
C#中File类中文件的读取写入
C#中File类中文件的读取写入注意:使用File读取写入文件非常简单,但FIle的操作方式决定只能读取小文件,读写时全部加载进行读取.读写大文件时建议使用文件流. 常用方法 //获取所有编码方式 ...
PHP中的类与对象详细解读
1. 类与对象类是面向对象程序设计的基本概念,是一类东西的结构描述 , 是一种抽象的概念 . 对象是一类东西的一个具体的实例 , 是具体事物 . 对象通过new关键字进行实例化: 比如汽车可以抽象为 ...
java中File类中list（）和listFiles（）方法区别
list()和listFiles()方法区别: 1.返回值类型不同:前者为String数组,后者为File对象数组 2.数组中元素内容不同:前者为string类型的[文件名](包含后缀名),后者为Fi ...
java程序中出现两个class,Java中Class类中两个值得注意的进行类型动态转换的方法...
Java中的Class类有两个重要的方法:cast()和asSubclass().这两个方法都是用于Class类进行运行时(run-time)阶段的类型转换的.下面来看看他们的定义和使用: 第一个方法 ...
java中string的方法_java中String类中的常用方法
@Test public void testToString2() { /** * 他会调用toString方法他调用的其实是Object类中的toString方法引用会隐式调用toStri ...

SLAM中“camera类中坐标转换方法解读

SLAM中“camera类中坐标转换方法解读相关推荐

最新文章

热门文章