IMU状态预积分的雅克比矩阵

IMU状态预积分的雅克比矩阵

  • 预积分的雅克比矩阵

预积分的雅克比矩阵

最后讨论预积分相对状态变量的雅克比矩阵。由于预积分测量已经归纳了IMU在短时间内的读数,因此残差相对于状态变量的雅克比矩阵推导则简单。
首先考虑旋转。
旋转与Ri,Rj和 b g , i b_{g,i} bg,i有关,用SO(3)的右扰动来推导它:
在这里插入图片描述
ϕ j \phi _{j} ϕj的导数为
在这里插入图片描述
假设优化初始的零偏为 b g , i b_{g,i} bg,i,在某一步迭代时,当前估计出来的零偏修正为 δ b g , i \delta b_{g,i} δbg,i,而当前修正得到的预积分旋转观测量为
在这里插入图片描述
残差为 r △ R i j ′ r^{\prime }_{\bigtriangleup R_{ij}} rRij

为了求导,又在上面两项的基础上加上了 δ ~ b g , i \tilde{\delta} b_{g,i} δ~bg,i,那么
在这里插入图片描述
所以最后得到
在这里插入图片描述
接下来,考虑速度项的雅克比矩阵。速度项与vi,vj呈线性关系,可以得到
在这里插入图片描述
对旋转部分只需要做一阶泰勒展开:
在这里插入图片描述
速度残差相对 b g , i , b a , i b_{g,i},b_{a,i} bg,iba,i的雅克比矩阵只和 △ v ~ i j \bigtriangleup \tilde{v} _{ij} v~ij相关。由于速度的残差项与它只相差一个负号,所以只需要在下式中加个负号。
在这里插入图片描述
最后来看平移部分。平移部分和 p i , p j , v i , R i p_{i},p_{j},v_{i},R_{i} pi,pj,vi,Ri及两个零偏有关。然后,它们的关系大多为线性关系,雅克比矩阵可以得出
在这里插入图片描述
零偏的残差在下面基础上加负号
在这里插入图片描述

本文来自互联网用户投稿,该文观点仅代表作者本人,不代表本站立场。本站仅提供信息存储空间服务,不拥有所有权,不承担相关法律责任。如若转载,请注明出处:http://www.mzph.cn/news/812127.shtml

如若内容造成侵权/违法违规/事实不符,请联系多彩编程网进行投诉反馈email:809451989@qq.com,一经查实,立即删除!

相关文章

Collections.synchronized * 是什么方法?Collections.synchronized* 中的方法和并发集合类有什么区别

该文章专注于面试,面试只要回答关键点即可,不需要对框架有非常深入的回答,如果你想应付面试,是足够了,抓住关键点 面试官:Collections.synchronized * 是什么 Collections.synchronized* 是 Java 集合框架(Java Collections Framework)中提供的一组静态方法,用于将非…

【拓展技术】——AutoDL服务器训练Pycharm使用注意点Pycharm配置AutoDL

一、AutoDL服务器模型训练 AutoDL是一个为研究人员、开发者和企业提供的平台,它致力于提供一个高效、可靠和易用的环境,以支持复杂的计算任务和AI模型的部署: 高效的并行计算资源:AutoDL拥有强大的计算集群和高性能的计算节点&a…

【QT入门】Qt自定义控件与样式设计之控件提升与自定义控件

【QT入门】Qt自定义控件与样式设计之控件提升与自定义控件 往期回顾 【QT入门】Qt自定义控件与样式设计之QProgressBar用法及qss-CSDN博客 【QT入门】 Qt自定义控件与样式设计之QSlider用法及qss-CSDN博客 【QT入门】Qt自定义控件与样式设计之qss的加载方式-CSDN博客 一、最终…

C++ 类和对象 上

目录 前言 什么是面向对象?什么是面向过程? 面向过程 面向对象 比较 类 引入 定义 实例化 类的大小 this指针 前言 今天我们来进入C类和对象的学习。相信大家一定听说过C语言是面向过程的语言,而C是面向对象的语言?那么他…

SQLMap简单注入教程

SQLmap是一个自动化的SQL注入工具,支持多种数据库和注入技术,能够检测和利用Web应用程序中的SQL注入漏洞。下面是一个关于SQLmap注入的教程,帮助你了解如何使用SQLmap进行SQL注入攻击。 一、SQLmap的基本原理 SQLmap通过分析目标网站的结构和…

启明智显M系列--工业级HMI芯片选型表

本章主要介绍启明智显M系列HMI主控芯片: 纯国产自主, RISC-V 内核,配备强大的 2D 图形加速处理器、PNG/JPEG 解码引擎、H.264解码;工业宽温,提供全开源SDK;1秒快速开机启动的特性,极大地提高了…

llama-factory SFT系列教程 (三),chatglm3-6B 命名实体识别实战

背景 llama-factory SFT系列教程 (一),大模型 API 部署与使用llama-factory SFT系列教程 (二),大模型在自定义数据集 lora 训练与部署本文为llama-factory SFT系列教程 第三篇 简介 利用 llama-factory 框架,基于 chatglm3-6B 模型 做命名…

