光纤陀螺测斜仪的温度补偿方法技术

本发明专利技术涉及一种光纤陀螺测斜仪的温度补偿方法，本发明专利技术的光纤陀螺测斜仪的温度补偿方法通过地球自转在水平平面的投影大小和光纤陀螺在水平面内的读数大小求出当前的光纤陀螺比例因子，进而对加速度传感器和光纤陀螺仪的读数进行修正，从而去除了随温度变化的光纤陀螺仪的比例因子对测量结果造成的影响，提高了光纤陀螺测斜仪的测量精度。

【技术实现步骤摘要】
光纤陀螺测斜仪的温度补偿方法
本专利技术涉及一种温度补偿方法，尤其涉及一种光纤陀螺测斜仪的温度补偿方法。
技术介绍
光纤陀螺仪是一种没有机械转子的新型全固态光纤传感器，它用来测量物体的旋转角速度。由于其精度高，抗冲击振动能力强，易于设计和制造等特点，现在越来越广泛在寻北仪，经纬仪，测斜仪等寻北定向领域使用。光纤陀螺测斜仪是利用光纤陀螺仪、加速度传感器等部件作为传感元件，通过测量地球自转角速度矢量来确定钻孔倾斜方向的一种仪器设备。光纤陀螺仪对温度比较敏感，当温度发生变化的时候，光纤陀螺的比例因子会发生漂移，这样通过光纤陀螺的读数用传统的计算方法进行解算将会引入比较大的误差，导致全温测量精度变差。光纤陀螺测斜仪通常采用4方位寻北，光纤陀螺和加速度传感器通过绕本体轴旋转四个方位(间隔90°)，可以得到相对测斜仪本体的读数，包括：gx，gy，gz；ωx，ωy，ωz。通常gz和ωz不能通过传感器得到。光纤陀螺测斜仪需要解算方位角ψ，顶角θ和工具面角φ。采用NED坐标系(即x轴指北方，y轴指东方，z轴指地)，光纤陀螺测斜仪初始状态下本体主轴和z方向重合。测斜仪的任意姿态可以通过下面三个步骤旋转来得到：1.绕本体z轴旋转方位角ψ2.绕本体y轴旋转顶角θ3.绕本体z轴旋转工具面角φ由几何关系可以得到：其中为NED坐标下重力加速度矢量，为NED坐标系下地球自转矢量。为本体坐标系中加速度矢量，即加速度传感器读数，为本体坐标系中地球自转矢量，即光纤陀螺仪读数。α为当地纬度。(1)(2)中有：把(3)(4)(5)(6)(7)(8)(9)代入(1)(2)得：从(10)，(11)可以解出：可以得到到此可以求出θ，φ，ψ三个角度。但是由于光纤陀螺仪的比例因子会随温度变化，因此在不同温度下ωx和ωy读数会有误差，导致方位角ψ测量误差变大。
技术实现思路
为解决上述技术问题，本专利技术的目的是提供一种能够去除随温度变化的光纤陀螺仪的比例因子对测量结果造成的误差，从而提高光纤陀螺测斜仪的测量精度的光纤陀螺测斜仪的温度补偿方法。本专利技术的光纤陀螺测斜仪的温度补偿方法，所述光纤陀螺测斜仪包括本体，所述本体内设有光纤陀螺仪和加速度传感器，所述光纤陀螺仪的温度补偿方法包括以下步骤：A：使本体绕本体的主轴转动一周，并且每隔90度记录下光纤陀螺仪和加速度传感器的读数，从而得到以下数据：gx+，ωx+，gy+，ωy+，gx-，ωx-，gy-，ωy-，其中，gx+为加速度传感器的第一次读数，ωx+为光纤陀螺仪的第一次读数，gy+为加速度传感器的第二次读数，ωy+为光纤陀螺仪的第二次读数，gx-为加速度传感器的第三次读数，ωx-为光纤陀螺仪的第三次读数，gy-为加速度传感器的第四次读数，ωy-为光纤陀螺仪的第四次读数；B：由公式gx＝(gx+-gx-)/2；gy＝(gy+-gy-)/2；ωx＝(ωx+-ωx-)/2；ωy＝(ωy+-ωy-)/2；分别得到gx，gy，ωx，ωy，其中，其中，gx、gy分别为初始坐标系下x轴和y轴方向的加速度值，ωx，ωy为初始坐标系下x轴和y轴方向光纤陀螺仪的值，所述初始坐标系为光纤陀螺仪在未旋转时的坐标系，初始坐标系包括x轴、y轴和z轴，所述z轴为光纤陀螺仪的主轴，所述x轴和y轴分别与z轴垂直且x轴与y轴互相垂直；C：根据以下公式：分别求得顶角θ和工具面角φ的值，其中g为重力加速度；D：将步骤B中的ωx和ωy，以及步骤C中的θ和φ分别代入以下公式得到光纤陀螺仪的比例因子s为：其中，α为当地纬度，得到的s有两个值，将其中一个与光纤陀螺仪的比例因子的历史数据相差较大的s舍去；E：将通过步骤D得到的s以及步骤B中的ωx和ωy分别代入到以下的公式，得到修正后的光纤陀螺仪的读数为：ωxcorrected＝sωx，ωycorrected＝sωy，其中ωxcorrected为修正后的光纤陀螺仪在初始坐标系的x轴方向的值读数，ωycorrected为修正后的光纤陀螺仪在初始坐标系的y轴方向的值；F：将步骤E中的ωxcorrected代入到以下公式中的ωx，将步骤E中的ωycorrected代入到以下公式中的ωy，并将步骤B中的gx、gy分别代入到以下公式，得到修正后的方位角ψ为：其中，g为地球的重力加速度，ωe为地球自转角速度。借由上述方案，本专利技术至少具有以下优点：本专利技术的光纤陀螺测斜仪的温度补偿方法通过以下公式：可实时得到当前温度下光纤陀螺仪的比例因子的值，并对加速度传感器的值和光纤陀螺仪的值进行修正，以得到当前温度下加速度传感器和光纤陀螺仪的真实数据，从而消除了随温度变化的光纤陀螺仪的比例因子对光纤陀螺测斜仪的测量结果的影响，提高了光纤陀螺测斜仪的测量精度。上述说明仅是本专利技术技术方案的概述，为了能够更清楚了解本专利技术的技术手段，并可依照说明书的内容予以实施，以下以本专利技术的较佳实施例并配合附图详细说明如后。附图说明图1是光纤陀螺测斜仪的结构示意图；图2是光纤陀螺测斜仪旋转角度和顺序的定义图中，1：本体；2：光纤陀螺仪；3：加速度传感器。具体实施方式下面结合附图和实施例，对本专利技术的具体实施方式作进一步详细描述。以下实施例用于说明本专利技术，但不用来限制本专利技术的范围。参见图1至图2，光纤陀螺测斜仪包括本体1，本体内设有光纤陀螺仪2和加速度传感器3，本专利技术一较佳实施例的光纤陀螺测斜仪的温度补偿方法，包括以下步骤：S1：沿着光纤陀螺测斜仪的主轴旋转光纤陀螺仪及加速度传感器，每次旋转90°，得到四个方位的传感器读数，分别为gx+，gx-，gy+，gy-；ωx+，ωx-，ωx+，ωx-。在测斜仪本体坐标系内的加速度和地球自转的大小为：gx＝(gx+-gx-)/2；gy＝(gy+-gy-)/2；ωx＝(ωx+-ωx-)/2；ωy＝(ωy+-ωy-)/2；S2.根据(12)和(13)式可以计算得到顶角θ和工具面角φ。S3.假设在一次寻北测量中光纤陀螺的比例因子保持不变为s，那么(11)式可以写成这里ωx，ωy，ωz仍然为光纤陀螺仪的读数，但是真实的角速度要乘以比例因子修正值s，对于旋转矩阵R，我们有R-1(θ)＝R(-θ)，R-1(φ)＝R(-φ)(17)由(16)式可以得到：(18)式的物理意义为：式左边的意思是陀螺在最后姿态有一个读数，我们想知道只做了第一步方位角旋转后ψ后的陀螺读数，于是我们按照原来的旋转顺序(ψ→θ→φ)的反向还原两步(-φ→-θ)，这样(18)式左边表示测斜仪回到了竖直状态测量，而右边表示在竖直状态下，转过了ψ角度后地球自转在测斜仪机体坐标系的矢量。这里ψ未知，但是在竖直状态，不论ψ是多少，水平面内的地球自转的投影是不变的。将(17)和(7)(8)(9)代入(18)有：S4.从(19)式中z轴分量相等可以算出：分别计算左右两边在x-y平面内(即水平平面内)的投影，并令他们相等有：可以限定s＞0(因为比例因子的偏差不太可能出现符号相反)，把(19)带入(20)，并且令ωe＝1，可以得到：(s(ωxcosφ-ωysinφ)-sinαsinθ)2+s2(ωxsinφ+ωycosφ)2cos2θ＝cos2αcos2θ有可以得到：又ωx，ωy，ωe，α，θ，φ都为已知量，可以求出s。s有两个值，需要根据s的符号和历史数据的变化率来舍弃一个根本文档来自技高网...

