首页 > 其他分享 >VINS中IMU预积分

VINS中IMU预积分

时间:2024-05-11 09:22:23浏览次数:25  
标签:mathbf 积分 boldsymbol IMU bmatrix end VINS omega dt

连续时间IMU积分

\[\begin{aligned} &\mathbf{p}_{b_{k+1}}^w=\mathbf{p}_{b_k}^w+\mathbf{v}_{b_k}^w\Delta t_k+\iint_{t\in[t_k,t_{k+1}]}\left(\mathbf{R}_t^w(\hat{\mathbf{a}}_t-\mathbf{b}_{a_t}-\mathbf{n}_a)-\mathbf{g}^w\right)dt^2\ \\ &\mathbf{v}_{b_{k+1}}^w=\mathbf{v}_{b_k}^w+\int_{t\in[t_k,t_{k+1}]}(\mathbf{R}_t^w(\hat{\mathbf{a}}_t-\mathbf{b}_{a_t}-\mathbf{n}_a)-\mathbf{g}^w)dt\\ &\mathbf{q}_{b_{k+1}}^w=\mathbf{q}_{b_k}^w\otimes\int_{t\in[t_k,t_{k+1}]}\frac{1}{2}\boldsymbol{\Omega}(\hat{\boldsymbol{\omega}}_t-\mathbf{b}_{w_t}-\mathbf{n}_w)\mathbf{q}_t^{b_k}dt\\ &其中\\ &\boldsymbol{\Omega}(\boldsymbol{\omega})=\begin{bmatrix}-\lfloor\boldsymbol{\omega}\rfloor_\times&\boldsymbol{\omega}\\-\boldsymbol{\omega}^T&0\end{bmatrix}, \lfloor\boldsymbol{\omega}\rfloor_\times=\begin{bmatrix}0&-\omega_z&\omega_y\\\omega_z&0&-\omega_x\\-\omega_y&\omega_x&0\end{bmatrix} \end{aligned} \]

标签:mathbf,积分,boldsymbol,IMU,bmatrix,end,VINS,omega,dt
From: https://www.cnblogs.com/narjaja/p/18185716

相关文章

  • 53_Maximum Subarray-最大子数组
    问题描述Givenanintegerarray nums,findthe subarray withthelargestsum,andreturn itssum.给定一个数组nums,找到一个子数组。使它的和最大,返回子数组例子Input:nums=[-2,1,-3,4,-1,2,1,-5,4]Output:6Explanation:子数组[4,-1,2,1]有最大的和6.基......
  • 如何写好Simulation证明(二): 半诚实模型下MPC的定义
    3.SecureComputation–SimulationforSemi-honestAdversaries我们在这里考虑的模型是staticsemi-honest敌手下的两方安全计算.这样的敌手能够在协议开始之前决定控制某一方,并且需要按照协议的描述执行.需要注意的是,这是一个非常弱的假设.如果敌手没有按照协议流......
  • 如何写好Simulation证明(三): 半诚实敌手模型下的OT
    4.ObliviousTransferforSemi-HonestAdversaries在本文中,我们将给出一个证明:基于enhancedOWP,构造一个半诚实敌手模型下的OT.首先我们先介绍enhancedOWP概念.4.1EnhancedOWP.对这个特殊的OWP我们先不做过多的解释,我们先关注参数.一般正式的定义中,一个OWP具......
  • LeetCode 1186. Maximum Subarray Sum with One Deletion
    原题链接在这里:https://leetcode.com/problems/maximum-subarray-sum-with-one-deletion/description/题目:Givenanarrayofintegers,returnthemaximumsumfora non-empty subarray(contiguouselements)withatmostoneelementdeletion. Inotherwords,youwa......
  • 如何写好Simulation证明(一): 语义安全
    密码学中很多证明需要用到Simulation,尤其是ZK,MPC等等.对于初学者来说,涉及Simulation的证明往往不容易理解,更别说自己独立证明,所以有必要学习一下如何写这样的证明.文章主要参考YehudaLindell的讲义:Howtosimulateit.1.Introduction什么是Simulation?中文翻译......
  • 在英特尔至强 CPU 上使用 Optimum Intel 实现超快 SetFit 推理
    在缺少标注数据场景,SetFit是解决的建模问题的一个有前途的解决方案,其由HuggingFace与Intel实验室以及UKPLab合作共同开发。作为一个高效的框架,SetFit可用于对SentenceTransformers模型进行少样本微调。SetFit仅需很少的标注数据就能达到较高的准确率,例如,在使用3-......
  • 用蒙特卡罗方法求积分
    实验任务采用Monte-Carlo法计算函数 y=x2 在0~10之间的积分值实验目的熟悉MPI_Reduce() 函数的用法实验方法该算法的思想是通过随机数把函数划分成小的矩形块,通过求矩形块的面积和来求积分值,我们生成n个0~10之间的随机数,求出该随机数所对应的函数值作为矩形的高,由......
  • LeetCode 1373. Maximum Sum BST in Binary Tree
    原题链接在这里:https://leetcode.com/problems/maximum-sum-bst-in-binary-tree/description/题目:Givena binarytree root,return themaximumsumofallkeysof any sub-treewhichisalsoaBinarySearchTree(BST).AssumeaBSTisdefinedasfollows:Thel......
  • 不定积分的基本性质
    不定积分有如下两个基本性质property1两个函数之和(差)的不定积分,等于这两个函数不定积分的和(差),即:\[\int[f(x)\pmg(x)]dx=\intf(x)dx\pm\intg(x)dx,\quad\quad\quad(0.0)\]要证明式子(0.0)成立,首先要证明式子(0.0)右侧是左侧被积函数\(f(x)\pmg(x)\)的原函数......
  • 基本积分表
    \(\intx^{\mu}dx=\frac{1}{\mu+1}x^{\mu+1}+C\)\[\begin{eqnarray}\intx^{\mu}dx=\frac{1}{\mu+1}x^{\mu+1}+C\\\mu为常数,但\mu\ne0\\\\推导过程如下:\\(\frac{1}{\mu+1}x^{\mu+1})'=\frac{(x^{\mu+1})'\cdot\mu+1-......