【MySQL】事务篇

SueWakeup 个人主页:SueWakeup 系列专栏:学习技术栈 个性签名:保留赤子之心也许是种幸运吧 目录 本系列专栏 1. 什么是事务 2. 事务的特征 原子性(Atomicity) 一致性(Consistency) 隔离性&…

# Contrastive Learning(对比学习)--CLIP笔记(一)

Contrastive Learning(对比学习)–CLIP笔记(一) 参考:CLIP 论文逐段精读【论文精读】_哔哩哔哩_bilibili CLIP简介 CLIP是一种多模态预训练模型,由OpenAI在2021年提出,论文标题:L…

Harmony鸿蒙南向外设驱动开发-Camera

功能简介 OpenHarmony相机驱动框架模型对上实现相机HDI(Hardware Device Interface)接口,对下实现相机Pipeline模型,管理相机各个硬件设备。 该驱动框架模型内部分为三层,依次为HDI实现层、框架层和设备适配层。各层基…

搜索(未完结版)

前言 图的基础与遍历 图的存储方式 邻接表 List<int []>list[N]; list[x]存储x的所有出点的信息。 list[i][j]{first,second}其中first表示从i出发的某个出点的编号&#xff0c;second表示边权。 list[1]{{2,0},{3,0}} 1这个点有2和3连个出边 邻接矩阵 d…

Mouse IFN-α ELISA kit (Quick Test)

干扰素α&#xff08;IFN-α&#xff09;是一类由免疫细胞分泌的内源性调节因子&#xff0c;也被称为白细胞干扰素&#xff0c;主要参与响应病毒感染的先天性免疫。 基于结构特征、受体、细胞来源和生物活性的不同&#xff0c;干扰素可被分为Ⅰ、Ⅱ、Ⅲ三种类型&#xff0c;其中…

一起学习python——基础篇(17)

今天我说一下python中有关文件的操作。 1、检测一个目录里面有无这个文件夹、有无txt文件&#xff0c;代码如下&#xff1a; import os #文件的路径 testPath"D:/pythonFile" testPath2"D:/pythonFile/test.txt" #使用exists()方法检查是否存在文件…

springboot项目如何配置跨域?

在Spring Boot项目中配置跨域&#xff08;CORS&#xff0c;Cross-Origin Resource Sharing&#xff09;主要是为了允许来自不同源&#xff08;不同的协议、域名或端口&#xff09;的前端应用能够访问后端API。Spring Boot提供了多种方式来配置跨域支持。 1. 使用CrossOrigin注…

一篇详解CSS样式

华子目录 CSS常见样式CSS基本语法 文本样式color颜色名称十六进制颜色代码rgb&#xff0c;rgbahsl、hsla预定义颜色值transparent颜色继承 font-stylefont-weightline-heighttext-shadowbox-shadowtext-transformwhite-spacedirection 列表样式list-style-typelist-style-image…

C#:成绩等级转换

任务描述 本关任务&#xff1a;给出一百分制成绩&#xff0c;要求输出成绩等级‘A’、‘B’、‘C’、‘D’、‘E’。 90分以上为A 80-89分为B 70-79分为C 60-69分为D 60分以下为E&#xff0c;如果输入数据不在0~100范围内&#xff0c;请输出一行&#xff1a;“Score is error!”…

RREA论文阅读

Relational Reflection Entity Alignment 关系反射实体对齐 ABSTRACT 实体对齐旨在识别来自不同知识图谱(KG)的等效实体对&#xff0c;这对于集成多源知识图谱至关重要。最近&#xff0c;随着 GNN 在实体对齐中的引入&#xff0c;近期模型的架构变得越来越复杂。我们甚至在这…

为什么tcp需要四次挥手?

首先;我们需要先简单解释下tcp四次挥手都做了什么: tcp终止一个连接&#xff0c;需要经过四次挥手 第一次挥手&#xff1a;客户端发送一个 FIN 报文&#xff0c;报文中会指定一个序列号。此时客户端处于 FIN_WAIT1 状态&#xff0c;表示停止发送数据&#xff0c;等待服务端的…

Power BI报告在PPT中实时刷新的实现技巧分享

前面我们刚介绍了如何在PPT中展示Power BI报告&#xff1f; 很巧的是&#xff0c;在刚刚的Power BI 2024年4月更新的诸多新特性中&#xff0c;PPT中使用的Power BI插件又有新特性的更新&#xff0c;数据自动刷新功能(新特性仅限国际版使用)&#xff0c;这个新特性支持最低15秒…

已解决javax.xml.bind.JAXBException: JAXB异常的正确解决方法,亲测有效!!!

已解决javax.xml.bind.JAXBException: JAXB异常的正确解决方法&#xff0c;亲测有效&#xff01;&#xff01;&#xff01; 目录 问题分析 报错原因 解决思路 解决方法 审核类定义 检查注解 验证上下文路径 测试序列化与反序列化 适应环境变化 总结 博主v&#xff1…