rednose

rednose

提供高效算法的视觉里程计与传感器融合定位卡尔曼滤波器

这个开源项目使用扩展卡尔曼滤波器和符号雅可比计算,为视觉里程计、传感器融合定位和SLAM提供高精度解决方案,支持在线和离线使用。它还包括3D定位误差状态卡尔曼滤波、多状态约束卡尔曼滤波以及Rauch-Tung-Striebel平滑技术。通过使用马哈拉诺比斯距离来拒绝异常值,该项目确保了滤波结果的稳定性和准确性。

Kalman filter视觉里程计传感器融合符号化雅可比计算三维定位Github开源项目

介绍

rednose 项目中描述的卡尔曼滤波框架是一种非常强大的优化工具,尤其适用于视觉里程计、传感器融合定位或建图(SLAM)。这个框架旨在提供非常准确的结果,无论是在线还是离线工作都能保持相当高的计算效率。此外,它在Python中设计滤波器也相当简便。

功能概览

使用符号雅可比矩阵计算的扩展卡尔曼滤波器

大多数动态系统可以被描述为隐马尔科夫过程。而为了用嘈杂的测量数据估计这样一个系统的状态,可以使用递归贝叶斯估计器。对于线性马尔科夫过程,普通线性卡尔曼滤波器是最优的。然而,很多系统是非线性的。扩展卡尔曼滤波器通过在每一步对非线性系统进行线性化建模,为大多数应用提供接近最优的估计器。传统上,扩展卡尔曼滤波器通过书写系统的动态方程然后手动计算用于线性化的雅可比矩阵,这对复杂系统来说非常耗费时间且容易出现计算错误。这个库利用sympy符号计算雅可比矩阵,简化了系统的定义并消除了计算错误的可能性。

错误状态卡尔曼滤波器

3D定位算法通常还需要估计物体在3D空间中的方向。方向通常由欧拉角或四元数表示。欧拉角有多个问题,存在表示同一方向的多途方式,万向节锁会导致自由度的丢失,并且在误差较大时其行为非常非线性。严格正维度的四元数不存在这些问题,但四元数还有其他问题。四元数需要被归一化,否则它们会无限增长,但这无法在卡尔曼滤波器中清楚地强制执行。重要的是,四元数有四个维度,但只表示三个自由度,因此存在一个冗余维度。

卡尔曼滤波器旨在最小化系统状态的误差。可以有一个用于状态和状态误差在不同空间中表示的卡尔曼滤波器,只要有一个误差函数可以根据真实状态和估计的状态计算误差。在卡尔曼滤波器的误差中有冗余维度是有问题的,但在状态中不是。因此,一个很好的折中方案是使用四元数表示系统的姿态状态,并使用欧拉角描述姿态误差。这个库支持在不同于状态的空间中定义任意误差。

多状态约束卡尔曼滤波器

如何将基于特征的视觉里程计与卡尔曼滤波器集成?问题在于无法为图像空间中的2D特征观测编写一个本地化卡尔曼滤波器的观测方程。需要给特征观测提供一个深度以确保它具有3D位置,然后就可以在卡尔曼滤波器中编写一个观测方程。通过跟踪特征跨帧并估计深度可以做到这一点。然而解决方案并不简单,深度通过跟踪跨帧特征估计取决于这些帧中相机的位置,从而影响卡尔曼滤波器的状态。这导致了一个正反馈回路,卡尔曼滤波器错误地对其位置产生信心,因为特征位置更新强化了它。

解决方案是使用多状态约束卡尔曼滤波器(MSCKF),这个库完全支持这一功能。

Rauch–Tung–Striebel 平滑

在使用卡尔曼滤波器进行离线估计时,可能会出现状态估计不佳的初始化期。全局估计器没有这种困扰,为了让我们的卡尔曼滤波器与全局优化器竞争,我们可以使用RTS平滑器倒退运行滤波器。这些与可能的多次前向和后向数据遍历相结合,应使性能非常接近全局优化。

马氏距离离群点拒绝器

许多测量数据不来源于高斯分布,因此存在不符合卡尔曼滤波器统计模型的离群点。如果不加以处理,这会导致很多性能问题。这个库允许对输入测量使用马氏距离统计检验来处理这一问题。需要注意的是良好的初始化对于防止好的测量被拒绝至关重要。

编辑推荐精选

TRAE编程

TRAE编程

AI辅助编程,代码自动修复

