定向钻进连续取心钻具姿态监测系统设计.pdf

1、定向钻进连续取心钻具姿态监测系统设计林婷婷1，刘泽楷1，马银龙2，朱金宝1(1.吉林大学 仪器科学与电气工程学院，吉林 长春 130012；2.吉林大学 建设工程学院，吉林 长春 130012)摘要:定向钻进连续取心作为一项新兴的地质勘探技术，在矿产资源勘探方面有广阔前景，为研发具有自主知识产权的定向连续取心钻具，设计了基于姿态传感和无线通信技术的姿态监测系统。硬件系统设计方面，选用 MPU9250 姿态传感器和 STM32F103C8T6 主控芯片监测钻具姿态的变化，通过 LoRa 无线模块实现穿透地层的通信，同时为适应钻具的结构和随钻测量的要求，自主设计了小型化的系统电路，其长宽高尺寸分别

2、为 70 mm25 mm7 mm。软件设计方面，通过互补滤波和卡尔曼滤波对 MPU9250 获取的数据进行处理，建立了钻具姿态解算误差补偿模型，设计上位机实现钻具姿态的实时展示。最后，通过强电磁干扰环境的模拟测试对硬件和软件的可靠性与准确性进行了验证。结果表明，设计的系统有效地抑制了惯性传感组件的漂移、累积误差以及噪声，能够持续、稳定地对钻具姿态进行实时监测，为实现定向钻进连续取心钻具的姿态监测提供了一种新思路。关键词：定向钻进；连续取心；惯性传感器；互补滤波；卡尔曼滤波中图分类号：P634.7 文献标志码：A 文章编号：1001-1986(2023)09-0138-09Designofatt

3、itudemonitoringsystemfordirectionaldrillingcontinuouscoringtoolsLIN Tingting1,LIU Zekai1,MA Yinlong2,ZHU Jinbao1(1.College of Instrumentation and Electrical Engineering,Jilin University,Changchun 130012,China;2.College of Construction Engineering,Jilin University,Changchun 130012,China)Abstract:Dire

4、ctional drilling continuous coring,as an emerging geological exploration technique,holds vast potentialin the field of mineral resource exploration.To facilitate the development of directional continuous coring tools with pro-prietary intellectual property rights,an attitude monitoring system based

5、on attitude sensing and wireless communicationtechnology was designed in this paper.Concerning the hardware system design,the MPU9250 attitude sensor andSTM32F103C8T6 main control chip were adopted to monitor the attitude change of drilling tools,where the communic-ation through geological layers wa

6、s achieved using a LoRa wireless module.Additionally,to accommodate the structur-al of the drilling tool and the requirements of measurement while drilling,a downsized system circuit was autonomouslydesigned,which is sized 70 mm 25 mm 7 mm(L W H).In terms of software design,data collected by MPU9250

7、was processed by complementary filtering and Kalman filtering.Besides,an error compensation model for solution ofdrilling tool attitude was established,and an upper computer was designed to exhibit the real-time attitude of a drillingtool.Ultimately,the reliability and accuracy of both hardware and

8、software were verified through simulation tests underthe environment with strong electromagnetic interference.The outcomes reveal that the designed system effectively mit-igates the drift,cumulative errors,and noise in the inertial sensing components,capable of achieving the continuous andstable rea

9、l-time attitude monitoring of drilling tool,thereby offering a novel approach towards achieving the attitudemonitoring in directional drilling continuous coring tools.Keywords:directional drilling;continuous coring;inertial sensor;complementary filtering;Kalman filtering 收稿日期:2023-06-12；修回日期:2023-08

10、-23基金项目:科技部重点研发项目(2021YFC2900200)；国家自然科学基金区域联合基金重点项目(U21A2020)第一作者:林婷婷，1983 年生，女，吉林长春人，博士，教授，从事地球物理探测方法及装备研究.E-mail：通信作者:朱金宝，1992 年生，男，吉林延边人，博士，鼎新学者博士后，从事磁共振测井技术及仪器研究.E-mail： 第 51 卷 第 9 期煤田地质与勘探Vol.51 No.92023 年 9 月COAL GEOLOGY&EXPLORATIONSep.2023林婷婷，刘泽楷，马银龙，等.定向钻进连续取心钻具姿态监测系统设计J.煤田地质与勘探，2023，51(9)：

