IMU参数辨识及标定

IMU参数辨识及标定

、标定参数分析

        标定的本质是参数辨识。首先明确哪些参数可辨识,其次弄清怎样辨识。

        参数包括陀螺仪和加速度计各自的零偏、标度因数、安装误差。

  • IMU需要标定的参数主要是确定性误差随机误差,确定性误差主要标定biasscalemisalignment,随机误差主要标定noiserandom walkkalibr_allan 是用于求取随机误差的开源工具。

可以中英对照 

1.参数项

1) 零偏

        这个比较好理解,就是输出比输入多了一个常值误差。

        需要注意的是,通过Allan方差分析,得到了器件的量化噪声、角度随机游走、角速率随机游走、零偏不稳定性噪声、速率斜坡,仔细看,这些都是对零偏质量的分析,也可以直观的理解为零偏的波动和漂移程度,这里面并没有分析零偏本身的大小,而这个才是我们标定里要去估计的那个常值误差。

                加速度计的零偏在这里表示为

        陀螺仪的零偏在这里表示为

2) 标度因数误差

        也叫刻度因数误差。假设器件输出的是标准单位角速度(rad/s),那么输出和输入的比就是1。如果不是,就得需要标定,修正这个比例。

        加速度计的标度因数这里表示如下:

        陀螺仪的标度因数这里表示为:

  1. 修改配置文件

        进入之前编译好的imu_utils文件夹下xxxx.launch文件(自己添加的)查看相关设置:

3) 安装误差

        这里面b坐标系是正交的imu坐标系,g坐标系的三个轴是分别对应三个陀螺仪。由于加工工艺原因,陀螺仪的三个轴并不正交,和我们导航中使用的正交轴不重合。我们需要仔细想一想,这个安装误差怎么在陀螺输出中体现出来的,因为我们标定时只能采集到陀螺的输出,而无法直接去测量安装误差。理论上,在陀螺坐标轴和b系重合的情况下,我们沿b系某一个坐标轴旋转,那么其他两个轴是不会有角速度输出的,而有了安装误差以后,便有了输出,据此,我们就可以建立输出和误差之间的关系了。以图中一项误差为例,Sgxy表示的就是y轴的单位输入,在x陀螺上由安装误差造成的输出。由此,我们可以把所有的安装误差都成矩阵形式,即:

        加速度计的安装误差原理和它一样,直接给出公式。

        这样一共有12项安装误差参数。有的时候,可以简化为9项,具体什么情况下简化,以及怎样简化,我们会在本文的后面讲。

2)启动launch文件

source devel/setup.bash

roslaunch imu_utils xxxx.launch

2. 误差模型

        通过上面的参数分析,我们已经可以很容易地写出误差模型了。

        陀螺仪:

        其中W是陀螺输出,ω是各坐标轴真实输入。该公式的展开形式为

        同理,可以得到加速度计的展开形式为:

二、利用imu_utils 标定IMU参数

        imu_utils是用于求取IMU随机误差的开源工具。

1. 下载imu_utils和code_utils

imu_utils下载地址为:GitHub - gaowenliang/imu_utils: A ROS package tool to analyze the IMU performance.
code_utils下载地址为:GitHub - gaowenliang/code_utils: my code utils

注意:

1、全局安装ceres库,code_imu依赖ceres

2、不要同时把imu_utilscode_utils一起放到src下进行编译。由于imu_utils依赖code_utils,所以先把code_utils放在工作空间的src下面,进行编译。然后再将imu_utils放到src下面,再编译。

2. 安装依赖并编译

sudo apt-get install libdw-dev

 2.1 编译code_utils
2.2 安装Ceres

Ubuntu20.04安装Ceres1.14.0 - 知乎

2.3 构建工作空间编译code_utils

问题:

sumpixel_test.cpp文件

问题1修改#include "backward.hpp"为 #include“code_utils/backward.hpp”

问题2

解决:添加头文件:#include"opencv2/imgcodecs/legacy/constants_c.h"

问题3

解决:V_MINMAX 改为 NORM_MINMAX

mat_io_test.cpp文件

问题:

解决:

opencv4.x以上,有些宏,API名字改了,需要改为新的:

CV_LOAD_IMAGE_UNCHANGED 改为 cv::IMREAD_UNCHANGED

CV_LOAD_IMAGE_GRAYSCALE 改为 cv::IMREAD_GRAYSCALE

CV_LOAD_IMAGE_COLOR 改为 cv::IMREAD_COLOR

CV_LOAD_IMAGE_ANYDEPTH 改为 cv::IMREAD_ANYDEPTH

3 imu_utils编译

文件结构:

        将 ROS 包imu_utils放入code_utils的工作区src下面进行编译使用catkin_make;进行构建

        CMakeLists.txt文件下

        代码修改如下:

修改set(CMAKE_CXX_FLAGS "-std=c++11")为set(CMAKE_CXX_FLAGS "-std=c++14")

4 播放bag文件,进行离线标定IMU(使用imu_utils计算allan方差)

4.1 播放rosbag

rosbag play -r 200 imu.bag               // 200 倍速播放rosbag

4.2 运行标定文件

source ./devel/setup.bash

roslaunch imu_utils gh5a5s1.launch

注意:等rosbag播放两秒左右在启动launch文件,因为在IMU前几分钟录制的数据误差比较大。

4.3 标定结果

        数据包播放结束之后,在/imu_utils/data/这个文件夹下会出现一系列的参数文件,如上图所示。

        打开xxxx_imu_param.yaml这个文件,会看到计算出来的噪声和随机游走的系数值,如下所示:

        虽然我们得到了标定结果,但这个标定结果并不是我们最终的结果。现在得到的结果的单位是rad/s和m/s^2,噪声是个能量概念或者说功率概念,我们还要把标定得到的参数归一化到每单位sqrt(hz)尺度下,即/aqrt(Hz)。

        加速度allan方差图

        加速度每个轴的allan方差

        陀螺的allan方差

        陀螺每个轴的allan方差

有时候播放完数据,程序没有任何反映。试试300rete 播放。

三、 利用kalibr_allan标定IMU随机误差

        该方法需要安装Matlab,才能编译kalibr_allan。

1. 下载kalibr_allan并编译

        问题:

        在/kalibr_allan-master/bagconvert/cmake目录下找到FindMatlab.cmake文件,更改matlab的地址。

find_program(MATLAB_EXE_PATH matlab

    PATHS /usr/local/MATLAB/R2018a/bin)

        把 /usr/local/MATLAB/R2018a/bin更换成自己matlab的地址

        修改之后,删除build和dev文件夹,再次catkin_make

2. 生成mat文件

        rosrun bagconvert bagconvert bag名字 topic名字

3. matlab计算IMU误差

        利用/kalibr_allan/matlab/SCRIPT_allan_matparallel.m生成误差文件。

生成误差的.m文件:

注意:修改路径,最好改为绝对路径

/kalibr_allan/matlab/SCRIPT_allan_matparallel.m

4. 绘制allan方差曲线

4.1 运行/kalibr_allan/matlab/SCRIPT_process_results.m文件

修改路径mat_path的路径修改为步骤3中得到的.mat文件

4.2 标定结果

accelerometer_noise_density = 0.00102011

accelerometer_random_walk   = 0.00003924

gyroscope_noise_density     = 0.00001248

gyroscope_random_walk       = NaN

本文来自互联网用户投稿,该文观点仅代表作者本人,不代表本站立场。本站仅提供信息存储空间服务,不拥有所有权,不承担相关法律责任。如若转载,请注明出处:/a/511373.html

如若内容造成侵权/违法违规/事实不符,请联系我们进行投诉反馈qq邮箱809451989@qq.com,一经查实,立即删除!

相关文章

Python 之 Flask 框架学习

毕业那会使用过这个轻量级的框架,最近再来回看一下,依赖相关的就不多说了,直接从例子开始。下面示例中的 html 模板,千万记得要放到 templates 目录下。 Flask基础示例 hello world from flask import Flask, jsonify, url_fora…

STM32H5 读取温度传感器校准值时进 HardFault 的原因分析

1.前言 有客户反馈,在使用 STM32H5 读取温度传感器校准值地址时,会进入 HardFault,而在其他系列芯片中读取这个参数时并没有此现象。在 NUCLEO-H563ZI 开发板上去复现此问题,发现只有开启 ICACHE 后才会复现,初步验证…

图像处理与视觉感知---期末复习重点(6)

文章目录 一、图像分割二、间断检测2.1 概述2.2 点检测2.3 线检测2.4 边缘检测 三、边缘连接3.1 概述3.2 Hough变换3.3 例子3.4 Hough变换的具体步骤3.5 Hough变换的法线表示形式3.6 Hough变换的扩展 四、阈值处理4.1 概述4.2 计算基本全局阈值算法4.3 自适应阈值 五、基于区域…

ElementUI 表格横向滚动条时滚动到指定位置