Trae是一种自适应的集成开发环境(IDE),通过自动化和多元协作改变开发流程。利用Trae,团队能够更快速、精确地编写和部署代码,从而提高编程效率和项目交付速度。Trae具备上下文感知和代码自动完成功能,是提升开发效率的理想工具。

AI工具TraeAI IDE协作生产力转型热门
蛙蛙写作

蛙蛙写作

AI小说写作助手,一站式润色、改写、扩写

蛙蛙写作—国内先进的AI写作平台,涵盖小说、学术、社交媒体等多场景。提供续写、改写、润色等功能,助力创作者高效优化写作流程。界面简洁,功能全面,适合各类写作者提升内容品质和工作效率。

AI辅助写作AI工具蛙蛙写作AI写作工具学术助手办公助手营销助手AI助手
问小白

问小白

全能AI智能助手,随时解答生活与工作的多样问题

问小白,由元石科技研发的AI智能助手,快速准确地解答各种生活和工作问题,包括但不限于搜索、规划和社交互动,帮助用户在日常生活中提高效率,轻松管理个人事务。

热门AI助手AI对话AI工具聊天机器人
Transly

Transly

实时语音翻译/同声传译工具

Transly是一个多场景的AI大语言模型驱动的同声传译、专业翻译助手,它拥有超精准的音频识别翻译能力,几乎零延迟的使用体验和支持多国语言可以让你带它走遍全球,无论你是留学生、商务人士、韩剧美剧爱好者,还是出国游玩、多国会议、跨国追星等等,都可以满足你所有需要同传的场景需求,线上线下通用,扫除语言障碍,让全世界的语言交流不再有国界。

讯飞智文

讯飞智文

一键生成PPT和Word,让学习生活更轻松

讯飞智文是一个利用 AI 技术的项目,能够帮助用户生成 PPT 以及各类文档。无论是商业领域的市场分析报告、年度目标制定,还是学生群体的职业生涯规划、实习避坑指南,亦或是活动策划、旅游攻略等内容,它都能提供支持,帮助用户精准表达,轻松呈现各种信息。

AI办公办公工具AI工具讯飞智文AI在线生成PPTAI撰写助手多语种文档生成AI自动配图热门
讯飞星火

讯飞星火

深度推理能力全新升级,全面对标OpenAI o1

科大讯飞的星火大模型,支持语言理解、知识问答和文本创作等多功能,适用于多种文件和业务场景,提升办公和日常生活的效率。讯飞星火是一个提供丰富智能服务的平台,涵盖科技资讯、图像创作、写作辅助、编程解答、科研文献解读等功能,能为不同需求的用户提供便捷高效的帮助,助力用户轻松获取信息、解决问题,满足多样化使用场景。

热门AI开发模型训练AI工具讯飞星火大模型智能问答内容创作多语种支持智慧生活
Spark-TTS

Spark-TTS

一种基于大语言模型的高效单流解耦语音令牌文本到语音合成模型

Spark-TTS 是一个基于 PyTorch 的开源文本到语音合成项目,由多个知名机构联合参与。该项目提供了高效的 LLM(大语言模型)驱动的语音合成方案,支持语音克隆和语音创建功能,可通过命令行界面(CLI)和 Web UI 两种方式使用。用户可以根据需求调整语音的性别、音高、速度等参数,生成高质量的语音。该项目适用于多种场景,如有声读物制作、智能语音助手开发等。

咔片PPT

咔片PPT

AI助力,做PPT更简单!

咔片是一款轻量化在线演示设计工具,借助 AI 技术,实现从内容生成到智能设计的一站式 PPT 制作服务。支持多种文档格式导入生成 PPT,提供海量模板、智能美化、素材替换等功能,适用于销售、教师、学生等各类人群,能高效制作出高品质 PPT,满足不同场景演示需求。

讯飞绘文

讯飞绘文

选题、配图、成文,一站式创作,让内容运营更高效

讯飞绘文,一个AI集成平台,支持写作、选题、配图、排版和发布。高效生成适用于各类媒体的定制内容,加速品牌传播,提升内容营销效果。

热门AI辅助写作AI工具讯飞绘文内容运营AI创作个性化文章多平台分发AI助手
材料星

材料星

专业的AI公文写作平台,公文写作神器

AI 材料星,专业的 AI 公文写作辅助平台,为体制内工作人员提供高效的公文写作解决方案。拥有海量公文文库、9 大核心 AI 功能,支持 30 + 文稿类型生成,助力快速完成领导讲话、工作总结、述职报告等材料,提升办公效率,是体制打工人的得力写作神器。

下拉加载更多