【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...X10Xk=pbkwqbkwvbkwbakbgkλc=λ0cλ1c...λmccλe=λ0eλ1e...λmeeϕl=ϕl0ϕl1...ϕln

相关推荐
qeen8721 小时前
【C++】类与对象之类的默认成员函数(二)
android·c语言·开发语言·c++·笔记·学习
m0_7360348521 小时前
存储基础和虚拟化
笔记
AOwhisky1 天前
MySQL 学习笔记(第六期):MySQL 备份与恢复
运维·数据库·笔记·学习·mysql·云计算
华山沦贱1 天前
open62541 V1.5.4版对C++ Builder支持的bug
笔记
稷下元歌1 天前
七天学会plc 加机器视觉完整笔记:S7-1200 数据类型、存储区与寻址方式(I/Q/M/DB 详解)。
网络·数据库·笔记
逸模1 天前
AI+BIM 重构连锁公装新范式 逸模打造数字化营建核心底座
大数据·人工智能·笔记·其他·信息可视化·重构
xqqxqxxq1 天前
树结构技术学习笔记
数据结构·笔记·学习
十月的皮皮1 天前
C语言学习笔记202606008- 三角形判断(3种方法)
c语言·笔记·学习
XGeFei1 天前
【Fastapi学习笔记(6)】—— Fastapi文件上传、请求头自动转换
笔记·学习·fastapi
嘶哈哈哈1 天前
嘉立创 EDA 入门实操笔记:从原理图到 PCB 布线、差分对、覆铜与 DRC 检查
开发语言·笔记·php