一种数据校正方法、装置、设备及可读存储介质制造方法及图纸

技术编号:38426796 阅读:10 留言:0更新日期:2023-08-07 11:24
本申请公开了传感器测量技术领域内的一种数据校正方法、装置、设备及可读存储介质。本申请通过云计算端实时收集设备工作过程中的惯性数据,先对惯性数据中的静止状态下的加速度数据进行判断,若静止状态下的加速度数据符合预设加速度模长,则删减掉加速度误差参数的标定,直接基于惯性数据中的角速度数据实时完成角速度误差参数的标定。该方案通过云计算端实时执行,不影响用户对目标设备的使用,且能够从实时数据中选择合适的数据删减标定流程,降低了IMU标定对用户使用设备的影响,提升了标定方案的灵活性和通用性,也简化了标定方案,提高了标定效率。提高了标定效率。提高了标定效率。

【技术实现步骤摘要】
一种数据校正方法、装置、设备及可读存储介质


[0001]本申请涉及传感器测量
,特别涉及一种数据校正方法、装置、设备及可读存储介质。

技术介绍

[0002]目前,各种智能设备中都设有加速度、陀螺仪、磁力计、高度计、压力计等传感器。其中,基于MEMS(Microelectromechanical Systems)的6轴IMU(Inertial Measurement Unit)是包括有3轴加速度计和3轴陀螺仪的惯性测量单元,将其设于智能设备中,可以通过其中的加速度计测量3轴加速度,陀螺仪测量3轴角速度。但是,IMU在生产加工过程中会存在确定性误差,加速度计和陀螺仪的确定性误差均包含静态偏置、尺度误差和三轴非正交误差。在使用IMU过程中,加速度的1次积分和2次积分分别为速度和位置,角速度的积分为角度。由于确定性误差的存在,即使在短时间内,IMU所测数据的积分也会使得速度、位置、角度存在很大的误差,因此需要对IMU的确定性误差进行标定。
[0003]当前相关方案需要依赖高精密的转台提供精确的加速度值和角速度值,不易操作且成本较高,并且需要相关技术人员专门花时间进行离线标定,会影响用户对智能设备的正常使用。
[0004]因此,如何降低IMU标定对用户使用设备的影响,提升标定方案的灵活性和通用性,是本领域技术人员需要解决的问题。

技术实现思路

