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 小时前
【维克】指数调整:哪些股票会被“强制买入“?
人工智能·python·算法
梧桐1687 小时前
14天、31个缺陷、28个测试脚本—用 Claude Code 完成第三方软件测试
人工智能·测试工具
罗西的思考7 小时前
【轻量化复刻大模型】线性注意力交互式演示
人工智能·算法·机器学习
神也畏惧菠萝8 小时前
Day08 Python流程控制从入门到上瘾:if/match/while/for四件套,从B站登录一路打到猜数字游戏
python·算法·数据存储·for·while·if·ifelse
美狐美颜sdk8 小时前
视频美颜SDK中的YUV与RGBA格式有什么区别?直播APP开发解析
人工智能·计算机视觉·音视频·美颜sdk·直播美颜sdk·视频美颜sdk
jimmyleeee8 小时前
Agent安全之七:当智能体之间开始“互相信任”------深入理解 OWASP ASI07 不安全的智能体间通信
人工智能·安全
言乐68 小时前
通过 3D 动画直观演示球形瓶内可滑动半圆机构在倾倒时防粘盖、回正时刮膏体的运动学过程
python·3d·django·virtualenv·pygame
二哈赛车手8 小时前
新人笔记---hermes定时功能设计,具体讲解以及可优化点
java·人工智能·笔记·spring·ai·typescript