DSO中的stitchDoubleInternal函数中一个细节计算

记录下来吧。

代码:

H[tid].block<8,8>(hIdx, hIdx).noalias() += EF->adHost[aidx] * accH.block<8,8>(CPARS,CPARS) * EF->adHost[aidx].transpose();

adHost为在此之前的函数求解的相对位姿增量对绝对位姿增量的偏导,以及光度参数偏导组成的8*8矩阵。

accH.block<8,8>(CPARS,CPARS)是在上一步函数中计算的,是(d(fx)/d(g))转置*(d(fx)/d(g))     g包含了位姿和仿射系数 d表示求偏导

上面那个公式最终的形式类似  (d(fx)/d(g))转置*(d(fx)/d(g))  只不过里面的g由原来的相对位姿光度增量变成了host帧的绝对位姿增量和光度增量。

公式展开推导一下就可以看到这一步实现了偏差对相对位姿的偏导变成了偏差对绝对位姿的偏导。

  • 0
    点赞
  • 0
    收藏
    觉得还不错? 一键收藏
  • 1
    评论
评论 1
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值