视觉SLAM学习:Sophus库中 SO(3)和SE(3)的使用方法

视觉SLAM学习:Sophus库中 SO(3)和SE(3)的使用方法

一、SO(3)的使用方法

1.1 构造

首先可以构造旋转矩阵或四元数:

Matrix3d R=AngleAxisd(M_PI/2,Vector3d(0,0,0)).toRotationMatrix();
Quaterniod q(R);

接着根据旋转矩阵或四元数构造SO(3)

Sophus::SO3d SO3_R(R);
Sophus::SO3d SO3_q(q);

1.2 李代数用法

使用对数映射获得它的李代数

Vector3d so3=SO3_R.log
评论 1
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值