一种煤田钻探深孔钻探中的钻孔自动纠偏方法技术

本发明专利技术公开了一种煤田钻探深孔钻探中的钻孔自动纠偏方法，涉及煤田钻探技术领域，本发明专利技术将通过四元姿态解算算法对纠偏姿态进行确定，同时通过基于卡尔曼滤波器建立的钻孔姿态估计问题建模避免出现姿态四元数的漂移和误差累积问题，有效抑制传感器数据中的漂移和误差累积，通过偏差计算将实际测得的钻孔姿态与预设方向进行比较，确定实际方向与预设方向之间的偏差，降低了操作人员在危险环境中的风险和受伤可能性，实现自动化的钻孔偏差检测和纠正，减少人工干预，提高钻探作业效率，降低人工操作误差。工操作误差。

【技术实现步骤摘要】
一种煤田钻探深孔钻探中的钻孔自动纠偏方法


[0001]本专利技术涉及煤田钻探
，具体为一种煤田钻探深孔钻探中的钻孔自动纠偏方法。

技术介绍

[0002]煤田钻探是指在煤矿地区进行的一种勘探和开采前的钻探活动。它主要用于获取有关煤矿地下地质情况的信息，包括煤层的分布、厚度、品质、倾角等参数。这些信息对于煤矿开采的规划和设计非常重要。煤田钻探的主要目的是确定煤田的储量和质量，以便进行矿井设计和开采方案的制定。通过钻探取样和测量，可以确定煤层的物理性质、化学成分以及其他地质参数，为后续的煤矿开采工作提供依据。在煤田钻探中，常用的钻探方法包括钻孔钻探和岩心钻探。钻孔钻探是通过旋转钻杆和钻头来打开地下岩石，然后用钻孔来获取地质样品和测量地下地质参数。岩心钻探则是使用特殊的岩心钻头来采集岩石样本，以获取更准确的地质信息。
[0003]但是在现有技术中，钻孔的实际钻取参数要与预设钻取参数相近，例如中国专利公开了一种煤田钻探深孔钻探中的钻孔自动纠偏方法，CN114482861A，包括以下步骤：S1、保证场地平整，使得储备泥浆高出施工水位，防止钻孔过程中由于孔内压力小于孔外压力而导致坍孔；S2、在确认好钻孔位置后，将钻机移动到施工位置处；S3、操作钻机起落钢丝绳中心应对准桩中心；S4、钻机就位后校正，底座平整稳固，确保在钻进中不发生倾斜和位移，保证钻进中钻具的平稳及钻孔质量；S5、在成孔前，安装垂直度监测系统和钻头纠偏系统，自动纠偏后再成孔操作；S6、清孔后，对钻孔进行阶段性的成孔质量检查；S7、对孔内进行注浆，完成钻孔。在成孔前，钻头纠偏系统将钻杆垂直度纠正回正常范围内，在钻孔的过程中自动纠偏，提高钻孔质量。
[0004]虽然上述方案具有如上的优势，但是针对煤田钻探的深孔钻探，在实际的钻探过程中，引起钻孔偏斜的因素是多方面的，主要分为力学弯曲因素和集合偏斜因素，而无论哪种因素导致的钻孔偏斜，传统人工钻探都无法进行及时调整，还可能出现煤田钻探事故，导致人员伤亡、设备损坏，而少有的带有纠偏功能的钻头系统如上述技术方案，采用钻头检测系统和钻头纠偏系统来对钻头钻孔时进行监测，可以在出现偏斜进行及时的纠偏，但是在实际对钻头偏移检测过程，需要由传感器来对钻孔各参数进行监控，由于无法有效降低或减少传感器的误差累计，即使进行了纠正，还会因为传感器的累积误差进行二次纠正，三次纠正，因此亟须一种煤田钻探深孔钻探中的钻孔自动纠偏方法来解决此类问题。

技术实现思路

