一种陀螺仪数据融合方法技术

本发明专利技术公开了一种陀螺仪数据融合方法，包括以下步骤：A、在陀螺仪设备开启时，利用静止状态下加速度计输出的三个轴矢量，计算三个轴矢量和的模值；B、在运动状态下加速度计输出的三个轴矢量，计算三个轴矢量和的模值；C、利用上一时刻的姿态角、根据加速度计的输出得到的姿态角、根据角速度计得到的特定轴的角速度、上一时刻与当前时刻的间隔时间以及数据融合参考系数，计算当前的姿态角。本发明专利技术通过在数据融合过程中引入数据融合参考系数，在不增加计算复杂度的情况下实现高精度数据融合，同时解决了现有技术在设备存在加速度的情况下不能进行姿态定位的问题。本发明专利技术作为一种陀螺仪数据融合方法可广泛应用于陀螺仪技术领域。

【技术实现步骤摘要】

本专利技术涉及陀螺仪
，尤其是。
技术介绍
现有设备中采用陀螺仪来做智能控制，大多设备采用双轴或三轴陀螺仪来控制设 备的姿态角，由于加速度计在静止时数据是精确的，但是当设备运动起来后，数据就不再精 确了，角加速度计计算物体的旋转运动，至此只用一轴的数据，无论是单独利用加速度计还 是单独利用角加速度计都无法得到设备的角度，而且由于陀螺仪本身的精度和制造工艺等 问题，使得由硬件直接输出的数据具有漂移和累积误差，还有数据耦合过程中也会存在误 差，因此输出的角度数据无法长时间保持高精度，因此利用陀螺仪控制设备的技术难点在 于陀螺仪数据的融合运算。 当前主要有以下几种陀螺仪数据融合的方法，基于四元数融合法，基于卡尔曼算 法的数据融合，基于互补滤波的方式进行数据融合。虽然基于卡尔曼算法的数据融合的精 度较高，但是计算量巨大，过程复杂，基于四元数法计算量比卡尔曼算法小一些，互补滤波 计算量最小但是精度要低一些，而且目前上面的这些融合算法都是在设备没有做加速运动 的情况，在加速运动的情况下，加速度计的数据量融合了重力还有设备本身的加速度，无法 再利用它进行姿态定位。
技术实现思路
为了解决上述技术问题，本专利技术的目的是：提供一种适用于设备存在加速度的陀 螺仪数据融合方法。 本专利技术所采用的技术方案是：，包括有以下步骤： A、 在陀螺仪设备开启时，利用静止状态下加速度计输出的三个轴矢量，计算三个轴矢 量和的模值； B、 在运动状态下加速度计输出的三个轴矢量，计算三个轴矢量和的模值； C、 利用上一时刻的姿态角、根据加速度计的输出得到的姿态角、根据角速度计得到的 特定轴的角速度、上一时刻与当前时刻的间隔时间以及数据融合参考系数，计算当前的姿 态角。 进一步，所述步骤A中对三个轴矢量进行零值偏移误差补偿后再计算三个轴矢量 和的模值。 进一步，所述数据融合参考系数根据上述步骤A、步骤B中的模值计算所得。 进一步，所述步骤C中当前姿态角的计算公式为：本文档来自技高网...

【技术保护点】
一种陀螺仪数据融合方法，其特征在于：包括有以下步骤：A、在陀螺仪设备开启时，利用静止状态下加速度计输出的三个轴矢量，计算三个轴矢量和的模值；B、在运动状态下加速度计输出的三个轴矢量，计算三个轴矢量和的模值；C、利用上一时刻的姿态角、根据加速度计的输出得到的姿态角、根据角速度计得到的特定轴的角速度、上一时刻与当前时刻的间隔时间以及数据融合参考系数，计算当前的姿态角。

【技术特征摘要】
1. 一种陀螺仪数据融合方法，其特征在于：包括有以下步骤： A、 在陀螺仪设备开启时，利用静止状态下加速度计输出的三个轴矢量，计算三个轴矢 量和的模值； B、 在运动状态下加速度计输出的三个轴矢量，计算三个轴矢量和的模值； C、 利用上一时刻的姿态角、根据加速度计的输出得到的姿态角、根据角速度计得到的 特定轴的角速度、上一时刻与当前时刻的间隔时间以及数据融合参考系数，计算当前的姿 态角。2. 根据权利要求1所述的一种陀螺仪数据融合方法，其特征在于：所述步骤A中对三 个轴矢量进行零值偏移误差补偿后再计算三个轴矢量和的模值。3. 根据权利要求1所述的一种陀螺仪数据融合方法，其特征在于：所述数据融合参考 系数根据上述步骤A、步骤B中的模值计算所得。4...

【专利技术属性】
技术研发人员：盖增园，王旭耀，林羽凡，李建奇，雷波，曾德祥，
申请(专利权)人：广州博冠光电技术有限公司，
类型：发明
国别省市：广东;44