[0005]有鉴于此,本申请的目的在于提供一种数据校正方法、装置、设备及可读存储介质,以降低IMU标定对用户使用设备的影响,提升标定方案的灵活性和通用性。其具体方案如下:第一方面,本申请提供了一种数据校正方法,应用于云计算端,包括:在目标设备工作过程中,收集所述目标设备中的惯性测量单元测量得到的惯性数据;从所述惯性数据中筛选所述目标设备静止状态下的加速度数据;若所述加速度数据符合预设加速度模长,则从所述惯性数据中筛选符合预设条件的至少两组目标数据,并基于所述至少两组目标数据计算角速度误差参数;其中,每一组目标数据由所述惯性测量单元在所述目标设备从静止状态转换为运动状态再转换为静止状态的过程中,测量所述目标设备的加速度和角速度得到;将所述角速度误差参数发送至所述目标设备,以使所述目标设备根据所述角速度误差参数校正所述惯性测量单元当前测量的角速度值。
[0006]可选地,所述从所述惯性数据中筛选所述目标设备静止状态下的加速度数据,包括:利用预设滑动窗口在所述惯性数据中筛选至少9个时间连续且加速度方差不大于
预设方差阈值的数据区间;将筛选出的至少9个数据区间确定为所述加速度数据。
[0007]可选地,计算所述加速度数据中每一数据区间对应的加速度均值;计算每一加速度均值的模长与重力加速度的模长的差异值;若各差异值的离散程度小于预设离散程度阈值,则确定所述加速度数据符合所述预设加速度模长;否则,确定所述加速度数据不符合所述预设加速度模长。
[0008]可选地,还包括:若所述加速度数据不符合所述预设加速度模长,则在所述加速度数据的方差小于前次标定的静止加速度方差的情况下,基于所述加速度数据计算加速度误差参数;将所述加速度误差参数发送至所述目标设备,以使所述目标设备根据所述加速度误差参数校正所述惯性测量单元当前测量的加速度值。
[0009]可选地,所述基于所述加速度数据计算加速度误差参数,包括:利用所述加速度数据构建加速度最小二乘方程,以求解所述加速度误差参数;所述加速度误差参数包括:所述惯性测量单元中的加速度计的静态偏置、尺度因子误差和非正交误差;所述加速度最小二乘方程为:;其中,为所述加速度计的静态偏置、尺度因子误差和非正交误差中的需求解元素,表示非正交坐标系下所述加速度计的y轴绕正交坐标系的z轴的旋转大小,表示非正交坐标系下所述加速度计的z轴绕正交坐标系的y轴的旋转大小,表示非正交坐标系下所述加速度计的z轴绕正交坐标系的x轴的旋转大小,表示所述加速度计的x轴、y轴和z轴的尺度因子误差,表示所述加速度计的x轴、y轴和z轴的静态偏置;L为所述加速度数据中的加速度值的总数量,;为所述加速度数据中的第k个数据区间内的各加速度值的均值;为含需求解元素的静态偏置,为含需求解元素的尺度因子误差,为含需求解元素的非正交误差。
[0010]可选地,所述目标设备根据所述加速度误差参数校正所述惯性测量单元当前测量的加速度值,包括:所述目标设备按照加速度校正公式校正所述惯性测量单元当前测量的加速度值;所述加速度校正公式为:;其中,为校正后的加速度值;为求解得到的所述惯性测量单元中的加速度计的静态偏置,为求解得到的所述加速度计的尺度因子误差,为求解得到的所述加速度计的非正交误差;为所述加速度计当前测量的加速度值。
[0011]可选地,还包括:若所述加速度数据不符合所述预设加速度模长,则在所述加速度数据的方差不小于前次标定的静止加速度方差的情况下,丢弃所述加速度数据,并结束本次标定。
[0012]可选地,所述预设条件包括:每一组目标数据对应的运动状态持续时间小于预设时间阈值;至少两组目标数据对应的静止状态的时间段总个数不小于3。
[0013]可选地,所述角速度误差参数包括:所述惯性测量单元中的陀螺仪的静态偏置、尺度因子误差和非正交误差;
相应地,所述基于所述至少两组目标数据计算角速度误差参数,包括:计算所述至少两组目标数据中的所有静止状态的角速度数据的平均值,并将所述平均值确定为所述陀螺仪的静态偏置;利用所述至少两组目标数据构建角速度最小二乘方程,以求解所述陀螺仪的尺度因子误差和非正交误差;所述角速度最小二乘方程为:;其中,为所述陀螺仪的尺度因子误差和非正交误差中的需求解元素,表示非正交坐标系下所述陀螺仪的y轴绕正交坐标系的z轴的旋转大小,表示非正交坐标系下所述陀螺仪的z轴绕正交坐标系的y轴的旋转大小,表示非正交坐标系下所述陀螺仪的x轴绕正交坐标系的z轴的旋转大小,表示非正交坐标系下所述陀螺仪的z轴绕正交坐标系的x轴的旋转大小,表示非正交坐标系下所述陀螺仪的x轴绕正交坐标系的y轴的旋转大小,表示非正交坐标系下所述陀螺仪的y轴绕正交坐标系的x轴的旋转大小,表示所述陀螺仪的x轴、y轴和z轴的尺度因子误差;a
j
‑1表示每一组目标数据中的前一静止状态j

1的加速度均值,a
j
表示每一组目标数据中的后一静止状态j的加速度均值,为旋转矩阵,所述旋转矩阵通过对前一静止状态j

1与后一静止状态j之间的运动状态的角速度数据进行4阶龙格库塔积分得到,j表示任意一组目标数据的组标识,Q为所有组标识的集合。
[0014]可选地,所述目标设备根据所述角速度误差参数校正所述惯性测量单元当前测量的角速度值,包括:所述目标设备按照角速度校正公式校正所述惯性测量单元当前测量的角速度值;所述角速度校正公式为:;其中,为校正后的角速度值;为求解得到的所述惯性测量单元中的陀螺仪的静态偏置,为求解得到的所述陀螺仪的尺度因子误差,为求解得到的所述陀螺仪的非正交误差;为所述陀螺仪当前测量的角速度值。本文档来自技高网
...

【技术保护点】