【技术保护点】
一种光纤陀螺测斜仪的温度补偿方法，所述光纤陀螺测斜仪包括本体，所述本体内设有光纤陀螺仪和加速度传感器，其特征在于：所述光纤陀螺仪的温度补偿方法包括以下步骤：A：使本体绕本体的主轴转动一周，并且每隔90度记录下光纤陀螺仪和加速度传感器的读数，从而得到以下数据：gx+，ωx+，gy+，ωy+，gx‑，ωx‑，gy‑，ωy‑，其中，gx+为加速度传感器的第一次读数，ωx+为光纤陀螺仪的第一次读数，gy+为加速度传感器的第二次读数，ωy+为光纤陀螺仪的第二次读数，gx‑为加速度传感器的第三次读数，ωx‑为光纤陀螺仪的第三次读数，gy‑为加速度传感器的第四次读数，ωy‑为光纤陀螺仪的第四次读数；B：由公式gx＝(gx+‑gx‑)/2；gy＝(gy+‑gy‑)/2；ωx＝(ωx+‑ωx‑)/2；ωy＝(ωy+‑ωy‑)/2；分别得到gx，gy，ωx，ωy，其中，gx、gy分别为初始坐标系下x轴和y轴方向的加速度值，ωx，ωy为初始坐标系下x轴和y轴方向光纤陀螺仪的值。所述初始坐标系为光纤陀螺仪在未旋转时的坐标系，初始坐标系包括x轴、y轴和z轴，所述z轴为光纤陀螺仪的主轴，所述x轴和y轴分别与z轴垂直且x轴与y轴互相垂直。C：根据以下公式：θ=arcsingx2+gy2g,]]>φ=-arctan(gygx)gx≤0π-arctan(gygx)gx>0,]]>分别求得顶角θ和工具面角φ的值，其中g为重力加速度；D：将步骤B中的ωx和ωy，以及步骤C中的θ和φ分别代入以下公式得到光纤陀螺仪的比例因子s为：s=(ωxcosφ-ωysinφ)sinαsinθ±cosθωx2cos2α+ωy2cos2α-sin2θ(ωxsinφ+ωycosφ)2ωx2+ωy2-sin2θ(ωxsinφ+ωycosφ)2]]>其中，α为当地纬度，得到的s有两个值，将其中一个与光纤陀螺仪的比例因子的历史数据相差较大的s舍去；E：将通过步骤C得到的s以及步骤B中的ωx和ωy分别代入到以下的公式，得到修正后的光纤陀螺仪的读数为：ωxcorrected＝sωx，ωycorrected＝sωy，其中ωxcorrected为修正后的光纤陀螺仪在初始坐标系的x轴方向的值，ωycorrected为修正后的光纤陀螺仪在初始坐标系的y轴方向的值；F：将步骤E中的ωxcorrected代入到以下公式中的ωx，将步骤E中的ωycorrected代入到以下公式中的ωy，并将步骤B中的gx、gy分别代入到以下公式，得到修正后的方位角ψ为：ψ=arctan(2(-(ωxgy-ωygx)g2-gx2-gy2-g(ωxgx+ωygy)-ωesinα(gx2+gy2))),]]>其中，g为地球的重力加速度。...