11、138146.doi:10.12363/issn.1001-1986.23.06.0314LIN Tingting，LIU Zekai，MA Yinlong，et al.Design of attitude monitoring system for directional drilling continuous coringtoolsJ.Coal Geology&Exploration，2023，51(9)：138146.doi:10.12363/issn.1001-1986.23.06.0314经济社会发展与矿产资源密不可分，矿产资源在气候变化、资源危机、全球治理、可持续发展等一系列重大挑

12、战都有着非常重要的地位，而战略性关键矿产资源供给安全一直是世界各国必须面对的一大难题1。当前我国约 2/3 的战略性矿产资源需要进口，其中约有 1/2 的战略性矿产对外依存度超出了 50%。而我国在矿产资源勘探还面临着增储方法有限、新增资源储量无法满足国家战略需求的问题2。根据中国矿产资源报告 2022，2021 年我国地质勘查投资 972.87 亿元，较上年增长 11.6%3，为矿产资源勘探提供了有力的支持。但是在钻探技术层面，如何快速定向连续获得岩(矿)心样品，为矿产资源储量评价提供准确参数，是目前阶段国内矿产勘探“卡脖子”技术难题。针对以上矿产资源勘探技术问题，国内外学者和研究机构开展了

13、广泛的研究工作。其中，定向钻进连续取心作为一项新兴技术4，广泛应用于矿产资源勘探、隧道超前探测、非常规能源勘探等领域5。该技术要求在钻进过程中对钻具进行精确定位和控制，针对此问题，本文对定向取心钻具的随钻姿态监测问题展开了研究。在测斜仪器方面，陀螺测斜仪和磁性 MWD(Measurement While Drilling)是广泛使用的姿态监测工具。陀螺测斜仪按信号传输方式可分为有线陀螺测斜仪和无线随钻陀螺测斜仪(GWD)，有线陀螺测斜仪已在全世界范围内广泛应用，国内对 GWD 的研究目前正在测试阶段，而国外主要由美国陀螺数据公司主导。美国的 GWD 已广泛应用于钻井测量，相关产品有 20 GW

14、D、40 GWD 和 70 GWD 三种型号，分别适用于最大作业井斜角度为 20、40和 70的情况6；在进行大斜度套管开窗、导斜器定向、海洋平台丛式井或加密井防碰绕障和救援井施工时，由于磁干扰的存在，无法使用磁性 MWD，必须采用不受磁干扰的陀螺测斜仪来有效解决测斜问题。同时，在向东或向西的大斜度井眼中钻进时，应用磁性 MWD 和某些类型的陀螺测斜仪可能会导致较大的方位测量误差。王立兵等7指出惯性传感元件存在的零点漂移问题会对测量造成影响，Chen Weicao 等8进一步分析了零点漂移的影响因素，将两大主要影响因素总结为读数偏移和角度偏移；胡茂晓、蒋硕硕9-10提出，构建姿态监测系统的关键

15、问题有两个：姿态传感器数据的采集与融合；数据的实时回传与分析。为解决这 2 个关键问题，相关研究深入到姿态矩阵11、四元数解算12-13和滤波算法等领域。其中，对于姿态监测系统常用的滤波算法有互补滤波和卡尔曼滤波14-15。黄镇等16基于互补滤波和卡尔曼滤波设计了一种姿态解算方法，实现了误差 2以内的欧拉角测量；M.M.R.Masrafee 等17将卡尔曼滤波应用于姿态监测系统，对卡尔曼滤波算法进行了理论分析；J.Sola、Ruiter 等18-19深入解析了卡尔曼滤波的更新过程。D.M.Henderson 等20将卡尔曼滤波与四元数解算方法结合，用于分析航天飞机的欧拉角和变换矩阵；P.Owc

