[发明专利]一种适用于光纤陀螺开孔定位仪的组合测量方法有效
申请号: | 201810261863.2 | 申请日: | 2018-03-28 |
公开(公告)号: | CN108332743B | 公开(公告)日: | 2021-02-26 |
发明(设计)人: | 林铁;李慧鹏;潘雄;易军 | 申请(专利权)人: | 株洲菲斯罗克光电技术有限公司 |
主分类号: | G01C21/16 | 分类号: | G01C21/16;G01C19/72 |
代理公司: | 长沙朕扬知识产权代理事务所(普通合伙) 43213 | 代理人: | 马家骏 |
地址: | 412000 湖南省株洲市天元区仙*** | 国省代码: | 湖南;43 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 适用于 光纤 陀螺 定位 组合 测量方法 | ||
1.一种适用于光纤陀螺开孔定位仪的组合测量方法,其特征在于,通过利用井下钻机测量点地理位置信息和钻机作业特有的速度约束信息与光纤陀螺开孔定位仪实时采集的惯性信息进行信息融合处理,以定位开孔位置,其中,所述惯性信息包括光纤陀螺开孔定位仪的捷联惯性输出的钻机位置信息、速度信息;通过利用井下钻机测量点地理位置信息和钻机作业特有的速度约束信息与光纤陀螺开孔定位仪实时采集的惯性信息进行信息融合处理,具体为:
S1:根据井下钻机作业特点,在煤层钻孔时保持位置和线速度不变,只有钻杆发生姿态变化这一特征,以测量点地理位置和速度约束两个特征信息作为外部信息源,与井下钻机光纤陀螺开孔定位仪捷联惯性测量单元的输出进行比较,得到速度差值和位移差值;
其中,速度差值的计算公式为:
其中,
Vx代表井下钻机光纤陀螺开孔定位仪捷联惯性导航算法解算的东向速度;
Vy代表井下钻机光纤陀螺开孔定位仪捷联惯性导航算法解算的北向速度;
Vz代表井下钻机光纤陀螺开孔定位仪捷联惯性导航算法解算的天向速度;
位置差值的计算公式为:
其中,Lat代表井下钻机光纤陀螺开孔定位仪捷联惯性导航算法解算的纬度;
Lon代表井下钻机光纤陀螺开孔定位仪捷联惯性导航算法解算的经度;
H代表井下钻机光纤陀螺开孔定位仪捷联惯性导航算法解算的高度;
Lat0代表井下钻机光纤陀螺开孔定位仪测量点的纬度;
Lon0代表井下钻机光纤陀螺开孔定位仪测量点的经度;
H0代表井下钻机光纤陀螺开孔定位仪测量点的高度;
S2:建立卡尔曼滤波器模型,将步骤S1中的差值信号作为卡尔曼滤波器的观测量进行数据融合获得补偿信号;
其中,所述卡尔曼滤波器模型如下:
Z(t)=H(t)X(t)+V(t) (2)
式(1)为连续系统的状态方程;式(2)为连续系统的量测方程;
对卡尔曼滤波器进行离散可得:
Xk=Φk,k-1Xk-1+Γk-1Wk-1 (3)
Zk=HkXk+Vk (4)
式(3)为系统离散化的状态方程;式(4)为系统离散化的量测方程;
其中:
Xk为tk时刻状态变量,Xk-1为tk-1时刻状态变量;
Φk,k-1为tk-1时刻至tk一步转移阵;
Γk-1为系统噪声驱动阵;
Wk-1为系统激励噪声序列;
Zk为tk时刻观测变量;
Hk为量测阵;
Vk为量测噪声序列;
所述卡尔曼滤波的状态变量选为:
式中:
表示当地地理坐标系OtXtYtZt下的位置误差X轴分量,
表示当地地理坐标系OtXtYtZt下的位置误差Y轴分量,
表示当地地理坐标系OtXtYtZt下的位置误差Z轴分量,
表示当地地理坐标系OtXtYtZt下的速度误差X轴分量,
表示当地地理坐标系OtXtYtZt下的速度误差Y轴分量,
表示当地地理坐标系OtXtYtZt下的速度误差Z轴分量,
ηx表示方位角ψ误差,
ηy表示倾斜角θ误差,
ηz表示滚转角φ误差,
一步转移矩阵为:
卡尔曼滤波器接收信息比较单元的输出ZKA、ZKB作为观测量;
其中,
量测阵为:
S3:将步骤S2中的补偿信号对测量的钻机位置信息和速度信息误差信息进行估计和在线修正,对测量的误差进行实时补偿,实现井下钻机光纤陀螺开孔定位仪的高精度测量,其中,修正后的钻机位置信息为:
其中,ψ0为输出补偿后井下钻机光纤陀螺开孔定位仪的方位角,θ0为输出补偿后井下钻机光纤陀螺开孔定位仪的倾斜角,φ0为输出补偿后井下钻机光纤陀螺开孔定位仪的滚转角。
2.根据权利要求1所述的适用于光纤陀螺开孔定位仪的组合测量方法,其特征在于,所述步骤S1中,采用光纤陀螺输出井下钻机光纤陀螺开孔定位仪机体坐标系ObXbYbZb下的角速度信息,采用加速度计输出的井下钻机光纤陀螺开孔定位仪机体坐标系ObXbYbZb下的比力信息,对所述角速度信息和所述比力信息采用捷联惯性导航算法解算后,输出井下钻机光纤陀螺开孔定位仪捷联惯性导航算法解算的东向速度Vx,井下钻机光纤陀螺开孔定位仪捷联惯性导航算法解算的北向速度Vy以及井下钻机光纤陀螺开孔定位仪捷联惯性导航算法解算的天向速度Vz。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于株洲菲斯罗克光电技术有限公司,未经株洲菲斯罗克光电技术有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201810261863.2/1.html,转载请声明来源钻瓜专利网。