【技术特征摘要】
1.一种数据校正方法,其特征在于,应用于云计算端,包括:在目标设备工作过程中,收集所述目标设备中的惯性测量单元测量得到的惯性数据;从所述惯性数据中筛选所述目标设备静止状态下的加速度数据;若所述加速度数据符合预设加速度模长,则从所述惯性数据中筛选符合预设条件的至少两组目标数据,并基于所述至少两组目标数据计算角速度误差参数;其中,每一组目标数据由所述惯性测量单元在所述目标设备从静止状态转换为运动状态再转换为静止状态的过程中,测量所述目标设备的加速度和角速度得到;将所述角速度误差参数发送至所述目标设备,以使所述目标设备根据所述角速度误差参数校正所述惯性测量单元当前测量的角速度值。2.根据权利要求1所述的数据校正方法,其特征在于,所述从所述惯性数据中筛选所述目标设备静止状态下的加速度数据,包括:利用预设滑动窗口在所述惯性数据中筛选至少9个时间连续且加速度方差不大于预设方差阈值的数据区间;将筛选出的至少9个数据区间确定为所述加速度数据。3.根据权利要求2所述的数据校正方法,其特征在于,包括:计算所述加速度数据中每一数据区间对应的加速度均值;计算每一加速度均值的模长与重力加速度的模长的差异值;若各差异值的离散程度小于预设离散程度阈值,则确定所述加速度数据符合所述预设加速度模长;否则,确定所述加速度数据不符合所述预设加速度模长。4.根据权利要求1所述的数据校正方法,其特征在于,还包括:若所述加速度数据不符合所述预设加速度模长,则在所述加速度数据的方差小于前次标定的静止加速度方差的情况下,基于所述加速度数据计算加速度误差参数;将所述加速度误差参数发送至所述目标设备,以使所述目标设备根据所述加速度误差参数校正所述惯性测量单元当前测量的加速度值。5.根据权利要求4所述的数据校正方法,其特征在于,所述基于所述加速度数据计算加速度误差参数,包括:利用所述加速度数据构建加速度最小二乘方程,以求解所述加速度误差参数;所述加速度误差参数包括:所述惯性测量单元中的加速度计的静态偏置、尺度因子误差和非正交误差;所述加速度最小二乘方程为:;其中,为所述加速度计的静态偏置、尺度因子误差和非正交误差中的需求解元素,表示非正交坐标系下所述加速度计的y轴绕正交坐标系的z轴的旋转大小,表示非正交坐标系下所述加速度计的z轴绕正交坐标系的y轴的旋转大小,表示非正交坐标系下所述加速度计的z轴绕正交坐标系的x轴的旋转大小,表示所述加速度计的x轴、y轴和z轴的尺度因子误差,表示所述加速度计的x轴、y轴和z轴的静态偏置;L为所述加速度数据中的加速度值的总数量,;为所述加速度数据中的第k个数据区间内的各加速度值的均值;为含需求解元素的静态偏置,为含需求解元素的尺度因子误差,为含需求解元素的非正交误差。
6.根据权利要求4所述的数据校正方法,其特征在于,所述目标设备根据所述加速度误差参数校正所述惯性测量单元当前测量的加速度值,包括:所述目标设备按照加速度校正公式校正所述惯性测量单元当前测量的加速度值;所述加速度校正公式为:;其中,为校正后的加速度值;为求解得到的所述惯性测量单元中的加速度计的静态偏置,为求解得到的所述加速度计的尺度因子误差,为求解得到的所述加速度计的非正交误差;为所述加速度计当前测量的加速度值。7.根据权利要求1所述的数据校正方法,其特征在于,还包括:若所述加速度数据不符合所述预设加速度模长,则在所述加速度数据的方差不小于前次标定的静止加速度方差的情况下,丢弃所述加速度数据,并结束本次标定。8.根据权利要求1所述的数据校正方法,其特征在于,所述预设条件包括:每一组目标数据对应的运动状态持续时间小于预设时间阈值;至少两组目标数据对应的静止状态的时间段总个数不小于3。9.根据权利要求1所述的数据校正方法,其特征在于,所述角速度误差参数包括:所述惯性测量单元中的陀螺仪的静态偏置、尺度因子误差和非正交误差;相应地,所述基于所述至少两组目标数据计算角速度误差参数,包括:计算所述至少两组目标数据中的所有静止状态的角速度数据的平均值,并将所述平均值确定为所述陀螺仪的静态偏置;利用所述至少两组目标数据构建角速度最小二乘方程,以求解所述陀螺仪的尺度因子误差和非正交误差;所述角速度最小二乘方程为:;其中,为所述陀螺仪的尺度因子误差和非正交误差中的需求...

【专利技术属性】
技术研发人员:魏一振申屠晗钟家跃张卓鹏
申请(专利权)人:杭州光粒科技有限公司
类型:发明
国别省市:

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1