leeayu-优快云博客

原创一文读懂自动驾驶中常用的定位算法之NDT点云配准算法

本系列博客计划写两篇，第一篇侧重原生态论文重点内容翻译解释及公式推导，第二篇侧重实际代码细节。将会不定期更新，文中所用图片如无声明来源网络和论文。文章目录写在前面AbstractChapter 1 Introduction1.1 ContributionsChapter2 Common concepts2.1 rotation2.2 registration2.3 sampling2.4 sla...

2019-04-11 21:57:12 15535 22

原创观测维度过大的一种ceres求解优化思路

这个优化如此重要，以至于需要单列一个文章。

2024-08-07 16:52:46 187

原创 ceres::Problem求解最小二乘总结

专门解决最小二乘问题min⁡x12∑iρi∥fixi1xik∥2s.t.lj≤xj≤ujminxs.t.21∑iρi∥fixi1xik∥2lj≤xj≤ujpublic:// 在继承的类中实现Evaluate函数，填充残差和jabocian注意jacobian是残差对状态的导数，不一定是观测方程对状态的导数。如果残差定义为r。

2024-08-07 11:59:35 724

原创 ceres::GradientProblem求解一般最小化问题

注意在 GradientProblem的构造函数中可以传入参数的Manifold，用于更新非欧式空间的参数。对于一般的无约束最小化问题，使用。对应的cost function有。这个问题的一般最小化解法如下。

2024-08-06 17:07:54 288

原创 ceres中的NormalPrior cost function

但是在估计的过程中，你不希望这个参数随着给定的数据无所限制的进行更新，因为一旦某些数据是错的，这个估计值就会被错误带偏。如果我们提前进行了机械测量，值为。这个先验观测的实现如下，注意这个仅限于向量空间的状态估计，如果是SO3这种，需要自定义prior factor。，我们确信无论估计值如何变化，最终的估计值始终在机械测量值附近，那么这个机械测量值就是我们的先验观测。则我们的prior measurement构成的factor为。假设你想估计天线到imu的杆臂这个参数，定义为。

2024-08-05 09:36:05 896

原创 ceres多种方法求解非线性最小二乘问题

问题同。

2024-08-04 23:48:35 356

原创手写高斯牛顿求解非线性最小二乘问题

【代码】手写高斯牛顿求解非线性最小二乘问题。

2024-08-04 00:33:36 280

原创状态估计中的概率基础

高斯分布是一个理想的分布，在真实世界中，模型往往是非线性非高斯的，为了方便处理，我们经常在使用高斯分布来近似表示真实世界中的PDF的某个点。请注意公式⾥⾯的 p(x) 是概率密度（probability density）⽽不是概率（probability）。变形之后就是贝叶斯公式，这条公式在状态估计中会被反复使用，是最核心的公式，公式本身没有任何假设。计算高斯分布的变换的关键就是计算均值和协方差，直接按照公式去推导即可。P(y)的计算方式就是把x通过积分来边缘化掉的。的条件下的PDF如下。

2024-08-02 12:07:37 1072

原创从零真正理解SLAM中的边缘化---------详细的理论细节推导

文章目录1 边缘化是什么2 实际SLAM中的优化问题构建2.1 线性高斯系统优化问题的构建（参考状态估计这本书，本节只是简介使得文章前后保持连续性）2.2 非线性非高斯系统（Non Linear Non Gaussian，NLNG）优化问题构建2.3 NLNG问题的Batch形式（实际SLAM优化多帧pose和多路标点的情况）2.4 使用高斯牛顿法求解2.5 考虑一个小的优化问题：仅包含观测模型3 边缘化（Marginalization）3.1 边缘化想做什么事情3.2 边缘化过程详细步骤（以VINS-MO

2024-08-01 12:56:37 939

原创如何在基于滤波框架的绝对定位系统中融合相对观测

以无人驾驶定位系统为例，融合gnss，imu，轮速，camera LaneMatch(frame to map)，lidar scan match(frame to map)。如何融合LIO、VIO这类帧间相对观测呢？本文讨论滤波框架下如何融合LIO，VIO相对观测。

2024-07-31 11:14:36 204

原创 MSCKF中的观测模型

这个地方使用QR分解来降低算法复杂度，参见。最后计算K的时候需要求解。

2024-07-31 11:02:22 649

原创 MSCKF里面的两个实用算法策略

以在无人车定位系统中融合GNSS，IMU，轮速，camera/lidar frame to map pose为例，想要在这个绝对定位系统中继续融合LO、VIO的relative pose该怎么做呢？（这里只考虑松耦合）

2024-07-31 10:57:53 867

原创 MSCKF中的camera状态增广

在MSCKF的状态增广公式中不考虑噪声R，所以协方差变换结果就是。是相机pose和imu pose的外参公式构成的非线性函数。对 imu error state的导数。考虑imu和camera之间的外参数。下图是来自《机器人学的状态估计》

2024-07-31 09:18:39 362