16、zarek21基于卡尔曼滤波和互补滤波，实现了视觉系统中圆形标志物的中心点追踪捕捉。综上，笔者通过整体框架构建、电路设计、控制与通信编程和数据处理等方面开展了定向钻进连续取心姿态监测系统的设计，并结合模拟实验进行了验证分析，以期研发出具有自主知识产权、质量稳定可靠的定向钻进连续取心姿态监测系统，为定向钻进连续取心提供可靠的技术支撑。1随钻姿态监测技术随钻姿态监测技术通过在钻井过程中依据传感器数据和算法来实时监测钻具的姿态，提供有关钻具的倾斜角度、方位角度和轴向旋转角度等信息，协助钻井操作控制和避免潜在的问题，涉及的关键组件与技术主要包括：MEMS(Micro-Electro-Mechanica

17、l System)传感器、惯性导航系统(Inertial Navigation System,INS)、钻杆振动监测技术、数据融合和算法处理技术等，通过软硬件协同，提升姿态监测系统的准确性和稳定性。为了攻克定向连续取心的技术难题，实现钻具姿态实时监测，推进取心钻具智能化，本文结合了钻探技术、传感器技术与嵌入式系统，寻求钻具姿态监测的最优解。在实际应用中，采用单片机作为核心控制组件，单片机接收传感器回传的数据并进行计算、控制输出以及与其他设备进行通信，实现实时高精度数据处理，从而提高系统的稳定性和精度。对硬件和软件进行联合设计，最终实现姿态监测系统的完整功能，角度测量误差 0.5以内。2系统总体

18、设计本文设计的姿态监测系统以 STM32F103C8T6 单片机为主控，通过姿态传感器 MPU9250 对运动姿态进行监测，提供俯仰角、横滚角和航向角等姿态信息，进一步求取钻具的方位角、顶角和工具面向角。经过校正、消噪、滤波处理后的姿态角度信息通过 LoRa模块发送至地面上位机，上位机软件完成角度数据显示、运动曲线绘制和 3D 姿态展示。设计的系统如图 1 所示。第 9 期林婷婷等：定向钻进连续取心钻具姿态监测系统设计 139 传感器STM32主控制器无线通信模块LoRa上位机LabVIEW锂电池稳压模块LDO图 1 钻具姿态监测系统Fig.1 Block diagram of attitud

19、e monitoring system for drilling tool 3系统硬件设计3.1主控芯片为满足姿态监测系统的要求，选择基于 ARMCortex-M 内核的 STM32F103C8T6 芯片作为主控制器。该芯片具备处理速度快和功耗低等优势，能够满足多参数测量、高实时性和多种扩展功能等要求，能够满足钻具姿态监测系统在定向钻进连续取心钻具上的应用。主控模块如图 2 所示。VCC3.31U1VBATVDD_3VCC3.3GNDR110 KSWCLKVCC3.3GNDSWDIOTXDRXDVDD_2VSS_3VSS_2PB9PB8PB7PB6PB5PB4PB3PA15PA14PA13PB

20、13PB12PB14PB15PA12PA11PA10PA9PA8BOOT0PC13-TAMPER-RTCPC14-OSC32_INPC15-OSC32_OUTPD0-OSC_INPD1-OSC_OUTNRSTVSSAVDDAPA0-WKUPPA1PA2PA3PA4PA5PA5PA7PB0PB1PB2PB10PB11VSS_1VDD_123456789101112131415161718192021222324262728293031323334353637383940414243444546474825VCC3.3VCC3.3PC14PC15OSCINOSCOUTNRSTGNDSCLR310

21、KSDAGNDTXLORARXLORASTM32F103C8T6GNDGND图 2 STM32F103C8T6 芯片连接Fig.2 Schematic diagram of STM32F103C8T6 chip 3.2姿态传感器模块为了实现地下钻具姿态实时监测，需要综合测量精度、模块尺寸和功耗等因素对传感器进行选型。MPU9250 是首个将 9 轴运动姿态监测整合为一体的数字传感器，在解决传感器组合中轴间差异问题的同时，实现了传感器体积的缩小和系统功耗的降低。其内部集成了三轴陀螺仪、三轴加速度计和三轴磁力计，并具备 3 个 16 位加速度 AD 输出，3 个 16 位加速度AD 输出和 14