ElementUI 表格横向滚动条时滚动到指定位置 getColumnOffset(columnProp) {this.$nextTick(() > {const table this.$refs.tableRef.$refs.multipleTable;const columns table.columns;const column columns.find((col) > col.property columnProp);if (column) {// …

Flume学习笔记

视频地址:https://www.bilibili.com/video/BV1wf4y1G7EQ/ 定义 Flume是一个高可用的、高可靠的、分布式的海量日志采集、聚合和传输的系统。 Flume高最要的作用就是实时读取服务器本地磁盘的数据,将数据写入HDFS。 官网:https://flume.apache.org/releases/content/1.9.0/…

Python PDF页面设置 -- 旋转页面、调整页面顺序

在将纸质文档扫描成PDF电子文档时,有时可能会出现页面方向翻转或者页面顺序混乱的情况。为了确保更好地浏览和查看PDF文件,本文将分享一个使用Python来旋转PDF页面或者调整PDF页面顺序的解决方案。 目录 使用Python旋转PDF页面 使用Python调整PDF页面…

【Redis 知识储备】单机架构 -- 分布系统的演进(1)

单机架构 1. 概念2. 单机架构的优点3. 单机架构的问题4. 单机架构问题的解决思路 1. 概念 单机架构, 只有一台服务器, 这个服务器负责所有的工作 初期,我们需要利⽤我们精⼲的技术团队,快速将业务系统投⼊市场进⾏检验,并且可以迅速响应变化…

【攻防世界】warmup (代码审计)

进入题目环境,只有一个表情: ctrl u 查看源代码: 源代码提示我们访问 /source.php。访问结果如下: 我们进行代码审计,发现解题的关键点 include &_REQUEST[file]。但是题目使用了白名单进行了过滤。我们发现白名单…

Redis底层数据库之SDS

高速的存储介质:内存优秀的底层数据结构高效的IO模型高效的线程模型 1. 动态字符串SDS Redis中保存的Key是字符串,value往往是字符串或者字符串的集合。可见字符串是redis中最常用的一种数据结构。 C语言种字符串存在的一些问题: 获取字符…

web-AOP

AOP基础 AOP进阶 通知顺序和类型 切入点表达式 连接点

腾讯云(CVM)托管进行权限维持

前言 刚好看到一个师傅分享了一个阿里云ECS实战攻防,然后想到了同样利用腾讯云CVM的托管亦可实现在实战攻防中的权限维持。 简介 腾讯云自动化助手(TencentCloud Automation Tools,TAT)是一个原生运维部署工具,它可…

链表的极致——带头双向循环链表

​ 文章目录 双向带头循环链表简介:双向:带头:特点:链表带头节点的好处: 循环:特点:循环的好处: 双向带头循环链表的接口函数实现准备工作: 初始化链表(头结…

在flutter中添加video_player【视频播放插件】

添加插件依赖 dependencies:video_player: ^2.8.3插件的用途 在Flutter框架中,video_player 插件是一个专门用于播放视频的插件。它允许开发者在Flutter应用中嵌入视频播放器,并提供了一系列功能来控制和定制视频播放体验。这个插件对于需要在应用中展…

HarmonyOS 应用开发之创建自定义组件

在ArkUI中,UI显示的内容均为组件,由框架直接提供的称为系统组件,由开发者定义的称为自定义组件。在进行 UI 界面开发时,通常不是简单的将系统组件进行组合使用,而是需要考虑代码可复用性、业务逻辑与UI分离&#xff0c…

练习 17 Web [极客大挑战 2019]PHP

常见的网站源码备份文件名和后缀,反序列化攻击 unserialize():wakeup绕过,private类以及属性序列化后的%00修改 开靶机 提到”备份“ 那看看有没有backup.php啥的 如果网站存在备份文件,常见的备份文件后缀名有:“.gi…

系统IO函数接口

目录 前言 一. man手册 1.1 man手册如何查询 1.2 man手册基础 二.系统IO函数接口 三.open打开文件夹 3.1 例1 open打开文件 3.2 open打开文件代码 3.3 例2 创建文件 四.write写文件 4.1 write写文件 五. read读文件 5.1 read读文件与偏移 5.2 偏移细节 5.3 read读文件代码 六.复…

vscode 重命名很慢或失败 vscode renames are slow

网上问题, 插件问题(我遇见的排除,不是)被其他程序占用问题,(我这边是这个) 解决方案: 打开【资源管理器】,使用火绒 或其他软件,查看文件夹 or 文件 被哪个…

集合的学习

为什么要有集合:集合会自动扩容 集合不能存基本数据类型(基本数据类型是存放真实的值,而引用数据类型是存放一个地址,这个地址存放在栈区,地址所指向的内容存放在堆区) 数组和集合的对比: 集…

Python 简单使用 RabbitMQ

一、安装 pip install pika 二、推送消息到队列中 执行pythone方法 import pika import time# 用户名和密码 user_info pika.PlainCredentials(admin,admin)# 连接服务器上的rabbitMQ服务 connection pika.BlockingConnection(pika.ConnectionParameters(127.0.0.1, 5672,…

python核心篇之网络通信

一. 发送请求 1. 发送get请求 2. 发送post请求 3. json数据与python数据的对应关系