BA优化中,存在5个相机10个点,假设10个点都能被观测到,求状态矩阵维度、误差矩阵维度、雅各比维度

状态矩阵:1x(5x6+10x3)=1x60
SLAM中相机姿态用李代数(SE3)表示, SE3是6维的,路边点的位置是三维的(X,Y,Z),因此状态矩阵的维度是60
误差矩阵:2x5x10 = 100
一个路标点的误差的维度为2,误差即为实际像素坐标( u ^ , v ^ \hat{u},\hat{v} u^,v^)与观测的路标点的像素{ u , v u,v uv}之间的误差。一个相机中10个点的误差维度为20,5个相机为100。
雅克比矩阵维度:100x60
雅克比矩阵为误差矩阵对状态矩阵求导,维度为误差矩阵维度x状态矩阵维度,即100x60

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

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值