一种加速度计算方法技术

本发明专利技术公开了一种加速度计算方法，包括使用互补滤波器融合陀螺仪、加速度计和磁力计。本发明专利技术的有益效果是：利用互补滤波器，采集加速度计、陀螺仪、磁力计组成的九轴惯性传感器输出数据，计算出四元数，研究地理坐标系和载体坐标系之间的投影关系，采用四元数姿态解算法解算出刚体的运动方向，去除重力加速度g在加速度计三轴上的投影分量后，最终得到刚体的真实X、Y、Z轴的加速度与合加速度。Z轴的加速度与合加速度。Z轴的加速度与合加速度。

【技术实现步骤摘要】
一种加速度计算方法


[0001]本专利技术涉及一种加速度计算方法，属于运动加速度研究


技术介绍

[0002]目前，在人体运动姿态、运动加速度和速度的研究领域方面，研究者常借助使用互补滤波姿态算法计算刚体的姿态角和使用三轴加速度计来采集加速度数据，进行加速度的计算，如：一种航姿参考系统的互补滤波姿态解算方法(专利申请号：202010464589.6)，一种加速度计的测试方法(专利申请号：201711408774.8)。经研究后发现，通过姿态解算只能得到刚体的运动方向；且采用三轴加速度计来计算加速度，得到的加速度方向与刚体的真实运动的加速度方向任然存在误差，依靠加速度的公式计算合加速度数值在计算计算加速度值时，存在外在因素影响，计算得到的加速度值也存在误差。
[0003]造成刚体加速度存在误差的原因主要有：
[0004](1)方向问题：当芯片安置在刚体上，存在安装倾斜、放置位置变化、芯片与刚体接触不平整等诸多因素，刚体运动的三轴方向实际上很难与芯片的三轴方向完全重合，研究者仅凭三轴加速度计提供的各轴原始加速度数值，无法获得刚体真实的运动合加速度方向。
[0005](2)数值问题：三轴加速度计提供的X、Y、Z各轴向的加速度数值含有重力加速度g的分量。
[0006]这种由加速度计提供的各轴原始加速度数值包含有重力加速度g的三轴投影分量，由该值计算出的刚体运动合加速度无论是在方向上，还是在数值大小上，都与真实的刚体运动合加速度相差甚远，加速度计输出的三轴向加速度并不等同于刚体的三轴向加速度数据。
[0007]因此，仅凭三轴加速度计自身是无法准确计算出刚体的合加速度，但依靠九轴惯性传感器提供的九轴数值，通过互补滤波器利用输出数据计算出四元数的算法，可以去掉重力加速度g的影响，从而计算出刚体真实的合加速度数值。

技术实现思路