22、位磁力计 AD 输出，可编程陀螺仪参数可选250、500、1 000、2 000()/s，可编程的加速度参数可选2、4、8、16 g，磁力计最大量程可达到4 800 T。在本文应用中，陀螺仪满量程范围设置为2 000()/s，陀螺仪的 ADC 位数为 16 位，由此计算得到灵敏度为：65 536/4 000=16.4 LSB/()s1)。加速度计满量程范围设置为2 g，灵敏度为：65 536/4=16 384 LSB/g。MPU9250 与单片机的数据交互通过IIC 接口实现，最高传输速率可达 400 kHz/s，其外围电路如图 3 所示。VCC3.3VCC3.3VCC3.3VCC3.3U42

23、4SDA/SDISCL/SCLKR2310 KR2110 KR2210 KR2510 KR2410 K2322NCS2120191817161514131RESVAUX_CLAUX_DARESVAD0/SD0REGOUTFSYNCINTMPU9250VDDIONCNCNCNCNC23456710 nFC18C190.1 FC200.1 FVCC3.3FSYNCINTAD0/SD089101112SDA/SDISCL/SCLKnCSAUX_DARESVRESVGNDNCNCNCNCVDDGNDGNDGNDGND图 3 MPU9250 及其外围电路Fig.3 MPU9250 and its per

24、ipheral circuit MPU9250 姿态传感器获取姿态信息的基本原理是：陀螺仪获得角速度源数据，通过积分得到当前的姿态，用加速度计和磁力计的数据分别对陀螺仪进行重力校正和地磁校正。重力校正和地磁校正采用的方法为固定矢量观测法，重力矢量计算可以得到以重力矢量为法向量的当地水平面，从而校正了欧拉角中的俯仰角和横滚角。结合已知的水平面，从地磁矢量分离出水平面上指向磁极的矢量，从而校正了欧拉角中的航向角。3.3无线通信模块LoRa(Long Range Radio)是 Semtech 公司创建的低功耗局域网无线标准，在相同功耗条件下，LoRa 的 140 煤田地质与勘探第 51 卷传输距离

25、相比传统的无线射频通信提升 35 倍，实现了低功耗和远距离的统一。本文选用的 LoRa 模块电路图如图 4 所示，模块传输距离可达 6 000 m，功耗约0.5 W，尺寸为 36 mm20 mm3 mm，同时满足了系统远传输距离、低功耗、小尺寸的要求。U2GNDNCNCRSTAUXTXDRXDLora115141312111098723456NCMD0VCCVCCGNDGNDGNDGNDGNDGNDMD0VCC3.3GNDGNDRXLORATXLORAANTANT图 4 LoRa 模块连接Fig.4 Schematic diagram of LoRa module 3.4锂电池与电源模块为了实

26、现随钻姿态监测，系统需设计独立供电。系统搭载了一块容量为 400 mAh 锂电池作为供电电源，其标称电压为 3.70 V，放电截止电压为 2.75 V，而STM32 模块、MPU9250 模块和 LoRa 模块的额定工作电压均为 3.30 V，因此选用了 TI 公司生产的TPS61025DRCR 电源芯片，对锂电池电源进行稳压。稳压芯片及其外围电路如图 5 所示。VCC3.3VCCVCCU3111GNDL16.8 H10 FR9R10C112.2 FC131M8R11180 KR121 M400 K1098762345ENVOUTFBLBOGNDEPPGNDSWPSLBIVBATTPS6102

27、5DRCRGNDGNDGNDGND图 5 TPS61025DRCR 电源芯片模块及外围电路Fig.5 TPS61025DRCR power supply chip module and peripheralcircuit 3.5小型化系统电路设计为了实现随钻测量的目标，整个系统必须是低功耗的，且系统电路必须是小型化的。这对监测模块系统电路的尺寸提出了较高的要求，因此，对电路进行了设计，其尺寸为：长 70 mm、宽 25 mm、高 7 mm，集成了 STM32 主控模块、MPU9250 传感器模块、LoRa 无线通信模块和电源模块，并由锂电池供电，可供系统在非休眠状态下工作 6 h 以上，系统电

