林婷婷,刘泽楷,马银龙,朱金宝
LIN Tingting,LIU Zekai,MA Yinlong,ZHU Jinbao

• 1:吉林大学仪器科学与电气工程学院
• 2:吉林大学建设工程学院

摘要(Abstract)：

定向钻进连续取心作为一项新兴的地质勘探技术，在矿产资源勘探方面有广阔前景，为研发具有自主知识产权的定向连续取心钻具，设计了基于姿态传感和无线通信技术的姿态监测系统。硬件系统设计方面，选用MPU9250姿态传感器和STM32F103C8T6主控芯片监测钻具姿态的变化，通过LoRa无线模块实现穿透地层的通信，同时为适应钻具的结构和随钻测量的要求，自主设计了小型化的系统电路，其长宽高尺寸分别为70 mm×25 mm×7 mm。软件设计方面，通过互补滤波和卡尔曼滤波对MPU9250获取的数据进行处理，建立了钻具姿态解算误差补偿模型，设计上位机实现钻具姿态的实时展示。最后，通过强电磁干扰环境的模拟测试对硬件和软件的可靠性与准确性进行了验证。结果表明，设计的系统有效地抑制了惯性传感组件的漂移、累积误差以及噪声，能够持续、稳定地对钻具姿态进行实时监测，为实现定向钻进连续取心钻具的姿态监测提供了一种新思路。
Directional drilling continuous coring, as an emerging geological exploration technique, holds vast potential in the field of mineral resource exploration. To facilitate the development of directional continuous coring tools with proprietary intellectual property rights, an attitude monitoring system based on attitude sensing and wireless communication technology was designed in this paper. Concerning the hardware system design, the MPU9250 attitude sensor and STM32F103C8T6 main control chip were adopted to monitor the attitude change of drilling tools, where the communication through geological layers was achieved using a LoRa wireless module. Additionally, to accommodate the structural of the drilling tool and the requirements of measurement while drilling, a downsized system circuit was autonomously designed, which is sized 70 mm × 25 mm × 7 mm(L × W × H). In terms of software design, data collected by MPU9250was processed by complementary filtering and Kalman filtering. Besides, an error compensation model for solution of drilling tool attitude was established, and an upper computer was designed to exhibit the real-time attitude of a drilling tool. Ultimately, the reliability and accuracy of both hardware and software were verified through simulation tests under the environment with strong electromagnetic interference. The outcomes reveal that the designed system effectively mitigates the drift, cumulative errors, and noise in the inertial sensing components, capable of achieving the continuous and stable real-time attitude monitoring of drilling tool, thereby offering a novel approach towards achieving the attitude monitoring in directional drilling continuous coring tools.

关键词(KeyWords)： 定向钻进;连续取心;惯性传感器;互补滤波;卡尔曼滤波
directional drilling;continuous coring;inertial sensor;complementary filtering;Kalman filtering

Abstract:

Keywords:

基金项目(Foundation): 科技部重点研发项目(2021YFC2900200);; 国家自然科学基金区域联合基金重点项目(U21A2020)

作者(Author): 林婷婷,刘泽楷,马银龙,朱金宝
LIN Tingting,LIU Zekai,MA Yinlong,ZHU Jinbao

参考文献(References)：

