slam
陈君豪
在无尾熊的世界里,有尾巴的就是王
展开
-
SE(3)的BCH扰动模型
当我们在优化SE3的时候,Jacobian就是SE3的微小变动,对于最终投影点的变化,此时我们会把这个过程分为2个阶段,第一个阶段是SE3的变化对于世界坐标转成相机坐标的变化,第二个阶段是相机坐标的变化导致投影点的变化(这个部分与SE3无关,和相机参数有关)不一样的原因是我们写推导过程的偏微分是先写旋转的变化再写平移的变化,但是VertexSE3Expmap里面是先输入平移的t在输入旋转的r,所以左右位置要互换。可是代码里输入的是 [-(Rp+t), I]SE3deriv的推导如下。原创 2023-06-13 20:35:35 · 379 阅读 · 0 评论 -
从角速度到旋转矩阵和Jacobian
【代码】从角速度到旋转矩阵和Jacobian。原创 2023-06-13 05:25:01 · 166 阅读 · 0 评论