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

相关推荐
美酒没故事°21 小时前
Open WebUI安装指南。搭建自己的自托管 AI 平台
人工智能·windows·ai
云烟成雨TD21 小时前
Spring AI Alibaba 1.x 系列【6】ReactAgent 同步执行 & 流式执行
java·人工智能·spring
小O的算法实验室21 小时前
2026年ASOC,基于深度强化学习的无人机三维复杂环境分层自适应导航规划方法,深度解析+性能实测
算法·无人机·论文复现·智能算法·智能算法改进
AI攻城狮21 小时前
用 Obsidian CLI + LLM 构建本地 RAG:让你的笔记真正「活」起来
人工智能·云原生·aigc
鸿乃江边鸟21 小时前
Nanobot 从onboard启动命令来看个人助理Agent的实现
人工智能·ai
lpfasd12321 小时前
基于Cloudflare生态的应用部署与开发全解
人工智能·agent·cloudflare
俞凡21 小时前
DevOps 2.0:智能体如何接管故障修复和基础设施维护
人工智能
comedate1 天前
[OpenClaw] GLM 5 关于电影 - 人工智能 - 的思考
人工智能·电影评价
财迅通Ai1 天前
6000万吨产能承压 卫星化学迎来战略窗口期
大数据·人工智能·物联网·卫星化学
liliangcsdn1 天前
Agent Memory智能体记忆系统的示例分析
数据库·人工智能·全文检索