• [1]田郁溟，琚宜太，周尚国.我国战略矿产资源安全保障若干问题的思考[J].地质与勘探，2022,58(1):217-228.TIAN Yuming,JU Yitai,ZHOU Shangguo.Thinking on several problems of China’s strategic mineral resources security guarantee[J].Geology and Exploration,2022,58(1):217-228.
• [2]王佟，韩效忠，邓军，等.论中国煤炭地质勘查工作在新条件下的定位与重大研究问题[J].煤田地质与勘探，2023,51(2):27-44.WANG Tong,HAN Xiaozhong,DENG Jun,et al.Orientation and major research problems of coal geological exploration in China under new conditions[J].Coal Geology&Exploration,2023,51(2):27-44.
• [3]中华人民共和国自然资源部.中国矿产资源报告[M].北京：地质出版社，2022.
• [4]薛倩冰，张金昌.智能化自动化钻探技术与装备发展概述[J].探矿工程(岩土钻掘工程)，2020,47(4):9-14.XUE Qianbing,ZHANG Jinchang.Advances in intelligent automatic drilling technologies and equipment[J].Exploration Engineering (Rock&Soil Drilling and Tunneling),2020,47(4):9-14.
• [5]李小洋，马银龙，韩泽龙，等.一种涡轮式定向取心钻进装置：CN115217429A[P].2022-10-21.
• [6]郭先敏，成冠琪，蔡西茂，等.全姿态随钻陀螺测斜技术[J].石油机械，2016,44(6):1-6.GUO Xianmin,CHENG Guanqi,CAI Ximao,et al.All-attitude gyro while drilling technology[J].China Petroleum Machinery,2016,44(6):1-6.
• [7]王立兵，杨松普，罗巍，等.足部安装MEMS-IMU个人导航系统[J].中国惯性技术学报，2016,24(4):460-463.WANG Libing,YANG Songpu,LUO Wei,et al.Pedestrian navigation algorithm based on MEMS-IMU[J].Journal of Chinese Inertial Technology,2016,24(4):460-463.
• [8]CHEN Weicao,GAO Guowei,WANG Juan,et al.The study of the MEMS gyro zero drift signal based on the adaptive Kalman filter[J].Key Engineering Materials,2012,500:635-639.
• [9]胡茂晓.惯性动作捕捉前端设备与数据传输研究[D].济南：山东大学，2015.HU Maoxiao.Research on front-end equipment and data transmission of inertial motion capture device[D].Ji’nan:Shandong University,2015.
• [10]蒋硕硕.传感器技术的发展现状与应用前景探讨[J].电子技术与软件工程，2013(9):23.JIANG Shuoshuo.Discussion on the current development status and prospects of sensor technology[J].Electronic Technology&Software Engineering,2013(9):23.
• [11]秦永元.惯性导航[M].北京：科学出版社，2006.
• [12]FENG Kaiqiang,LI Jie,ZHANG Xiaoming,et al.A new quaternion-based Kalman filter for real-time attitude estimation using the two-step geometrically-intuitive correction algorithm[J].Sensors,2017,17(9):2146.
• [13]李文亮.四元数矩阵[M].长沙：国防科技大学出版社，2002.
• [14]乔会敏，张嘉易，郝永平，等.一种微机械陀螺仪误差的高精度补偿方法[J].国外电子测量技术，2012,31(8):18-20.QIAO Huimin,ZHANG Jiayi,HAO Yongping,et al.A high precision compensation method for micro-mechanical gyro error[J].Foreign Electronic Measurement Technology,2012,31(8):18-20.
• [15]KALMAN R E.A new approach to linear filtering and prediction problems[J].Journal of Fluids Engineering,1960,82(1):35-45.
• [16]黄镇，张浩磊，刘梅，等.一种二阶互补滤波与卡尔曼滤波的姿态解算方法设计[J].电子工艺技术，2018,39(3):168-170.HUANG Zhen,ZHANG Haolei,LIU Mei,et al.Design of second-order complementary filter and Kalman filter for attitude calculation[J].Electronics Process Technology,2018,39(3):168-170.
• [17]MASRAFEE M M R,FARDIN N,AHMED A,et al.Design of Inertial Measurement Unit in Attitude and Heading Reference System for Real-Time Maneuver Monitoring by Using Kalman Filter[C]//2021 5th International Conference on Electrical Engineering and Information Communication Technology (ICEEICT).IEEE,2021:1-5.
• [18]SOLA J.Quaternion kinematics for the error-state Kalman filter[J].arXiv preprint arXi:1711.02508,2017.
• [19]DE RUITER A,DAMAREN C.Extended Kalman filtering and nonlinear predictive filtering for spacecraft attitude determination[J].Canadian Aeronautics and Space Journal,2002,48(1):13-23.
• [20]HENDERSON D M.Euler angles,quaternions,and transformation matrices for space shuttle analysis[R].(1977-06-09)[2013-09-03].
• [21]OWCZAREK P,GOSLINSKI J.An estimation of central points of circle markers in a vision system by using Kalman filter and complementary filter[C].20th International Conference on Methods and Models in Automation and Robotics (MMAR).IEEE,2015:940-945.

文章评论(Comment)：