Sophus和Eigen 李群李代數 簡單介紹

2022-09-14 16:06:25 字數 930 閱讀 8450

sophus中似乎沒有李代數的表示(儘管庫中都用se3、so3,但是對於這個庫,作者似乎表達的是李群的意思);比如你定義乙個李群,要將他表示成李代數。

可以這樣寫:

1

sophus::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 3

using

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來表示。李代數相當於李群的導數,即角速度 速度 與角度 位置 的關係,代...