28、路实物如图 6 所示。4系统软件设计本系统软件设计部分基于 Keil5、MATLAB、Lab-VIEW 等软件和 STM32 单片机硬件平台，主要实现功能为 MPU9250 九轴数据的获取与处理、STM32 主控数据解算与处理、LoRa 数据传输和上位机姿态展示。4.1软件流程系统的软件流程如图 7 所示，首先进行系统时钟的初始化，随后进行串口、LoRa、单片机 I2C 接口和MPU9250 传感器的初始化。MPU9250 传感器回传的数据存储到寄存器中，由 STM32 内核处理器进行校正、四元数归一化、互补滤波和卡尔曼滤波，最后上位机匹配 LoRa 模块。STM32 主控负责完成姿态传感器源

29、数据采集、姿态解算和姿态输出，LoRa 模块负责传输STM32 的姿态输出数据，最终由上位机实现角度数据与 3D 姿态实时显示。4.2姿态解算CRb姿态解算本质上是求解钻具的固联坐标系和地理坐标系间的姿态矩阵13。设钻具的固联坐标系为 b 系，当钻具转动时，b 系也随之转动。设地理坐标系为R 系，X 轴指向东，Y 轴指向北，Z 轴指向天。由 b 系到R 系的坐标变换矩阵即为钻具的姿态矩阵，如图 8所示。主控模块根据传感器的输出实时计算出姿态矩阵，从而实时获取钻具当前的俯仰角、横滚角和航向角。陀螺仪和加速度计分别用来测量钻具姿态变化的角速度信息和加速度信息，根据陀螺仪和加速度计的输出和磁力计的校

30、正，可以对姿态矩阵进行实时更新。在姿态解算中，通常采用 3 种方法来表示姿态矩阵，分别是欧拉角、方向余弦和四元数。三种解算方法见表 1，这 3 种方法各有优劣，在实际应用时的选用情况也有所区别。四元数法由于其计算量小，并且适用于全姿态解算12，可以较好地对钻具姿态信息进行 LoRa 模块LoRa 天线锂电池稳压芯片九轴传感器MPU9250STM32 模块图 6 系统电路实物Fig.6 Physical diagram of system circuit第 9 期林婷婷等：定向钻进连续取心钻具姿态监测系统设计 141 实时监测，因此，本文选用四元数法对姿态数据进行解算。4.3四元数理论1四元数的

31、基本表示形式为：Q(q0,q1,q2,q3)=q0+q1i+q2j+q3k，其中，q0、q1、q2、q3为实数，i、j、k 为相互正交的单位向量，也是虚数单位11。在三维空间中，任何旋转都可以表示为绕某个轴(x,y,z)(,x,y,z)CRb以某个角度的旋转，此方法被称为 Axis-Angle 表示方法。假设是表示轴方向的单位向量，表示绕该轴旋转的角度，那么四维向量可以用来表示三维空间中的任意旋转。如果表征 R 系至 b 系的旋转四元数 Q 已确定，则可以计算出姿态矩阵：CRb=q20+q21q22q232(q1q2q0q3)2(q1q3+q0q2)2(q1q2+q0q3)q20q21+q22

