【SLAM论文笔记】PL-EVIO笔记(中)

滑窗优化

窗口由10个关键帧组成。

优化的状态参数包括事件点与图像点的逆深度、事件线特征的4参数正交表达(下一小节描述),各个关键帧IMU的加计和陀螺的零偏、世界坐标系下的位置p、速度v与姿态四元数q,IMU与相机的外参,IMU与事件相机的外参;比VINS多了事件点线特征的参数、事件相机与IMU的外参等。
χ = [ χ b λ c λ e ϕ l T c b T e b ] \bold{\chi} = \begin{array}{}[\bold{\chi}_b&\bold{\lambda}_c&\bold{\lambda}_e&\bold{\phi}_l&\bold{T}^b_c&\bold{T}^b_e]\end{array} χ=[χbλcλeϕlTcbTeb]

其中, χ b \bold{\chi}b χb是各关键帧的位姿参数包含加计、陀螺零偏, λ e \lambda_e λe、 λ c \lambda_c λc分别是事件相机、普通相机的图像特征点的逆深度, ϕ l \phi_l ϕl是各关键帧事件相机图像恢复出空间直线的4参数表达。
χ b = [ X 1 X 2 . . . X 10 ] X k = [ p b k w q b k w v b k w b a k b g k ] λ c = [ λ 0 c λ 1 c . . . λ m c c ] λ e = [ λ 0 e λ 1 e . . . λ m e e ] ϕ l = [ ϕ l 0 ϕ l 1 . . . ϕ l n ] \bold{\chi}b =\begin{array}{}[\bold{X}1&\bold{X}2&...&\bold{X}{10}]\end{array} \\ \bold{X}k=\begin{array}{}[p^w{b_k}&q^w{b_k}&v^w{b_k}&b
{a_k}&b_{g_k}]\end{array} \\ \bold{\lambda_c}=\begin{array}{}[\lambda^c_0&\lambda^c_1&...&\lambda^c_{m_c}]\end{array} \\ \bold{\lambda_e}=\begin{array}{}[\lambda^e_0&\lambda^e_1&...&\lambda^e_{m_e}]\end{array} \\ \bold{\phi}l=\begin{array}{}[\bold{\phi}{l_0}&\bold{\phi}{l_1}&...&\bold{\phi}{l_n}]\end{array} \\ χb=[X1X2...X10]Xk=[pbkwqbkwvbkwbakbgk]λc=[λ0cλ1c...λmcc]λe=[λ0eλ1e...λmee]ϕl=[ϕl0ϕl1...ϕln]

相关推荐
雷工笔记37 分钟前
AI使用|通过AI学习物料分类编码表
笔记·学习
Shea的笔记本1 小时前
MindSpore实战笔记:WaveNet音乐生成复现全记录
笔记
koo3641 小时前
pytorch深度学习笔记23
pytorch·笔记·深度学习
FakeOccupational2 小时前
【电路笔记 STM32】Cortex-M7 内核上的数据缓存结构图 + MPU内存保护单元 + Cache基本操作 + Cache&DMA 时序图
笔记·stm32·缓存
C羊驼2 小时前
C语言学习笔记(十一):数据在内存中的存储
c语言·经验分享·笔记·学习
电科_银尘3 小时前
【论文阅读】Deep Cascade:开启级联网络与数据一致性(DC)的新纪元
论文阅读
承渊政道3 小时前
【优选算法】(实战体验滑动窗口的奇妙之旅)
c语言·c++·笔记·学习·算法·leetcode·visual studio
C羊驼3 小时前
C语言学习笔记(十):操作符
c语言·开发语言·经验分享·笔记·学习
鹭天3 小时前
RAG学习笔记
笔记·学习