视觉slam中Sophus库的基本使用

这篇具有很好参考价值的文章主要介绍了视觉slam中Sophus库的基本使用。希望对大家有所帮助。如果存在错误或未考虑完全的地方,请大家不吝赐教,您也可以点击"举报违法"按钮提交疑问。

一、Sophus库简介:

Eigen库是一个开源的C++线性代数库,它提供了快速的有关矩阵的线性代数运算,还包括解方程等功能。但是Eigen库提供了集合模块,但没有提供李代数的支持。一个较好的李群和李代数的库是Sophus库,它很好的支持了SO(3),so(3),SE(3)和se(3)。Sophus库是基于Eigen基础上开发的,继承了Eigen库中的定义的各个类。因此在使用Eigen库中的类时,既可以使用Eigen命名空间,也可以使用Sophus命名空间。

Eigen::Matrix3d和Sophus::Matrix3d
Eigen::Vector3d和Sophus::Vector3d

此外,为了方便说明SE(4)和se(4),Sophus库还typedef了Vector4d、Matrix4d、Vector6d和Matrix6d等,即:

Sophus::Vector4d
Sophus::Matrix4d
Sophus::Vector6d
Sophus::Matrix6d

二、Sophus的基本使用

笔者使用的是带模板的Sophus库,本库使用起来也很简单。其中李代数下的SO3的类为

Sophus::SO3d ,可以直接使用Eigen中的旋转矩阵和四元数进行初始化。

     AngleAxisd roation_vector(M_PI/2,Vector3d(0,0,1));
    Eigen::Matrix3d R=roation_vector.toRotationMatrix();

    Quaterniond q(R);
    Sophus::SO3d so3_R(R);
    Sophus::SO3d so3_Q(q);

了解李群李代数的都知道SO3上还是表示矩阵,我们初始化的矩阵如何进行输出?需要.matrix()输出矩阵。

    cout<<"this from matrix : \n"<<so3_R.matrix()<<endl;
    cout<<"this from quater : \n"<<so3_Q.matrix()<<endl;

1、使用对数映射转换为so3

SO3.log()就可以将SO3上的元素对数表示到so3中,其中so3的定义依然是Vector3d,其实就是Eigen中的类。

    Vector3d so3=so3_Q.log();
    cout<<"so3 = \n"<<so3.transpose()<<endl;

 2、so3->SO3

使用SO3d::hat()可以实现so3->SO3的转换。

    //将so3转换到SO3中
    cout<<"so3 hat= \n"<<Sophus::SO3d::hat(so3)<<end

 使用so3d::vee可以实现SO3->so3的转换:

    //SO3转换到so3中
    cout<<"SO3 vee=\n"<<Sophus::SO3d::vee(Sophus::SO3d::hat(so3)).transpose()<<endl

 3、增加扰动

 学过slam十四讲的应该知道,旋转矩阵不满足加法的封闭,这样求导就很麻烦。所以引了BCH近似公式来近似加法。Sophus中提供exp用来进行计算:

    Vector3d update_so3(1e-4,0,0);//增加扰动
    Sophus::SO3d SO3_updated=Sophus::SO3d::exp(update_so3)*so3_R;
    cout<<"so3 update =\n"<<SO3_updated.matrix()<<endl;

学完so3和SO3接下的SE3就很简单了是大同小异的,所以直接贴代码很容易就可以看懂。

4、SE3和se3

      //se3和SE3
    Vector3d t(1,0,0);
    Sophus::SE3d SE3_Rt(R,t);
    Sophus::SE3d SE3_qt(q,t);

    cout<<"this from matrix : \n"<<SE3_Rt.matrix()<<endl;
    cout<<"this from quater : \n"<<SE3_qt.matrix()<<endl;

    //因为se3为6维的向量,而Eigen中没有6为vecor6d,所以自己定义一个
    typedef Eigen::Matrix<double,6,1>  Vector6d;
    Vector6d se3=SE3_Rt.log();
    cout<<"se3= \n"<<se3.transpose()<<endl;     //平移在前而旋转在后

    //同样使用exp和vee
     //将se3转换到SE3中
    cout<<"se3 hat= \n"<<Sophus::SE3d::hat(se3)<<endl;

    //SE3转换到se3中
    cout<<"SE3 vee=\n"<<Sophus::SE3d::vee(Sophus::SE3d::hat(se3)).transpose()<<endl;

    //同样加入扰动
    Vector6d update_se3;
    update_se3.setZero();
    update_se3(1,0)=1e-4d;
    cout<<"update_se3 is \n"<<update_se3.transpose()<<endl;
    Sophus::SE3d SE3_updated=Sophus::SE3d::exp(update_se3)*SE3_Rt;
    cout<<" SE3 update is \n"<<SE3_updated.matrix()<<endl;

以下为so3到SO3转换和SE3到se3的转换图:

视觉slam中Sophus库的基本使用

 文章来源地址https://www.toymoban.com/news/detail-408158.html

到了这里,关于视觉slam中Sophus库的基本使用的文章就介绍完了。如果您还想了解更多内容,请在右上角搜索TOY模板网以前的文章或继续浏览下面的相关文章,希望大家以后多多支持TOY模板网!

