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 右扰动)

相关推荐
大刚测试开发实战7 小时前
TestHub V0.2.2版本发布,附更新指南
人工智能
冬奇Lab8 小时前
Agent 系列(21):Harness 测试工程——45 个测试怎么设计,以及它发现了什么 bug
人工智能·llm·agent
冬奇Lab8 小时前
每日一个开源项目(第133篇):EchoBird - 把 AI 工具的安装和部署做成傻瓜操作
人工智能·开源·资讯
IT_陈寒10 小时前
Redis的SETNX并发问题让我加了三天班
前端·人工智能·后端
用户51914958484511 小时前
Windows 渗透测试载荷加载器 POC 工具集
人工智能·aigc
大树8811 小时前
金刚石散热越强,管路越先见顶
大数据·运维·服务器·人工智能·ai
通信小呆呆11 小时前
当算法有了“五感”:多模态数据融合如何向人体感官协同学习?
人工智能·学习·算法·机器学习·机器人
施小赞11 小时前
普通 RAG vs GraphRAG 核心对比
人工智能·ai
EAIReport11 小时前
RuoYi-AI 企业级AI开发平台实战详解
人工智能
HelloWorld__来都来了12 小时前
【每日学术速报】2026-06-15
人工智能·具身智能