sophus中似乎沒有李代數的表示(儘管庫中都用se3、so3,但是對於這個庫,作者似乎表達的是李群的意思);比如你定義乙個李群,要將他表示成李代數。
可以這樣寫:
1sophus::se3 se3_;
2 typedef eigen::matrixvector6d;
3 vector6d se3 = se3_.log;
此外se3的構造方式也可以是:
cv::solvepnpransac(pts3d, pts2d, k, mat(), rvec, tvec, false, 100, 1.0, 0.99, inliers);
t_c_w_estimated_ =se3(
so3(rvec.at
(0, 0), rvec.at(1, 0), rvec.at(2, 0
)), vector3d(tvec.at
(0, 0), tvec.at(1, 0), tvec.at(2, 0
)) );
1 #include 2 #include 3using
namespace
std;
45 #include6
7 #include 8 #include 9
10 #include "
so3.h
"11 #include "
se3.h"12
13#define m_pi 3.1415926535897932384626433832795
14//
cv_pi
1516
//1718
int main(int argc, char**ar**)
19
除錯結果:自己看ide看看
如何安裝Eigen庫和Sophus庫
查詢老版本sudo updatedb locate eigen3 刪除老版本檔案將列舉出來了檔案刪除,篩選條件 必刪除項 為 usr include eigen3 usr lib cmake eigen3 usr share doc libeigen3 dev usr share pkgconfig...
李群和李代數的關係
三維旋轉矩陣構成了特殊正交群so 3 而變換矩陣構成了特殊歐氏群se 3 那什麼是群呢?群 group 是一種集合加上一種運算的代數結構。我們把集合記作a,運算記作 那麼群可以記作g a,群要求這個運算滿足以下幾個條件 李群是指具有連續 光滑 性質的群。像整數群z 那樣離散的群沒有連續性質,所以不是...
李群與李代數
先來張整體的從csdn截的圖 該圖 展示了我所認知的李群 李代數抽象概念。這裡,進一步解說下 so 3 是旋轉群,相當於剛體僅作空間轉動的姿態幾何 se 3 是運動群,包括轉動和平動兩部分,上式中t代表位置 x,y,z 一般用p來表示。李代數相當於李群的導數,即角速度 速度 與角度 位置 的關係,代...