32、q232(q2q3q0q1)2(q1q3q0q2)2(q2q3+q0q1)q20q21q22+q23为了直观地表示旋转状态，以 1、2、3的形式表示钻具的姿态，转换公式为：1=arcsin(2(q0q2q1q3)(1)2=arctan(2(q0q1+q2q3)q20q21q22+q23)(2)3=arctan(2(q0q3+q1q2)q20+q21q22q23)(3)式中：1为俯仰角；2为横滚角；3为航向角，对其进行校正后，通过矩阵运算，求取钻具的方位角、顶角和工具面向角。由此可见，四元数 Q 包含了所有的姿态信息，姿态更新实质上是单位四元数 Q 的计算过程。表1姿态解算方法对照Table1C

33、omparisonofattitudeestimationmethods姿态解算方法优势局限实际应用情况欧拉角计算简单，易交互特定情况损失自由度水平姿态角变化小方向余弦可全姿态运行计算量大，实时性差应用较少四元数参数少，易操作形式复杂不直观应用广泛 4.4零点漂移的校准MPU9250 传回的源数据中夹杂了较严重的噪声，在芯片处于静止状态时，仍会出现较为明显的数据摆动7。除此之外，受到零点漂移的影响，数据并非只在静止工作点附近波动。零点漂移现象的影响因素主要有两点，一是芯片的测量精度，二是芯片的安装精度。前者称为读数偏移，后者称为角度偏移8。在使用滤波算法抑制噪声之前需对数据进行校准，以消除偏移

34、的影响。零点漂移的校准过程就是找出摆动数据围绕的中 开始系统时钟初始化I2C 初始化MPU9250 初始化MPU9250初始化成功？陀螺仪参数配置加速度计参数配置磁力计数据配置陀螺仪数据读取加速度计数据读取磁力计数据读取寄存器降噪、滤波源数据解算上位机串口初始化LoRa 初始化LoRa初始化成功？缓冲区NYYN姿态数据结束图 7 软件流程Fig.7 Software flowchart XZR 系b 系YXYZO姿态矩阵 CRb图 8 钻具坐标系、地理坐标系Fig.8 Schematic diagram of drill tool coordinate system and geo-graph

35、ic coordinate system 142 煤田地质与勘探第 51 卷心值的过程。以陀螺仪 X 轴源数据 Dx和加速度计 X轴源数据 Ex为例，将系统静置于水平面，此时 Dx和Ex理论值为 0，但由于零点漂移现象的存在，往往会存在偏移量。以 50 Hz 采样率采集了一组数据见表 2。表2陀螺仪和加速度计的零点漂移Table2Zerodriftofgyroscopeandaccelerometer数据序号Dx/LSBEx/LSB111.845827.645938.8458410.345857.545865.145974.845986.745897.2459109.9459平均值7.9745

36、8.5 Dx在实际应用中，为了尽量减小角度偏移，一般将MPU9250 传感器固定在钻具上，使二者坐标系尽可能地重合，以最大程度地减小的角度偏移；对于读数偏移，在每次启动系统时采用如下方法进行校准，以为例，在校准陀螺仪角速度数据时，以 10 个数据的均值7.97 LSB 为读数的偏移量，将每次的读数减去偏移量作为校准后的读数，即：Dx0=Dx7.97(4)类似的也有：Ex0=Ex458.5(5)式中：Dx0为校准后的陀螺仪 X 轴数据；Ex0为校准后的加速度计 X 轴数据。以此类推，可以获得陀螺仪 X 轴角速度读数 Dx0、陀螺仪 Y 轴角速度读数 Dy0，和陀螺仪 Z 轴角速度读数 Dz0，以

37、及加速度计 X 轴加速度读数 Ex0和加速度计 Y 轴加速度读数 Ey0。4.5互补滤波陀螺仪在动态响应方面表现良好，但在解算姿态时会产生积累误差；磁力计和加速度计在测量姿态时没有累积误差，但动态响应较差。因此，它们在频域上具有互补的特性。为了获取最优的姿态数据，可以采用互补滤波的方法进行融合，如图 9 所示。在短时间内陀螺仪得到的角度更优，分配更高的权重；随着测量时间的延长，采用 4.4 节中的校准方法，使用校准后的加速度计数据对陀螺仪数据进行处理，增加加速度计的权重，通过不同的滤波器(高通、低通等)融合陀螺仪与加速度计的数据，得到整个频带的信号，从而提高测量精度和系统的动态特性16，就是互

38、补滤波的核心思想。数据采集低通滤波高通滤波加速度计原始数据陀螺仪原始数据重构信号图 9 互补滤波Fig.9 Schematic diagram of complementary filtering 将系统置于静止状态，采集陀螺仪源数据，采集时长 900 s，并对得到的数据进行积分解算得到角度值，解算出的角度信息如图 10 所示。互补滤波融合后的数据表明，角度值一直在 0附近，效果较好。校准前的数据在前 200 s，陀螺仪产生的累积误差较小，在200900 s，陀螺仪的累计误差较为明显，900 s 误差约为 0.8。1.00.80.60.4角度/()0.200.20.40100200300400

39、500时间/s600700800900校准前校准后图 10 陀螺仪积分误差与校准Fig.10 Gyroscope integration error and calibration 4.6卡尔曼滤波虽然互补滤波能够在很大程度上利用陀螺仪、加速度计和传感器的频率特性优势，提高姿态数据精度14，但陀螺仪、加速度计和磁力计各自都存在误差，互补滤波的方法难以进一步提升传感器获取数据的精度。卡尔曼滤波是著名的递归算法，最初用于线性问题15。在本文研究的姿态监测系统中，卡尔曼滤波融合陀螺仪、加速度计和磁力计的输出数据，根据上一状态预测当前状态，再与实际测得的状态进行比较，将预估的当前状态与测得的当前状态融

40、合20-21，对钻具的姿态角进行估算，得出最优的角度和角速度17，减小了数据的波动，大大确保了数据的准确性，从而纠正实际测量得到的曲线，实现了数据精度的提升。4.6.1 卡尔曼滤波理论卡尔曼滤波算法包括预测过程和更新过程，通过第 9 期林婷婷等：定向钻进连续取心钻具姿态监测系统设计 143 比较观测值和预测值之间的差异，实现更准确的状态估计。预测过程根据上一时刻(t1 时刻)的后验估计值，估计当前时刻(t 时刻)的状态，并得到 t 时刻的先验估计值；更新过程则利用当前时刻的测量值，修正预测过程中的估计值，以获得当前时刻的后验估计值18。卡尔曼滤波预测方程如下：xt=A xt1+But1(6)P

41、t=APt1AT+W(7)xt xt1ut1ABPtPt1W式中：为 t 时刻的先验估计值；为 t1 时刻的后验估计值；为系统控制向量；为状态转移矩阵；为控制矩阵；为先验估计协方差；为 t1 时刻的后验估计协方差；为过程噪声协方差。卡尔曼滤波更新方程如下式19：Kt=PtHTHPtHT+V(8)xt=xi+Kt(ztH xi)(9)Pt=(IKtH)Pt(10)xtKtVPtHztI式中：为 t 时刻的后验估计值；为卡尔曼增益矩阵；为测量噪声协方差；为后验估计协方差；为测量矩阵；为实际观测值；为单位矩阵。根据上述公式及主要参数，可以完成卡尔曼滤波的预测和更新过程，实现对实测值的修正。4.6.2

42、 实测验证为了验证卡尔曼滤波的有效性，最大程度上还原姿态监测系统的地下工作环境，对系统开展了震动数据采集实验。实验选用了 Z 轴线性马达对监测系统施加持续震动，图 11a 为实验环境，为缓冲较小的水泥路面，以方位角读数为例，对比卡尔曼滤波前后的姿态数据去噪的效果，初始方位角约为 13，实测数据展示在图 11b 中。由测试结果可知，卡尔曼滤波有效地抑制了由系统震动引入的噪声，具有较好的消噪能力。4.7上位机设计为了实时、直观地观测到准确的钻具姿态信息，设计了基于 LabVIEW 的钻具姿态监测上位机系统。所设计的系统具有界面简洁友好，功能全面的优点，能够满足本项目对于钻具姿态监测的需要。主控模块

43、解算后的数据通过 LoRa 模块无线传输至上位机，上位机通过矩阵运算实现了方位角、顶角和工具面向角的实时显示，并绘制对应的图线。其中方位角显示范围为 180 180，顶角显示范围为90 90，工具面向角显示范围为 180 180。同时，为了直观地展示钻具的姿态，在上位机中设置了 3D姿态展示界面，3D 姿态展示功能具有高准确性和高实时性的特点，能够帮助确定钻具的地下姿态。5实验验证为了验证本文研究内容和研发仪器的有效性，模拟地下的干扰和钻具钻进时的位置和环境特征，在吉林大学朝阳校区地质宫博物馆进行了系统测试。5.1区域地质概况地质宫博物馆位置如图 12 所示。由图可知，实验场地周边有多栋建筑(

44、居民楼、教学楼、学生公寓等)、信号基站和供电线路等干扰因素。同时地质宫博物馆内有常年运转的大功率电气设备，对系统的源数据获取、信号传输和姿态展示提出了很高的要求。地质宫博物馆高度约 50 m，上位机设置在地质宫顶层，监测系统设置在地质宫底层。5.2测试结果测试结果表明，在校园和教学楼高电磁干扰的环境下，设计的系统仍能稳定工作。将上位机和接收模块设置于地质宫顶层，多次调整监测系统的姿态，均可 Z 轴线性马达13.313.4(a)实验环境(b)实测数据13.213.113.0角度/()12.912.812.712.60100200300400500时间/s600700800900原始数据卡尔曼滤波

45、后的数据图 11 卡尔曼滤波实测Fig.11 Kalman filtering measurement 144 煤田地质与勘探第 51 卷实现系统功能，展示准确的姿态信息。采用 BW-IMU100C 高精度惯性测量单元测得的数据作为参考值，系统的误差达到 0.5以内。实测结果如图 13 所示。6结论a.在姿态监测技术和嵌入式系统的基础上完成了定向钻进连续取心姿态监测系统设计，构建了以MPU9250 传感器为核心，STM32 为主控的定向钻进连续取心姿态监测系统，用四元数法对采集的源数据进行解算，后续采用互补滤波和卡尔曼滤波，有效地抑制了系统的噪声，提高了系统的监测精度，姿态角监测误差小于 0.

46、5。(a)钻具模型(b)上位机测试界面姿态曲线图3D 姿态展示波特率115 200COM8停止串口选择钻具姿态检测上位机方位角/()顶角/()工具面向角/()37.689.90.120918090505090100001001801801000100180220230240250260时间27028029030031128方位角顶角262422201816140500数据点数1 000角度/()191817161514130500(c)角度测试结果数据点数1 000角度/()参考值测量值工具面向角80767874727068660500数据点数1 000角度/()参考值测量值参考值测量值图 1

47、3 测试实验模型及测试结果Fig.13 Experimental models and test results b.设计的姿态监测系统电路长 70 mm，宽 25 mm，高 7 mm，相比其他姿态监测装备具有较小的体积，并且设计有长距离、低功耗的无线传输模块和独立的电源与供电模块，能够实现对钻具各个组件进行姿态监测，无需外源供电。c.设计的姿态监测系统为定向钻进连续取心技术的实现提供了一种新思路，研制的系统装备、形成的技术参数体系需要进一步工程检验，以验证其姿态监测的可靠性和稳定性。d.钻具姿态监测是构成定向钻进连续取心技术的关键技术之一，虽取得了一些实用性成果，但仍有部分工作需要进一步完善

48、，如设计恒温仓以适应宽温地质环境并减小温度漂移，设计缓震结构以进一步改善实测信号信噪比，拓展姿态监测技术对于物探领域的普适性。测试地点图 12 长春市地质宫博物馆位置Fig.12 Location of Changchun Geological Palace Museum第 9 期林婷婷等：定向钻进连续取心钻具姿态监测系统设计 145 参考文献(References)田郁溟，琚宜太，周尚国.我国战略矿产资源安全保障若干问题的思考J.地质与勘探，2022，58(1)：217228.TIAN Yuming，JU Yitai，ZHOU Shangguo.Thinking on severalprob

49、lems of Chinas strategic mineral resources security guaran-teeJ.Geology and Exploration，2022，58(1)：217228.1 王佟，韩效忠，邓军，等.论中国煤炭地质勘查工作在新条件下的定位与重大研究问题J.煤田地质与勘探，2023，51(2)：2744.WANG Tong，HAN Xiaozhong，DENG Jun，et al.Orientationand major research problems of coal geological exploration inChina under new c

50、onditionsJ.Coal Geology&Exploration，2023，51(2)：2744.2 中华人民共和国自然资源部.中国矿产资源报告M.北京：地质出版社，2022.3 薛倩冰，张金昌.智能化自动化钻探技术与装备发展概述J.探矿工程(岩土钻掘工程)，2020，47(4)：914.XUE Qianbing，ZHANG Jinchang.Advances in intelligent auto-matic drilling technologies and equipmentJ.Exploration Engin-eering(Rock&Soil Drilling and Tunn