摘要: 使用Eigen实现卡尔曼滤波。如果实现扩展卡尔曼滤波只需将H矩阵换成雅可比的求解。 #ifndef _MYKALMAN_H #define _MYKALMAN_H #include <Eigen\Dense> class KalmanFilter { public: KalmanFilter(int 阅读全文
posted @ 2023-12-19 11:06 铃灵狗 阅读(73) 评论(0) 推荐(0) 编辑
摘要: 牛顿法 \(F(x+\Delta x)=F(x)+F'(x)\Delta x+\frac{1}{2}F''(x)\Delta x^2\) 泰勒展开之后保留二次项 然后对展开式再进行求导 令导数等于0 直接得到前进的步长和方向 即\(Hx = b\)这里的\(x\)就是牛顿法求解的前进步长和方向。 如 阅读全文
posted @ 2023-12-19 11:06 铃灵狗 阅读(8) 评论(0) 推荐(0) 编辑
摘要: 红黑树的出现 红黑树增删改查的时间复杂度都是O(logn)。 如果插入的数据随机,那么使用二叉搜索树即可保证树接近平衡。此时增删改查的效率都为O(logN)。 但如果插入的数据为有序的,此时二叉搜索树极其不平衡,退化为链表,时间复杂度降为O(N)。而红黑树就是为了应对这种极端情况。 红黑树的特点 红 阅读全文
posted @ 2023-12-19 11:05 铃灵狗 阅读(10) 评论(0) 推荐(0) 编辑
摘要: C++部分 什么时候需要写虚函数、什么时候需要写纯虚函数? 只继承接口为纯虚函数 强调覆盖父类重写,或者父类也需要实现一定的功能,为虚函数 指针传参和引用传参区别? 引用传参本质上是传递原参数地址,指针传参本质还是值传递,生成拷贝指针,拷贝指针和原指针指向的为同一块内存。因此改变拷贝指针的指向不影响 阅读全文
posted @ 2023-12-19 11:02 铃灵狗 阅读(37) 评论(0) 推荐(0) 编辑
摘要: Harris角点 opencv函数 cornerHarris提取输入图像的Harris角点 检测原理 检测思想:使用一个固定窗口在图像上进行任意方向的滑动,对比滑动前后的窗口中的像素灰度变化程度,如果存在任意方向上的滑动,都有较大灰度变化,则认为该窗口中存在角点。 \(E(u, v)=\sum_{( 阅读全文
posted @ 2023-12-19 11:02 铃灵狗 阅读(30) 评论(0) 推荐(0) 编辑
摘要: 使用说明 源代码在这里,本文基于源代码进行功能增加和修改。主要应用Qt中的一些方法,结合ros2中rviz2对增加panel功能的一些封装。实现双击修改图表中的内容,节点的收发,图表根据收到的msg进行更新等功能。代码未进行编译检测,可能存在一些错误。可参考设计思路。 CPP文件 #include 阅读全文
posted @ 2023-12-19 10:47 铃灵狗 阅读(98) 评论(0) 推荐(0) 编辑
摘要: 前言 Vins-Mono预积分相关的公式和代码可以在各个博客中找到。本文将充当一个帮助大家快速理解预积分、中值积分相关概述的角色,带大家理解代码,应对面试。 下面会分成三步,来帮助大家充分理解这个过程。步骤是按照顺序来写的。 中值积分和预积分 ==imu每进来一帧都会进行一步中值积分和预积分。== 阅读全文
posted @ 2023-01-30 14:43 铃灵狗 阅读(79) 评论(0) 推荐(0) 编辑
摘要: 前言 vio面试很容易被问的一个环节。问的时候多是概念性问题,一般不要求展示代码细节和公式推导。所以针对这种case有了这篇博客。方便大家快速理解这个过程,便于后续进一步学习细节。 先搞个基础 Ax=0和Ax=b 两个最小二乘解的答案 推导反正知道大意,细节看一遍忘一遍,所以直接来结论吧。 Ax=0 阅读全文
posted @ 2023-01-30 14:42 铃灵狗 阅读(84) 评论(0) 推荐(0) 编辑
摘要: 前言 本文将通过论文对照代码的方式阐述A-LOAM这一神奇算法。全文保持各个章节短小精悍的风格。本文会省去一些细节,但是了解大部分的论文和代码实现已经足够了。 点曲率计算与边缘点面点区分 论文中通过对点云点的曲率进行如下求曲率的计算。将计算的结果跟阈值进行比较。大于阈值认为是边缘点角点,小于另一个阈 阅读全文
posted @ 2023-01-30 14:41 铃灵狗 阅读(123) 评论(0) 推荐(0) 编辑
摘要: 前言 以一个简短且好理解的方式记录一下常用Cmake的函数,区别于网上的那些抄来抄去。废话少,全精华。 link_directories link_directories(${PROJECT_SOURCES_DIR}/lib) 是对于 .so 文件的 函数作用:添加一个.so库文件的搜索路径 使得链 阅读全文
posted @ 2023-01-18 15:03 铃灵狗 阅读(40) 评论(0) 推荐(0) 编辑