【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]

相关推荐
taoqick4 分钟前
FIPO粗读笔记
笔记
半壶清水1 小时前
[软考网规考点笔记]-局域网之以太网标准
网络·笔记·网络协议·考试
忙什么果1 小时前
transformer学习笔记2
笔记·学习·transformer
ZhiqianXia1 小时前
Gem5 学习笔记(2) : Gem5 建模要点与基本思路
笔记·学习
_李小白2 小时前
【OSG学习笔记】Day 25: OSG 设计架构解析
笔记·学习·架构
后藤十八里2 小时前
维普期刊逆向笔记
javascript·笔记·js逆向
风中的小熊生气2 小时前
MQ 学习笔记
笔记·学习
elseif1232 小时前
【Markdown】指南(上)
linux·开发语言·前端·javascript·c++·笔记
深蓝海拓3 小时前
基于QtPy (PySide6) 的PLC-HMI工程项目(二)系统规划
笔记·python·qt·学习·plc
鱼鳞_4 小时前
Java学习笔记_Day20(二叉树)
java·笔记·学习