本文来自互联网用户投稿,该文观点仅代表作者本人,不代表本站立场。本站仅提供信息存储空间服务,不拥有所有权,不承担相关法律责任。如若转载,请注明出处: 如若内容造成侵权/违法违规/事实不符,请点击违法举报进行投诉反馈,一经查实,立即删除!

领支付宝红包 赞助服务器费用

相关文章

  • C++矩阵计算-杂记(包含Eigen库的安装)

    C++可以使用多种方法进行矩阵计算,其中常见的两种方式为使用已有的矩阵库或手写矩阵运算代码。 在C++中可以使用许多开源矩阵库进行矩阵计算,比如Eigen、Armadillo等。这些库提供了简单易用的API,可以完成矩阵的基本运算,如加减乘除、转置、求逆、求特征值和特征向量

    2024年02月02日
    浏览(45)
  • SLAM——Eigen函数库之矩阵块运算,高阶操作middleCols与segment用法

    Eigen/四元数/欧拉角/旋转矩阵 相关系列文章 Eigen/Matlab 使用小结 SLAM——之Eigen入门(矩阵运算及几何模块) SLAM——之Eigen函数库,一个相对复杂的EIgen使用实例 SLAM——Eigen函数库:矩阵块运算,block操作 SLAM——Eigen函数库之 Eigen::Ref 使用实例 欧拉角和旋转矩阵相互转换 四元数

    2024年02月10日
    浏览(44)
  • 视觉学习笔记4——ORB-SLAM3的地图保存与使用

    前言:视觉学习笔记4——学习研究ORB-SLAM3 ORB-SLAM3基本搭建完成,具体可以看开头的系列文章目录,接下来需要研究如何自定义自己的地图,也就是实时地图的保存与运用。 按照开源说明来看,地图保存与加载在V1.0已经实现了,需要修改相应的yaml文件即可,也就是相机yaml文

    2024年02月06日
    浏览(51)
  • Python - OpenCV机器视觉库的简单使用经验

    OpenCV是一个开源的计算机视觉库,它支持多种编程语言,包括Python。下面是Python 3中OpenCV的详细解析: 安装OpenCV 在Python 3中安装OpenCV,可以使用pip命令来安装。例如,在终端中输入以下命令: 打开和读取图像 使用Opencv读取图像,可以使用cv2.imread()函数。该函数接受一个参数

    2024年02月15日
    浏览(37)
  • Windows VsCode 配置 Eigen 库 - C++矩阵计算库的配置 - 手把手教程

    Eigen是一个用来进行矩阵处理的C++库,除了 C++ 标准库之外,Eigen 不需要其他任何依赖项。 官网 https://eigen.tuxfamily.org 直接点击最新版(当前是3.4.0)对应的zip文件下载即可。 解压后文件目录如下: 其中 Eigen 就是存放要Include的头文件的地方。 最好新建一个文件夹专门用来写Ei

    2023年04月08日
    浏览(40)
  • Pywin32:Python库的简介、安装和使用攻略

    Pywin32:Python库的简介、安装和使用攻略 Pywin32是Python的一个强大而广泛使用的库,它提供了访问Windows API的接口,以实现处理Windows系统资源的功能,如窗口管理、注册表操作、消息传递等等。这里我们将为您详细介绍pywin32的安装和使用方法,包括如何使用它来完成在Windows系

    2024年02月07日
    浏览(52)
  • Python-can库的使用(1)——简介与安装

    🙆‍♂️我是纯良思安,爱技术、爱分享,更爱生活🙆‍♂️ 💖喜欢的朋友可以关注一下,下次更新不迷路💖 文章目录 1、简介 1.1 主要功能 1.2 官方库文档描述 2、安装 2.1、GNU/Linux 依赖项 2.2、Windows 依赖项 Kvaser PCAN IXXAT NI-CAN neoVI Vector CANtact CanViewer 在开发模式下安装Py

    2024年02月20日
    浏览(114)
  • Transformers 库的基本使用

      本内容主要介绍 Transformers 库 的基本使用。   Transformers 库是一个开源库,其提供的所有预训练模型都是基于 transformer 模型结构的。   我们可以使用 Transformers 库提供的 API 轻松下载和训练最先进的预训练模型。使用预训练模型可以降低计算成本,以及节省从头开始

    2024年02月03日
    浏览(37)
  • Sophus库使用笔记

    Eigen库是一个开源的C++线性代数库,它提供了快速的有关矩阵的线性代数运算,还包括解方程等功能。但是Eigen库提供了集合模块,但没有提供李代数的支持。一个较好的李群和李代数的库是Sophus库,它很好的支持了SO(3),so(3),SE(3)和se(3)。Sophus库是基于Eigen基础上开发的,继承了

    2024年02月16日
    浏览(31)

觉得文章有用就打赏一下文章作者

支付宝扫一扫打赏

博客赞助

微信扫一扫打赏

请作者喝杯咖啡吧~博客赞助

支付宝扫一扫领取红包,优惠每天领

二维码1

领取红包

二维码2

领红包