SLAM中的非线性优-3D图优化之相对位姿Between Factor-SO3/t形式(十一)

本节开始讲解SO3+t的形式来推导相对位姿之间的雅可比跟残差,因为在实际求解过程中,也可能只有纯旋转或者纯平移的情况,因此,这里采用分开方式推导,从而兼容这种单一融合的需求,接下来依然沿用之前的图

一. 右扰动问题描述

二. 旋转部分

三. 平移部分

四. 完整雅可比矩阵

4.3 SO(3) 右雅可比

小角度近似

五. 左扰动模型

5.1 相对位姿残差

5.2 旋转部分(使用左扰动)

5.2.1 旋转残差

5.2.2旋转雅可比(左扰动)

5.2.3平移残差

5.2.4 平移雅可比(左扰动)

**六.**完整雅可比矩阵(左扰动)

参数顺序

完整雅可比矩阵

SO(3) 左雅可比

左雅可比的性质

总结(左扰动 vs 右扰动)

相关推荐
光锥智能6 小时前
WAIC亮点|兼具泛化能力与作业效率的极智嘉机器人天团
人工智能·机器人
阳光是sunny6 小时前
LangGraph中的Reducer是什么
前端·人工智能·后端
甲维斯7 小时前
Kimi K3 重构10000行单文件屎山代码!
人工智能
旖-旎7 小时前
LeetCode 518:零钱兑换||(完全背包)—— 题解
c++·算法·leetcode·动态规划·背包问题
阳光是sunny7 小时前
从链到图:LangGraph 入门基础全解析
前端·人工智能·后端
新知图书7 小时前
11.3 详细实现与核心配置(作业批改智能体开发)
人工智能·agent·ai agent·智能体·扣子
To_OC7 小时前
LC 42 接雨水:暴力超时卡半天?前后缀数组一用就通了
javascript·算法·leetcode
深度研习笔记8 小时前
OpenCV工业视觉实战11|多线程解耦+视频流稳流+推理加速,彻底解决卡顿阻塞,实现毫秒级工业实时检测
人工智能·opencv·计算机视觉
delishcomcn8 小时前
AI视觉识别+分切算法:电化铝缺陷检测与裁切一体化解锁
人工智能·算法
触底反弹8 小时前
深入理解大模型采样:Temperature、Top-K、Top-P 的原理与实战
人工智能·算法·面试