【技术特征摘要】
1.一种光纤陀螺测斜仪的温度补偿方法，所述光纤陀螺测斜仪包括本体，所述本体内设有光纤陀螺仪和加速度传感器，其特征在于：所述光纤陀螺仪的温度补偿方法包括以下步骤：A：使本体绕本体的主轴转动一周，并且每隔90度记录下光纤陀螺仪和加速度传感器的读数，从而得到以下数据：gx+，ωx+，gy+，ωy+，gx-，ωx-，gy-，ωy-，其中，gx+为加速度传感器的第一次读数，ωx+为光纤陀螺仪的第一次读数，gy+为加速度传感器的第二次读数，ωy+为光纤陀螺仪的第二次读数，gx-为加速度传感器的第三次读数，ωx-为光纤陀螺仪的第三次读数，gy-为加速度传感器的第四次读数，ωy-为光纤陀螺仪的第四次读数；B：由公式gx＝(gx+-gx-)/2；gy＝(gy+-gy-)/2；ωx＝(ωx+-ωx-)/2；ωy＝(ωy+-ωy-)/2；分别得到gx，gy，ωx，ωy，其中，gx、gy分别为初始坐标系下x轴和y轴方向的加速度值，ωx，ωy为初始坐标系下x轴和y轴方向光纤陀螺仪的值，所述初始坐标系为光纤陀螺仪在未旋转时的坐标系，...

【专利技术属性】
技术研发人员：万放，伍刚，伍佑明，
申请(专利权)人：无锡慧联信息科技有限公司，
类型：发明
国别省市：江苏;32