[0008]本专利技术的目的就在于为了解决上述至少一个技术问题而提供一种加速度计算方法。
[0009]本专利技术通过以下技术方案来实现上述目的：一种加速度计算方法，包括选用载体坐标系XbYbZb和地理坐标系NED，包括以下步骤
[0010]步骤一、采集九轴惯性传感器信息；
[0011]步骤二、利用四元数姿态解算建立运动学方程；
[0012]步骤三、建立九轴惯性传感器误差模型，解算正确的角速度值，并利用互补滤波器校准偏差，得到正确的角速度值；
[0013]步骤四、根据四元微分方程和校准偏差后的角速度值ω，得到正确的四元数；
[0014]步骤五、通过正确的四元数q0、q1、q2和q3，解算出刚体姿态角和加速度的真实值。
[0015]作为本专利技术再进一步的方案：所述步骤一中，九轴惯性传感器采集信息包括：加速度计数据信息、磁力计数据信息、陀螺仪数据信息。
[0016]作为本专利技术再进一步的方案：所述步骤二中，利用四元数姿态解算法建立四元数的姿态矩阵方程；采用数值积分法来求解矩阵和四元数微分方程；
[0017]其中，根据四元数的复数表达式q＝q0+q1i+q2j+q3k，通过矢量变换四元数姿态矩阵为：
[0018][0019]数值积分法选择一阶龙格—库塔法解四元数微分方程：
[0020]四元数的微分方程：
[0021][0022]一阶龙格—库塔法得到的计算式：
[0023][0024]展开成分量表达式，有：
[0025][0026]对四元数做归一化处理，得：
[0027][0028]式中是载体坐标系相对导航坐标系的角速度，x、y、z代表陀螺仪上的x、y、z轴；
通过将修正后得到真实的四个参数q0、q1、q2和q3值。
[0029]作为本专利技术再进一步的方案：所述步骤三中，建立互补滤波器,利用陀螺仪输出角速度值和用加速度计和磁力计校准偏差，得到正确的角速度值；
[0030]校准偏差方案：加速度计修正两坐标系在X、Y轴的旋转误差；磁力计修正两坐标系在Z轴的旋转误差；结合X、Y、Z三个轴的旋转误差修正值；
[0031]具体包括：
[0032]确立互补滤波器设互补滤波器的传递函数为：
[0033][0034]式中，k
P
的大小决定了互补滤波器的截止频率，在大于f
T
的高频阶段，陀螺仪数据决定解算结果；在小于f
T
的低频阶段，对解算结果起主要作用的是加速度计和磁力计数据。k
I
决定消除静态偏差用时；C(s)具有全通特性。
[0035]校准偏差后，加速度修正值为：
[0036]ω＝ω
g
+δ
[0037]δ＝k
P
·
e+k
I
·
∫e dt
[0038]e＝e
acc
+e
mag
[0039]ω表示修正后的角速度值；ω
g
表示陀螺仪输出的角速度向量；e表示加速度计和磁力计校准得到的误差值；δ表示角速度修正值。将修正后的角速度值ω代入步骤二，可计算出四元数q0、q1、q2和q3。
[0040]加速度计输出修正误差如下：
[0041]加速度计三轴数据为a
x
、a
y
、a
z
，归一化后：
[0042]由加速度计校准得到的偏差为e
acc
，v表示重力向量在机体坐标系的向量。
[0043]e
acc
＝a
×
v
[0044]磁力计输出修正误差如下：
[0045]磁力计三轴数据为m
x
、m
y
、m
z
，归一化后：
[0046]经过坐标变换后，m变为
[0047]设计一个理想的地磁场：Y轴指向正北方，此时Y轴的地磁力为1，X轴的地磁力为0。
[0048]理论的地理磁场强度归一化向量为：
[0049]理论的地理磁场强度归一化向量经过坐标转换，得到理论的地理磁场强度在芯片上的归一化投影向量为：
[0050]e
mag
＝m
×
w
[0051]作为本专利技术再进一步的方案：所述步骤四中，具体包括：
[0052]建立姿态矩阵方程，采用数值积分法来求解矩阵和四元数微分方程；利用陀螺仪输出角速度值和用加速度计和磁力计校准偏差，通过步骤三中得到的正确的角速度值ω,代入步骤二中可得真实的四元数数值。
[0053]作为本专利技术再进一步的方案：所述步骤五中，具体包括：
[0054]刚体姿态角的计算
[0055]通过载体坐标系相对于地理坐标系的关系得载体的姿态，地理坐标系到运载体坐标系的变换矩阵为姿态矩阵与四元数姿态矩阵等价：
[0056][0057]将计算所得四元数带入式中，计算出姿态角为
[0058][0059]刚体加速度大小的计算本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种加速度计算方法，其特征在于：所述加速度计算方法选用载体坐标系XbYbZb和地理坐标系NED，其包括以下步骤步骤一、采集九轴惯性传感器信息；步骤二、利用四元数姿态解算建立运动学方程；步骤三、建立九轴惯性传感器误差模型，解算正确的角速度值，并利用互补滤波器校准偏差，得到正确的角速度值；步骤四、根据四元微分方程和校准偏差后的角速度值ω，得到正确的四元数；步骤五、通过正确的四元数q0、q1、q2和q3，解算出刚体姿态角和加速度的真实值。2.根据权利要求1所述的加速度计算方法，其特征在于：所述步骤一中，九轴惯性传感器采集信息包括：加速度计数据信息、磁力计数据信息、陀螺仪数据信息。3.根据权利要求1所述的加速度计算方法，其特征在于：所述步骤二中，利用四元数姿态解算法建立四元数的姿态矩阵方程；采用数值积分法来求解矩阵和四元数微分方程；其中，根据四元数的复数表达式q＝q0+q1i+q2j+q3k，通过矢量变换四元数姿态矩阵为：数值积分法选择一阶龙格—库塔法解四元数微分方程：四元数的微分方程：一阶龙格—库塔法得到的计算式：展开成分量表达式，有：对四元数做归一化处理，得：
式中是载体坐标系相对导航坐标系的角速度，x、y、z代表陀螺仪上的x、y、z轴；通过将修正后得到真实的四个参数q0、q1、q2和q3值。4.根据权利要求1所述的加速度计算方法，其特征在于：所述步骤三中，建立互补滤波器,利用陀螺仪输出角速度值和用加速度计和磁力计校准偏差，得到正确的角速度值；校准偏差方案：加速度计修正两坐标系在X、Y轴的旋转误差；磁力计修正两坐标系在Z轴的旋转误差；结合X、Y、Z三个轴的旋转误差修正值；具体包括：确立互补滤波器设互补滤波器的传递函数为：式中，k
P
的大小决定了互补滤波器的截止频率，在大于f
T
的高频阶段，陀螺仪数据决定解算结果；在小于f
T
的低频阶段，对解算结果起主要作用的是加速度计和磁力计数据，k
I
决定消除静态偏差用时；C(s)具有全通特性；校准偏差后，加速度修正值为：ω＝ω
g
+δδ＝k
P
·
e+k
I
·
∫edte＝e
acc
+e
mag
ω表示修正后的角速度值；ω
g
表示陀螺仪输出的角速度向量；e表示加速度计和磁力计校准得到的误差值；δ表示角速度...

【专利技术属性】
技术研发人员：胡璞，
申请(专利权)人：武汉体育学院，
类型：发明
国别省市：