CN106643684A - 双轴数字陀螺仪及陀螺仪多层次误差补偿方法 - Google Patents
双轴数字陀螺仪及陀螺仪多层次误差补偿方法 Download PDFInfo
- Publication number
- CN106643684A CN106643684A CN201610907723.9A CN201610907723A CN106643684A CN 106643684 A CN106643684 A CN 106643684A CN 201610907723 A CN201610907723 A CN 201610907723A CN 106643684 A CN106643684 A CN 106643684A
- Authority
- CN
- China
- Prior art keywords
- temperature
- angular rate
- axis
- rate data
- compensation
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 37
- 230000001939 inductive effect Effects 0.000 claims abstract description 35
- 238000006243 chemical reaction Methods 0.000 claims abstract description 7
- 238000005259 measurement Methods 0.000 claims description 20
- 238000004364 calculation method Methods 0.000 claims description 9
- 238000009499 grossing Methods 0.000 claims description 8
- 230000008901 benefit Effects 0.000 claims description 7
- 241001274660 Modulus Species 0.000 claims 1
- 238000012360 testing method Methods 0.000 abstract description 6
- 230000035945 sensitivity Effects 0.000 abstract description 4
- 238000005516 engineering process Methods 0.000 description 4
- 238000012935 Averaging Methods 0.000 description 2
- 239000013078 crystal Substances 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 239000000463 material Substances 0.000 description 2
- 239000013307 optical fiber Substances 0.000 description 2
- 239000000969 carrier Substances 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 239000007788 liquid Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C19/00—Gyroscopes; Turn-sensitive devices using vibrating masses; Turn-sensitive devices without moving masses; Measuring angular rate using gyroscopic effects
- G01C19/02—Rotary gyroscopes
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Manufacturing & Machinery (AREA)
- Gyroscopes (AREA)
Abstract
本发明提出了双轴数字陀螺仪及陀螺仪多层次误差补偿方法，其中该陀螺芯片包含角速率感应传感器、温度传感器及A/D转换电路，角速率感应传感器分别采集载体X、Y轴的角速率信号,同时两个温度传感器分别用于采集两个陀螺芯片的温度信号，角速率信号和温度信号通过A/D转换电路输送到处理器，处理器对上述采集到的数字信号进行补偿运算得到精确的角速率数据，处理器连接输出模块，处理器通过输出模块传送到用户计算机上。进行数据处理时，首先对常温下的数据进行系统灵敏度和零位偏移的补偿，然后通过温度试验，对其进行温度补偿。通过两次补偿后，角速率传感器的系统零位偏差、偏差温度灵敏度等系统特性得到补偿，从而提高了测试精度。
Description
技术领域
本发明涉及惯性技术领域，特别涉及双轴数字陀螺仪及陀螺仪多层次误差补偿方法。
背景技术
过去普遍使用机械式的角速率陀螺，如液浮角速率陀螺、挠性有旋转马达的角速率陀螺等，这些角速率陀螺在实际应用中存在体积的大，价格昂贵、易损坏的缺点；
随着电子技术的进步，出现了许多微机械-电子系统的角速率陀螺，如开环角速率陀螺等，但这类角速率陀螺的输出受技术和和成本影响，陀螺的零位漂移受温度影响很大，有的角速率陀螺的零位偏差没有经过补偿，且输出电压受温度的影响很大，其输出结果有较大误差，如果直接采用角速率陀螺的输出数据，则不能真实地反应载体的运动，从而会对用户载体的运动监测及控制产生重大影响。
发明内容
本发明的目的旨在至少解决所述的技术缺陷之一。
为此，本发明的一个目的在于提出一种双轴数字陀螺仪，包括主控模块、陀螺传感器、A/D转换模块、输出模块；所述陀螺传感器连接A/D转换模块，所述A/D转换模块、主控模块、输出模块依次连接；
所述陀螺传感器包括角速率感应传感器和温度传感器；所述角速率感应传感器用于感测陀螺旋转角速度，获得角速率数据，并将角速率数据发送至A/D转换模块；所述温度传感器，用于采集陀螺传感器的温度信号，并将温度信号发送至A/D转换模块；
所述A/D转换模块，用于接收角速率感应传感器和温度传感器发送的角速率数据和温度信号，并将所述角速率数据和温度信号输送到主控模块；
所述主控模块包括主控芯片、时钟电路、复位电路；所述时钟电路、复位电路分别与主控芯片连接，所述主控芯片接收A/D转换模块发送的角速率数据和温度信号，并将角速率数据进行第一次补偿算法，得出初始补偿角速率数据；并将补偿角速率数据和温度信号进行第二次补偿算法，得到最终补偿角速率数据；
所述输出模块连接主控模块，用于将二次补偿后的最终角速率数据输出。
优选的，所述陀螺传感器和A/D转换模块分别设置为两组，且分别设置在陀螺的X轴方向和Y轴方向，其中，所述陀螺传感器包括：X轴方向角速率感应传感器、X轴方向温度传感器、Y轴方向角速率感应传感器、Y轴方向温度传感器,其中，所述X轴方向角速率感应传感器、X轴方向温度传感器与X轴方向的A/D转换模块相连；所述Y轴方向角速率感应传感器、Y轴方向温度传感器与Y轴方向的A/D转换模块相连。
优选的，所述主控模块执行所述第一次补偿算法，具体包括以下步骤：
在常温下采集X轴、Y轴角速率数据，包括：采集多组预设时间范围的零位输出数据，根据预设时间梯度，对所述X轴、Y轴角速率数据进行数据平滑，求得平均值，然后利用各平均值求出各组平均值；
计算出量程范围内的各点平均测量值信息，使用最小二乘法将平均测量值拟合计算得到比例因子；
利用前面计算得到的比例因子得出其零位偏移，根据计算得到的比例因子和零位偏移建立系统补偿模型，得出角速率数据输出值。
优选的，所述第二次补偿算法具体包括以下步骤：
建立基于温度的陀螺温度漂移误差补偿模型；
在预设温度范围内根据预设温度梯度采集一组X轴、Y轴角速率的全量程数据，计算出各温度下的比例因子和零位偏移；
利用最小二乘法将比例因子和零位偏移拟合，得到比例因子与温度梯度的二次关系，零位偏移与温度的三次关系，进行二次补偿，得出各温度节点下的角速率数据。
本发明还提供一种陀螺仪多层次误差补偿方法，其特征在于，具体包括，
步骤S1，在常温下，利用陀螺仪的角速率感应传感器，采集X轴、Y轴角速率数据；
步骤S2，将采集的角速率数据进行A/D转换后并利用第一次补偿算法进行处理，得出补偿角速率数据；
所述第一次补偿算法的计算过程包括：
步骤S201，在常温下采集X轴、Y轴角速率数据；具体包括，采集多组预设时间范围的零位输出数据，根据预设时间梯度，对所述X轴、Y轴角速率数据进行数据平滑，求得平均值，然后利用各平均值求出各组平均值；
步骤S202，计算出量程范围内的各点平均测量值信息，使用最小二乘法将平均测量值拟合计算得到比例因子；
步骤S203，利用前面计算得到的比例因子得出其零位偏移，根据计算得到的比例因子和零位偏移建立系统补偿模型。
步骤S3，利用温度传感器采集温度信号，将温度信号和补偿角速率数据进行第二次补偿算法，并利用第二次补偿算法进行二次补偿，得出各温度节点下的角速率数据。
步骤S3中所述第二次补偿算法的计算过程包括：
步骤S301，建立基于温度的陀螺温度漂移误差补偿模型；在预设温度范围内根据预设温度梯度采集一组X轴、Y轴角速率的全量程数据，计算出各温度下的比例因子和零位偏移；
步骤S302，利用最小二乘法将比例因子和零位偏移拟合，得到比例因子与温度梯度的二次关系，零位偏移与温度的三次关系；
步骤S303，根据拟合结果，建立基于温度的陀螺温度漂移误差补偿模型；进行二次补偿，得出各温度节点下的角速率数据。
优选的，步骤S201中，采集X轴、Y轴角速率数据时，采集多组预设时间范围的零位输出数据，根据预设固定时间梯度，进行数据平滑，求得平均值，然后利用各平均值求出各组平均值。
优选的，步骤S301中所述建立基于温度的陀螺温度漂移误差补偿模型时，采用在预设温度范围内根据预设的温度梯度采集一组X轴、Y轴角速率的全量程数据。
优选的，所述角速率感应传感器和温度传感器共设有两组包括X轴方向角速率感应传感器、X轴方向温度传感器、Y轴方向角速率感应传感器、Y轴方向温度传感器,其中，所述X轴方向角速率感应传感器、X轴方向温度传感器与X轴方向的A/D转换模块相连；所述Y轴方向角速率感应传感器、Y轴方向温度传感器与Y轴方向的A/D转换模块相连。
为了实现上述目的，本发明一方面的实施例提供的双轴数字陀螺仪及陀螺仪多层次误差补偿方法相比于现有技术至少存在以下优点
1、可以针对角速率传感器的系统零位偏差、零位偏差温度灵敏度、比例因子、比例因子温度灵敏度等特性，进行两次补偿，从而保证输出数据的比例因子恒定，保证测量精度。
2、陀螺芯片和温度传感器集成在一起，能更精准的测试陀螺芯片的工作温度，计算出补偿温度补偿公式对数据进行修正。可在-40℃到+85℃范围内检测和实现对零点和比例因子的漂移及温度引起的机械结构变化带来的影响进行补偿。
本发明附加的方面和优点将在下面的描述中部分给出，部分将从下面的描述中变得明显，或通过本发明的实践了解到。
附图说明
本发明的上述和/或附加的方面和优点从结合下面附图对实施例的描述中将变得明显和容易理解，其中：
图1为本发明一种双轴数字陀螺仪的结构框图；
图2为本发明实施例一种双轴数字陀螺仪的主控电路模块的电路原理图；
图3为本发明实施例一种双轴数字陀螺仪的输出电路模块的电路原理图；
图4为本发明一种陀螺仪多层次误差补偿方法的流程示意图。
具体实施方式
下面详细描述本发明的实施例，所述实施例的示例在附图中示出，其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施例是示例性的，旨在用于解释本发明，而不能理解为对本发明的限制。
如图1所示，本发明一方面的实施例提出一种双轴数字陀螺仪，包括主控模块、陀螺传感器、A/D转换模块、输出模块；陀螺传感器连接A/D转换模块，A/D转换模块、主控模块、输出模块依次连接；陀螺传感器包括角速率感应传感器和温度传感器；角速率感应传感器用于感测陀螺旋转角速度，获得角速率数据，并将角速率数据发送至A/D转换模块；温度传感器用于采集陀螺传感器的温度信号，并将温度信号发送至A/D转换模块；A/D转换模块，用于接收角速率感应传感器和温度传感器发送的角速率数据和温度信号，并将角速率数据和温度信号输送到主控模块。
陀螺传感器和A/D转换模块分别设置为两组，且分别设置在陀螺的X轴方向和Y轴方向，其中，陀螺传感器包括：X轴方向角速率感应传感器、X轴方向温度传感器、Y轴方向角速率感应传感器、Y轴方向温度传感器,其中，X轴方向角速率感应传感器、X轴方向温度传感器与X轴方向的A/D转换模块相连；Y轴方向角速率感应传感器、Y轴方向温度传感器与Y轴方向的A/D转换模块相连。
如图2所示，主控模块包括主控芯片、时钟电路、复位电路；时钟电路、复位电路分别与主控芯片连接，主控芯片采用STM32F103C8T6处理器，STM32F103C8T6的第5管脚和第6管脚之间串联晶振Y1，晶振Y1的两端分别连接电容C15的一端、电容C16的一端，电容C15的另一端、电容C16的另一端接地，形成时钟电路。
复位电路包括电阻R7、电容C14，主控芯片的第7管脚连接电阻R7的一端、电容C14的一端，电阻R7的另一端接3.3V、电容C14的另一端接地，形成主控芯片的复位电路。
主控芯片接收A/D转换模块发送的角速率数据和温度信号，并将角速率数据进行第一次补偿算法，得出初始补偿角速率数据；并将初始补偿角速率数据和温度信号进行第二次补偿算法。第一次补偿算法，具体包括以下步骤：
步骤1，在常温下采集X轴、Y轴角速率数据；具体为，采集多组预设时间范围的零位输出数据，根据预设固定时间梯度，进行数据平滑，求得平均值，然后利用各平均值求出各组平均值。其中数据进行平滑处理的过程，包括去除噪声数据、求取本时间梯度的平均值；然后再根据各个时间梯度的平均值进行加和或加权计算求出该时间范围内的最终平均值。
步骤2，计算出量程范围内的各点平均测量值信息，使用最小二乘法将平均测量值拟合计算得到比例因子；
步骤3，利用前面计算得到的比例因子得出其零位偏移，根据计算得到的比例因子和零位偏移建立系统补偿模型，得出角速率数据输出值。
第二次补偿算法具体包括以下步骤：
步骤4，建立基于温度的陀螺温度漂移误差补偿模型；具体包括，在预设温度范围内根据预设温度梯度采集一组X轴、Y轴角速率的全量程数据，计算出各温度下的比例因子和零位偏移；
步骤5，在预设温度范围内根据预设的温度梯度采集一组X轴、Y轴角速率的全量程数据，计算出各温度下的比例因子和零位偏移；
步骤6、利用最小二乘法将比例因子和零位偏移拟合，得到比例因子与温度梯度的二次关系，零位偏移与温度的三次关系，进行二次补偿，得出各温度节点下的角速率数据。
具体为，在步骤1-步骤3中，
依据标准:GJB2426A-2004光纤陀螺仪测试方法计算其零位偏移F0，采集4组100s的数据，对其做1s平滑，求出每组平滑后数据的平均值，然后再求平均，建立零位偏移系统补偿模型，利用前面计算得到的比例因子得出其零偏。
具体为首先根据测量数据Ωij和角速率输出值计算出量程范围内的各点平均测量值信息；
建立零位偏移建立系统补偿模型
Fj＝K·Ωij+F0+Vj
使用最小二乘法将平均测量值拟合计算得到比例因子
进而求得零位偏移F0满足
则补偿后的角速率数据
其中，Ωij为第j个输入角速度，为陀螺在第j个输入角速度第p个输出数据，K比例因子，K0为原始陀螺芯片比例因子，F0为零位偏移，Fj为陀螺仪在第j个输入角速度输出量平均值，CS为补偿后的角速率数据,Vj为拟合零位误差。
具体为，在步骤4-步骤6中；
在-40℃—60℃温度范围内每5℃采集一组X轴、Y轴角速率的全量程数据，计算出各温度下的比例因子和零位偏移，利用最小二乘法将比例因子和零位偏移拟合得到比例因子和零位偏移与温度的关系。
具体为根据上述步骤1-步骤3中分别求得的温度T时刻时比例因子KT和零位偏移量F0T
根据多项式拟合Q(t)＝a0tn+a1tn-1+…+an-1t1+an
建立比例因子KT与温度T的二次关系
KT＝a1T2+b1T+c1
建立零位偏移量F0T与温度T的三次关系
F0T＝a2T3+b2T2+c2T+d2
使用最小二乘法将平均测量值拟合系数a1、b1、c1a2、b2、c2、d2
第二次补偿后的角速率数据
其中，KT为温度T时陀螺芯片比例因子；F0T为温度T时的零位偏移量；CS第一次为补偿后的角速率数据；K0为原始陀螺芯片比例因子。
输出模块连接主控模块，用于将二次补偿后的最终角速率数据输出。
如图3所示，输出模块包括芯片U3、电容C9、电容C10、电容C11、电容C12、电容C13、电阻R4、电阻R5；芯片U3优选的选用串口芯片MAX3160EAP，芯片U3的电源输入端连接电容C9的一端，电容C9的另一端接地；芯片U3的第一输出端与第二输出端之间串联电阻R4，芯片U3的第一输入端与第二输入端之间串联电阻R5，第一输出端、第二输出端、第一输入端、第二输入端分别连接相应的串口接口J6、J5、J4、J3。
如图4所示，本发明还提出一种陀螺仪多层次误差补偿方法，具体包括；
步骤S1，在常温下，利用角速率感应传感器，采集X轴、Y轴角速率数据；
步骤S2，将采集的角速率数据进行A/D转换后并利用第一次补偿算法进行处理，得出补偿角速率数据；
步骤S3，利用温度传感器采集温度信号，将温度信号和补偿角速率数据进行第二次补偿算法，并利用第二次补偿算法进行二次补偿，得出各温度节点下的角速率数据。
步骤S2中第一次补偿算法具体为：
步骤S201，在常温下采集X轴、Y轴角速率数据；
步骤S201中，采集X轴、Y轴角速率数据时，采集多组预设时间范围的零位输出数据，根据预设固定时间梯度，进行数据平滑，求得平均值，然后利用各平均值求出各组平均值。
步骤S202，计算出量程范围内的各点平均测量值信息，使用最小二乘法将平均测量值拟合计算得到比例因子；
步骤S203，利用前面计算得到的比例因子得出其零位偏移，根据计算得到的比例因子和零位偏移建立系统补偿模型。
具体为依据标准:GJB2426A-2004光纤陀螺仪测试方法计算其零位偏移F0，采集4组100s的数据，对其做1s平滑，求出每组平滑后数据的平均值，然后再求平均，建立零位偏移系统补偿模型，利用前面计算得到的比例因子得出其零位偏移量。
具体为首先根据测量数据Ωij和角速率输出值计算出量程范围内的各点平均测量值信息，
建立零位偏移建立系统补偿模型
Fj＝K·Ωij+F0+Vj
使用最小二乘法将平均测量值拟合计算得到比例因子
进而求得零位偏移F0满足
则补偿后的角速率数据
其中，Ωij为第j个输入角速度，为陀螺在第j个输入角速度第p个输出数据，K比例因子，K0为原始陀螺芯片比例因子，F0为零位偏移，Fj为陀螺仪在第j个输入角速度输出量平均值，CS为补偿后的角速率数据,Vj为拟合零位误差。
步骤S3中第二次补偿算法具体为：
步骤S301，建立基于温度的陀螺温度漂移误差补偿模型；
步骤S301中建立基于温度的陀螺温度漂移误差补偿模型时，采用在预设温度范围内根据预设的温度梯度采集一组X轴、Y轴角速率的全量程数据。
步骤S302，利用最小二乘法将比例因子和零位偏移拟合，得到比例因子与温度梯度的二次关系，零位偏移与温度的三次关系；
步骤S303，根据拟合结果，建立基于温度的陀螺温度漂移误差补偿模型；进行二次补偿，得出各温度节点下的角速率数据。
具体为，
具体为，在步骤4-步骤6中，
在-40℃—60℃温度范围内每5℃采集一组X轴、Y轴角速率的全量程数据，计算出各温度下的比例因子和零位偏移，利用最小二乘法将比例因子和零位偏移拟合得到比例因子和零位偏移与温度的关系。
具体为根据上述步骤S201-步骤S203中分别求得的温度T时比例因子KT和温度T时零位偏移量F0T
根据多项式拟合Q(t)＝a0tn+a1tn-1+…+an-1t1+an
建立比例因子KT与温度T的二次关系
KT＝a1T2+b1T+c1
建立零位偏移量F0T与温度T的三次关系
F0T＝a2T3+b2T2+c2T+d2
使用最小二乘法将平均测量值拟合系数a1、b1、c1a2、b2、c2、d2
第二次补偿后的角速率数据
其中，KT为温度T时陀螺芯片比例因子；F0T为温度T时零位偏移量；CS第一次为补偿后的角速率数据；K0为原始陀螺芯片比例因子。
输出模块连接主控模块，用于将二次补偿后的最终角速率数据输出。
经分析，比例因子采用二次拟合，零位偏移采用三次拟合比较简便且拟合度高，
然后在一次补偿的基础上进行二次补偿，此次补偿消除了因温度引起的偏差。本发明可以针对角速率传感器的系统零位偏差、零位偏差温度灵敏度、比例因子、比例因子温度灵敏度等特性，进行两次补偿，从而保证输出数据的比例因子恒定，保证测量精度。
陀螺芯片和温度传感器集成在一起，能更精准的测试陀螺芯片的工作温度，计算出补偿温度补偿公式对数据进行修正。可在-40℃到+85℃范围内检测和实现对零点和比例因子的漂移及温度引起的机械结构变化带来的影响进行补偿。
在本说明书的描述中，参考术语“一个实施例”、“一些实施例”、“示例”、“具体示例”、或“一些示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本发明的至少一个实施例或示例中。在本说明书中，对上述术语的示意性表述不预设指的是相同的实施例或示例。而且，描述的具体特征、结构、材料或者特点可以在任何的一个或多个实施例或示例中以合适的方式结合。
尽管上面已经示出和描述了本发明的实施例，可以理解的是，上述实施例是示例性的，不能理解为对本发明的限制，本领域的普通技术人员在不脱离本发明的原理和宗旨的情况下在本发明的范围内可以对上述实施例进行变化、修改、替换和变型。本发明的范围由所附权利要求及其等同限定。
Claims (8)
1.一种双轴数字陀螺仪，其特征在于，包括主控模块、陀螺传感器、A/D转换模块、输出模块；所述陀螺传感器连接A/D转换模块，所述A/D转换模块、主控模块、输出模块依次连接；
所述陀螺传感器包括角速率感应传感器和温度传感器；所述角速率感应传感器用于感测陀螺旋转角速度，获得角速率数据，并将角速率数据发送至A/D转换模块；所述温度传感器，用于采集陀螺传感器的温度信号，并将温度信号发送至A/D转换模块；
所述A/D转换模块，用于接收角速率感应传感器和温度传感器发送的角速率数据和温度信号，并将所述角速率数据和温度信号输送到主控模块；
所述主控模块包括主控芯片、时钟电路、复位电路；所述时钟电路、复位电路分别与主控芯片连接，所述主控芯片接收A/D转换模块发送的角速率数据和温度信号，并将角速率数据进行第一次补偿算法，得出初始补偿角速率数据；并将补偿角速率数据和温度信号进行第二次补偿算法，得到最终补偿角速率数据；
所述输出模块连接主控模块，用于将二次补偿后的最终角速率数据输出。
2.根据权利要求1所述的一种双轴数字陀螺仪，其特征在于，所述陀螺传感器和A/D转换模块分别设置为两组，且分别设置在陀螺的X轴方向和Y轴方向，其中，所述陀螺传感器包括：X轴方向角速率感应传感器、X轴方向温度传感器、Y轴方向角速率感应传感器、Y轴方向温度传感器,其中，所述X轴方向角速率感应传感器、X轴方向温度传感器与X轴方向的A/D转换模块相连；所述Y轴方向角速率感应传感器、Y轴方向温度传感器与Y轴方向的A/D转换模块相连。
3.根据权利要求1所述的一种双轴数字陀螺仪，其特征在于，所述主控模块执行所述第一次补偿算法，具体包括以下步骤：
在常温下采集X轴、Y轴角速率数据，包括：采集多组预设时间范围的零位输出数据，根据预设时间梯度，对所述X轴、Y轴角速率数据进行数据平滑，求得平均值，然后利用各平均值求出各组平均值；
计算出量程范围内的各点平均测量值信息，使用最小二乘法将平均测量值拟合计算得到比例因子；
利用前面计算得到的比例因子得出其零位偏移，根据计算得到的比例因子和零位偏移建立系统补偿模型，得出角速率数据输出值。
4.根据权利要求3所述的一种双轴数字陀螺仪，其特征在于，所述第二次补偿算法具体包括以下步骤：
建立基于温度的陀螺温度漂移误差补偿模型；
在预设温度范围内根据预设温度梯度采集一组X轴、Y轴角速率的全量程数据，计算出各温度下的比例因子和零位偏移；
利用最小二乘法将比例因子和零位偏移拟合，得到比例因子与温度梯度的二次关系，零位偏移与温度的三次关系，进行二次补偿，得出各温度节点下的角速率数据。
5.一种陀螺仪多层次误差补偿方法，其特征在于，具体包括，
步骤S1，在常温下，利用陀螺仪的角速率感应传感器，采集X轴、Y轴角速率数据；
步骤S2，将采集的角速率数据进行A/D转换后并利用第一次补偿算法进行处理，得出补偿角速率数据；
所述第一次补偿算法的计算过程包括：
步骤S201，在常温下采集X轴、Y轴角速率数据；包括，采集多组预设时间范围的零位输出数据，根据预设时间梯度，对所述X轴、Y轴角速率数据进行数据平滑，求得平均值，然后利用各平均值求出各组平均值；
步骤S202，计算出量程范围内的各点平均测量值信息，使用最小二乘法将平均测量值拟合计算得到比例因子；
步骤S203，利用前面计算得到的比例因子得出其零位偏移，根据计算得到的比例因子和零位偏移建立系统补偿模型；
步骤S3，利用温度传感器采集温度信号，将温度信号和补偿角速率数据进行第二次补偿算法，并利用第二次补偿算法进行二次补偿，得出各温度节点下的角速率数据；
步骤S3中所述第二次补偿算法的计算过程包括：
步骤S301，建立基于温度的陀螺温度漂移误差补偿模型；具体包括，在预设温度范围内根据预设温度梯度采集一组X轴、Y轴角速率的全量程数据，计算出各温度下的比例因子和零位偏移；
步骤S302，利用最小二乘法将比例因子和零位偏移拟合，得到比例因子与温度梯度的二次关系，零位偏移与温度的三次关系；
步骤S303，根据拟合结果，建立基于温度的陀螺温度漂移误差补偿模型；进行二次补偿，得出各温度节点下的角速率数据。
6.根据权利要求5所述的一种陀螺仪多层次误差补偿方法，其特征在于，步骤S201中，采集X轴、Y轴角速率数据时，采集多组预设时间范围的零位输出数据，根据预设固定时间梯度，进行数据平滑，求得平均值，然后利用各平均值求出各组平均值。
7.根据权利要求5所述的一种陀螺仪多层次误差补偿方法，其特征在于，步骤S301中所述建立基于温度的陀螺温度漂移误差补偿模型时，采用在预设温度范围内根据预设的温度梯度采集一组X轴、Y轴角速率的全量程数据。
8.根据权利要求5所述的一种陀螺仪多层次误差补偿方法，其特征在于，所述角速率感应传感器和温度传感器共设有两组包括X轴方向角速率感应传感器、X轴方向温度传感器、Y轴方向角速率感应传感器、Y轴方向温度传感器,其中，所述X轴方向角速率感应传感器、X轴方向温度传感器与X轴方向的A/D转换模块相连；所述Y轴方向角速率感应传感器、Y轴方向温度传感器与Y轴方向的A/D转换模块相连。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201610907723.9A CN106643684A (zh) | 2016-10-19 | 2016-10-19 | 双轴数字陀螺仪及陀螺仪多层次误差补偿方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201610907723.9A CN106643684A (zh) | 2016-10-19 | 2016-10-19 | 双轴数字陀螺仪及陀螺仪多层次误差补偿方法 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN106643684A true CN106643684A (zh) | 2017-05-10 |
Family
ID=58855429
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201610907723.9A Pending CN106643684A (zh) | 2016-10-19 | 2016-10-19 | 双轴数字陀螺仪及陀螺仪多层次误差补偿方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN106643684A (zh) |
Cited By (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111323047A (zh) * | 2018-12-17 | 2020-06-23 | 北京华航无线电测量研究所 | 一种基于加速度计的陀螺零位误差动态补偿方法 |
| CN113062721A (zh) * | 2021-03-15 | 2021-07-02 | 重庆工程学院 | 一种勘探用测井仪的全温补偿方法及系统 |
| CN113155114A (zh) * | 2021-04-23 | 2021-07-23 | 三一重型装备有限公司 | Mems惯性测量单元陀螺零位的温度补偿方法及装置 |
Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US5795988A (en) * | 1996-07-01 | 1998-08-18 | Alliedsignal Inc. | Gyroscope noise reduction and drift compensation |
| US20090093984A1 (en) * | 2005-09-21 | 2009-04-09 | Samsung Electronics Co., Ltd. | Method and apparatus for calibrating gyro-sensor |
| CN201266087Y (zh) * | 2008-09-05 | 2009-07-01 | 北京七维航测科技发展有限公司 | 角速率陀螺 |
| CN102230806A (zh) * | 2011-04-26 | 2011-11-02 | 中国科学院软件研究所 | 一种陀螺仪温度漂移补偿方法 |
| CN105910626A (zh) * | 2016-06-15 | 2016-08-31 | 重庆华渝电气集团有限公司 | 挠性陀螺测斜仪寻北全温标定补偿方法 |
| CN206540554U (zh) * | 2016-10-19 | 2017-10-03 | 北京七维航测科技股份有限公司 | 双轴数字陀螺仪 |
-
2016
- 2016-10-19 CN CN201610907723.9A patent/CN106643684A/zh active Pending
Patent Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US5795988A (en) * | 1996-07-01 | 1998-08-18 | Alliedsignal Inc. | Gyroscope noise reduction and drift compensation |
| US20090093984A1 (en) * | 2005-09-21 | 2009-04-09 | Samsung Electronics Co., Ltd. | Method and apparatus for calibrating gyro-sensor |
| CN201266087Y (zh) * | 2008-09-05 | 2009-07-01 | 北京七维航测科技发展有限公司 | 角速率陀螺 |
| CN102230806A (zh) * | 2011-04-26 | 2011-11-02 | 中国科学院软件研究所 | 一种陀螺仪温度漂移补偿方法 |
| CN105910626A (zh) * | 2016-06-15 | 2016-08-31 | 重庆华渝电气集团有限公司 | 挠性陀螺测斜仪寻北全温标定补偿方法 |
| CN206540554U (zh) * | 2016-10-19 | 2017-10-03 | 北京七维航测科技股份有限公司 | 双轴数字陀螺仪 |
Non-Patent Citations (3)
| Title |
|---|
| 朱;潘英俊;刘宇;黎蕾蕾;: "陀螺角度误差的温度测试与补偿" * |
| 李战;冀邦杰;国琳娜;洪剑英;: "光纤陀螺温度误差建模及补偿方法" * |
| 魏泽松;张嘉易;郝永平;王磊;: "温度对IMU微机械陀螺仪零偏影响及标定补偿" * |
Cited By (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111323047A (zh) * | 2018-12-17 | 2020-06-23 | 北京华航无线电测量研究所 | 一种基于加速度计的陀螺零位误差动态补偿方法 |
| CN111323047B (zh) * | 2018-12-17 | 2022-09-09 | 北京华航无线电测量研究所 | 一种基于加速度计的陀螺零位误差动态补偿方法 |
| CN113062721A (zh) * | 2021-03-15 | 2021-07-02 | 重庆工程学院 | 一种勘探用测井仪的全温补偿方法及系统 |
| CN113062721B (zh) * | 2021-03-15 | 2022-11-18 | 重庆工程学院 | 一种勘探用测井仪的全温补偿方法及系统 |
| CN113155114A (zh) * | 2021-04-23 | 2021-07-23 | 三一重型装备有限公司 | Mems惯性测量单元陀螺零位的温度补偿方法及装置 |
| CN113155114B (zh) * | 2021-04-23 | 2023-11-17 | 三一重型装备有限公司 | Mems惯性测量单元陀螺零位的温度补偿方法及装置 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN105698765B (zh) | 双imu单目视觉组合测量非惯性系下目标物位姿方法 | |
| CN111426318B (zh) | 基于四元数-扩展卡尔曼滤波的低成本ahrs航向角补偿方法 | |
| CN105300379B (zh) | 一种基于加速度的卡尔曼滤波姿态估计方法及系统 | |
| CN110108279B (zh) | 一种杆塔倾斜测量系统及倾斜解算方法 | |
| CN101949710B (zh) | Gnss辅助mems惯性传感器零偏的快速在线动态标定方法 | |
| CN100559123C (zh) | 一种mems陀螺仪的差分测量方法 | |
| CN106643684A (zh) | 双轴数字陀螺仪及陀螺仪多层次误差补偿方法 | |
| CN109724602A (zh) | 一种基于硬件fpu的姿态解算系统及其解算方法 | |
| CN105043348A (zh) | 基于卡尔曼滤波的加速度计陀螺仪水平角度测量方法 | |
| CN107664498A (zh) | 一种姿态融合解算方法及系统 | |
| CN103472262B (zh) | 量程可调式mems加速度计的参数标定方法 | |
| CN108318038A (zh) | 一种四元数高斯粒子滤波移动机器人姿态解算方法 | |
| CN109798891A (zh) | 基于高精度动作捕捉系统的惯性测量单元标定系统 | |
| CN109682377A (zh) | 一种基于动态步长梯度下降的姿态估计方法 | |
| CN1664506A (zh) | 一种载体姿态测量方法及其系统 | |
| CN104215229B (zh) | Rtk设备调节方法、系统及rtk测量方法 | |
| CN206540554U (zh) | 双轴数字陀螺仪 | |
| CN105806367A (zh) | 无陀螺惯性系统误差标定方法 | |
| CN111076748A (zh) | 基于mems加速度计的水平倾角仪误差补偿方法及系统 | |
| CN107228956A (zh) | 一种基于mems加速度计的加速度测量方法 | |
| CN114485877B (zh) | 一种结合惯性测量模块进行称重补偿的称重系统和方法 | |
| CN105737793A (zh) | 滚转角测量单元及测量方法 | |
| CN106197376A (zh) | 基于单轴mems惯性传感器的车身倾角测量方法 | |
| CN101021418B (zh) | 角速率及角度陀螺 | |
| CN107270902A (zh) | 一种带有交叉轴耦合误差补偿的mems惯性测量单元 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| AD01 | Patent right deemed abandoned | ||
| AD01 | Patent right deemed abandoned |
Effective date of abandoning: 20240112 |