原创矩阵常见分解算法及其在SLAM中的应用

酉矩阵，正交矩阵A的元素是属于复数域矩阵，如果AA∗IAA^{*} = IAA∗I，那么A是属于酉矩阵（Unitary Matrix）A的元素是属于实数域矩阵，如果AATIAA^{T} = IAATI，那么A是属于正交矩阵（Orthogonal Matrix），当然也是Unitary Matrix埃尔米特矩阵，对阵矩阵A的元素是属于复数域矩阵，如果AA∗A = A^{*}AA∗，那么A是属于埃尔米特矩阵（Hermitian Matrix）

2024-07-30 17:18:58 957

原创理解全贝叶斯估计（Full Beyes Estimation）

【代码】理解全贝叶斯估计（Full Beyes Estimation）

2024-07-22 13:30:34 197

原创 ubuntu一些好用的开发工具及其配置

输入某命令，比如conda，按下ctrl+R，会显示和该命令匹配的历史命令的列表有了这个工具再也不用记忆太复杂的命令，只需要知道大概几个单词，输入即可搜索。其搜索源来自于 vim ~/.zsh_history, 这个文件被fzf工具创建，其会记录所有terminal输入过的命令。

2024-07-22 09:09:26 631

原创 deep learning 环境配置

（2）最重要的是在选择CUDA Installer时，要把Driver这一项取消掉（[]中是空的表示没有选择安装这项，[x]表示有安装这项），因为第一步已经安装过NVIDIA驱动了。其中对于cuda的要求的11.1版本，所以需要按照这个版本要求安装下cuda，同时记得在bashrc中修改cuda bin、lib的path。进去网站 https://developer.nvidia.com/cuda-toolkit-archive 选择想要安装的cuda版本。

2024-07-10 14:54:09 662

原创非递减有序数组搜索目标值左右边界

精髓：确定搜索区间是[ , ], 还是[ , )准确切换mid左右边界，正确返回candidate indexclass Solution {public: int countTarget(vector<int>& scores, int target) { const int left_bound = FindLeftBound(scores, target); const int right_bound = FindRightB

2024-06-27 10:40:28 421 1

原创 c++ copy constructor, copy assignment, move constructor, move assignment functions

【代码】c++ copy constructor, copy assignment, move constructor, move assignment functions。

2024-01-31 12:39:38 284

原创 Lidar SLAM Review

lidar slam review

2022-11-14 20:30:53 79

原创二分搜索查找边界

二分搜索查找边界

2022-11-14 20:27:21 168

原创 Dynamic binding, polymorphism and Curiously Recursive Template Pattern

C++多态和动态绑定与循环模板模式的区别

2022-07-07 22:58:04 170

原创 Inheritance and Polymorphism in cpp

class Base { public: Base() { Init(); /*this will invoke the base function, because derived object is not been created yet.*/ } virtual ~Base() = default; virtual void Init() { cout << "Base init\n"; } void Run() { Work(); /*this wil.

2021-11-17 14:38:24 368

原创 C++的继承构造函数

class Base { public: Base(int a) : data_(a) {} Base(double b) : data_(static_cast<int>(b)) {} Base(string c) : data_(static_cast<int>(c.size())) {} virtual ~Base() = default; protected: int data_ = 0;};class Derived : public Bas

2021-08-24 13:14:31 225

原创最优加权最小二乘估计

文章目录Reference最小二乘估计加权最小二乘估计ReferenceMatrix Differentiation加权最小二乘法与局部加权线性回归卡尔曼滤波与组合导航原理(1-2讲)最小二乘估计Z=HX+VZ = HX + VZ=HX+Vwhere, Z is the mmm dimension observation vector; XXX is a nnn dimension state vector; HHH is a m∗nm * nm∗n matrix; VVV is noi

2021-05-09 14:06:11 4145

原创 Lect3 最优化Optimization

文章目录Reference简介损失函数可视化最优化梯度计算使用有限差值进行数值计算微分计算梯度梯度下降Referencehttps://zhuanlan.zhihu.com/p/21387326?refer=intelligentunithttps://zhuanlan.zhihu.com/p/21360434?refer=intelligentunit简介最优化是求一个最佳的WWW使得LLL最小，LLL由score function 和 loss function组成。损失函数可视化

2021-02-18 20:32:42 152

原创 Lect2 线性分类

文章目录ReferenceKNN分类的不足线性分类器Score Function将图像看做高维度的点将线性分类器看做模板匹配偏差和权重的合并技巧图像数据预处理损失函数 Loss function多类支持向量机损失 Multiclass Support Vector Machine Loss正则化（Regularization）Softmax分类器SVM和Softmax的比较Referencehttps://zhuanlan.zhihu.com/p/20918580?refer=intelligentu

2021-02-17 21:04:13 271

Robotics - Modelling, Planning and Control (Springer, 2009)

JLink V9说明文档

Micrium-Probe-TargetCode-410

Micrium_STM32F107-EVALucTCPIP

ubuntu下无法打开USB串口