[0005]本专利技术的目的是为了解决现有技术中存在的无法有效降低或减少传感器的误差累计，即使进行了纠正，还会因为传感器的累积误差进行二次纠正，三次纠正的问题。
[0006]为实现上述目的，本专利技术提供了如下技术方案：
[0007]本专利技术提供了一种煤田钻探深孔钻探中的钻孔自动纠偏方法，其特征在于，包括
以下步骤：
[0008](1)纠偏数据采集
[0009]在钻杆中部安装倾角传感器，在钻杆下部安装方位角传感器，在钻杆上部安装旋转速度传感器，在钻机臂上同样安装倾角传感器和方位角传感器，多个传感器持续对钻杆钻探时的倾角、方位角、旋转速度进行监测，并进行记录；
[0010](2)纠偏数据处理
[0011]对钻探时的倾角、方位角、旋转速度数据进行预处理；
[0012](3)纠偏姿态计算
[0013]采用四元姿态解算算法对纠偏姿态进行确定，具体的：初始化姿态解算、传感器数据更新，其中传感器更新具体步骤为：
[0014]3.1从传感器数据中获取角速度数据；
[0015]3.2由当前时刻的获取的旋转速度数据采用四阶龙格库塔法来估计姿态变化四元数，具体的：
[0016]3.2.1将旋转速度传感器更新频率定义为
△
t，即离散化的时间步长；
[0017]3.2.2由当前时刻的角速度数据，计算姿态变化四元数的增量
△
q1；
[0018]3.2.3将当前时刻的角速度数据乘以
△
t的一半，得到中间时刻的角速度：
[0019]3.2.4由中间时刻的角速度，计算中间时刻的姿态变化四元数的增量
△
q2；
[0020]3.2.5再次将中间时刻的角速度乘以
△
t的一半，得到另一个中间时刻的角速度：
[0021]3.2.6由另一个中间时刻的角速度，计算另一个中间时刻的姿态变化四元数的增量
△
q3；
[0022]3.2.7将三个姿态变化四元数增量并进行加权平均，得到最终的姿态变化四元数增量：
△
q＝(
△
q1+2
×△
q2+2
×△
q3+
△
q4)/6，其中
△
q4为使用当前时刻的角速度计算的姿态变化四元数的增量；
[0023]3.2.8将姿态变化四元数增量与上一时刻的姿态四元数相乘，得到当前时刻的姿态四元数：q(t)＝q(t
‑
1)
×△
q；
[0024]3.3将步骤2.8中得到的姿态变化四元数与上一时刻的四元数相乘，得到当前时刻的姿态四元数；
[0025]3.4在步骤(3)，对姿态四元数进行归一化，使其范数等于1；
[0026](4)姿态结果输出转换
[0027]根据姿态四元数，计算出钻孔的倾角和方位角，具体的
[0028]4.1通过姿态四元数转换为欧拉角，对倾斜角度进行表示；
[0029]4.2通过姿态四元数转换为旋转矩阵，姿态四元数q的方向向量表示为：D＝[2(q1q3‑
q2q0),2(q2q3‑
q1q0),q
02
‑
q
12
‑
q
22
+q
32
]，根据方向向量D计算方位角，采用反正切函数计算方向向量的x分量与y分量的比值，即atan2(D[1],D[0])；
[0030](5)钻孔姿态估计问题建模
[0031]基于卡尔曼滤波器建立钻孔姿态估计问题建模，具体的：
[0032]5.1将钻孔姿态估计问题建立为一个状态空间模型，建立状态方程和观测方程；
[0033]5.2初始化卡尔曼滤波器的状态向量和协方差矩阵；
[0034]5.3根据钻孔当前姿态估计问题建模中的状态方程，使用过程模型对当前状态进行预测，并计算预测状态的协方差矩阵，预测步骤利用先验信息预测下一时刻的状态；
[0035]5.4根据系统建模中的观测方程，将各传感器测量值与预测状态进行比较，计算预测状态的测量残差，并计算卡尔曼增益；
[0036]5.5利用卡尔曼增益修正预测状态和协方差矩阵，得到更新后的状态估计和协方差；
[0037](6)实际纠偏值计算
[0038]将实际测得的钻孔姿态通过向量运算与预设方向进行比较，确定偏差；
[0039](本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种煤田钻探深孔钻探中的钻孔自动纠偏方法，其特征在于，包括以下步骤：(1)纠偏数据采集在钻杆中部安装倾角传感器，在钻杆下部安装方位角传感器，在钻杆上部安装旋转速度传感器，在钻机臂上同样安装倾角传感器和方位角传感器，多个传感器持续对钻杆钻探时的倾角、方位角、旋转速度进行监测，并进行记录；(2)纠偏数据处理对钻探时的倾角、方位角、旋转速度数据进行预处理；(3)纠偏姿态计算采用四元姿态解算算法对纠偏姿态进行确定，具体的：初始化姿态解算、传感器数据更新，其中传感器更新具体步骤为：3.1从传感器数据中获取角速度数据；3.2由当前时刻的获取的旋转速度数据采用四阶龙格库塔法来估计姿态变化四元数，具体的：3.2.1将旋转速度传感器更新频率定义为
△
t，即离散化的时间步长；3.2.2由当前时刻的角速度数据，计算姿态变化四元数的增量
△
q1；3.2.3将当前时刻的角速度数据乘以
△
t的一半，得到中间时刻的角速度：3.2.4由中间时刻的角速度，计算中间时刻的姿态变化四元数的增量
△
q2；3.2.5再次将中间时刻的角速度乘以
△
t的一半，得到另一个中间时刻的角速度：3.2.6由另一个中间时刻的角速度，计算另一个中间时刻的姿态变化四元数的增量
△
q3；3.2.7将三个姿态变化四元数增量并进行加权平均，得到最终的姿态变化四元数增量：
△
q＝(
△
q1+2
×△
q2+2
×△
q3+
△
q4)/6，其中
△
q4为使用当前时刻的角速度计算的姿态变化四元数的增量；3.2.8将姿态变化四元数增量与上一时刻的姿态四元数相乘，得到当前时刻的姿态四元数：q(t)＝q(t
‑
1)
×△
q；3.3将步骤2.8中得到的姿态变化四元数与上一时刻的四元数相乘，得到当前时刻的姿态四元数；3.4在步骤(3)，对姿态四元数进行归一化，使其范数等于1；(4)姿态结果输出转换根据姿态四元数，计算出钻孔的倾角和方位角，具体的：4.1通过姿态四元数转换为欧拉角，对倾斜角度进行表示；4.2通过姿态四元数转换为旋转矩阵，姿...

【专利技术属性】
技术研发人员：胡莹，王彥霞，牛婕，刘彦磊，闫松松，刘明，詹玫玫，
申请(专利权)人：中国煤炭地质总局一一九勘探队，
类型：发明
国别省市：