CN114970073A - 一种基于激光雷达的采煤机虚实融合定位系统 - Google Patents

一种基于激光雷达的采煤机虚实融合定位系统 Download PDF

Info

Publication number
CN114970073A
CN114970073A CN202111507050.5A CN202111507050A CN114970073A CN 114970073 A CN114970073 A CN 114970073A CN 202111507050 A CN202111507050 A CN 202111507050A CN 114970073 A CN114970073 A CN 114970073A
Authority
CN
China
Prior art keywords
coal mining
mining machine
positioning
hydraulic support
virtual
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202111507050.5A
Other languages
English (en)
Other versions
CN114970073B (zh
Inventor
王学文
郝梓翔
谢嘉成
李素华
刘曙光
闫泽文
冯昭
葛福祥
孟浩
梅震怀
郑子盈
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Taiyuan University of Technology
Original Assignee
Taiyuan University of Technology
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Taiyuan University of Technology filed Critical Taiyuan University of Technology
Priority to CN202111507050.5A priority Critical patent/CN114970073B/zh
Publication of CN114970073A publication Critical patent/CN114970073A/zh
Application granted granted Critical
Publication of CN114970073B publication Critical patent/CN114970073B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06F—ELECTRIC DIGITAL DATA PROCESSING
    • G06F30/00—Computer-aided design [CAD]
    • G06F30/20—Design optimisation, verification or simulation
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06F—ELECTRIC DIGITAL DATA PROCESSING
    • G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
    • G06F17/10—Complex mathematical operations
    • G06F17/16—Matrix or vector computation, e.g. matrix-matrix or matrix-vector multiplication, matrix factorization
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06F—ELECTRIC DIGITAL DATA PROCESSING
    • G06F2119/00—Details relating to the type or aim of the analysis or the optimisation
    • G06F2119/02—Reliability analysis or reliability optimisation; Failure analysis, e.g. worst case scenario performance, failure mode and effects analysis [FMEA]

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Theoretical Computer Science (AREA)
  • General Physics & Mathematics (AREA)
  • Mathematical Physics (AREA)
  • Data Mining & Analysis (AREA)
  • Mathematical Optimization (AREA)
  • Mathematical Analysis (AREA)
  • Pure & Applied Mathematics (AREA)
  • Computational Mathematics (AREA)
  • General Engineering & Computer Science (AREA)
  • Software Systems (AREA)
  • Databases & Information Systems (AREA)
  • Computing Systems (AREA)
  • Algebra (AREA)
  • Computer Hardware Design (AREA)
  • Evolutionary Computation (AREA)
  • Geometry (AREA)
  • Operation Control Of Excavators (AREA)
  • Radar Systems Or Details Thereof (AREA)

Abstract

本发明提供了一种基于激光雷达的采煤机虚实融合定位方案，包括底层数据处理系统、数据修正系统和虚拟现实系统。利用采煤机上安装的两台二维激光雷达、倾角传感器和里程计采集支架和采煤机的姿态数据，经由数据修正系统修正后通过精定位系统和粗定位系统中内置的解算模块获得采煤机在工作面内的相对位置信息和绝对位置信息。在虚拟现实环境中实现截割推进过程的仿真运动，并通过人机交互获取采煤机位置信息同时给出定位结果置信度的判定。本发明为采煤机在复杂底板条件下的定位提供了一种基于激光雷达和虚拟现实技术的解决方案，解决了中小型煤矿由于无法负担昂贵的惯导仪器而导致的采煤机无法准确定位的问题，有利于降低采煤机定位的投入成本。同时避免了采煤机依靠惯导定位误差随时间累计导致长时间定位不准确的问题。

Description

一种基于激光雷达的采煤机虚实融合定位系统
技术领域
本发明涉及采煤机定位技术领域，具体为一种基于激光雷达的采煤机虚实融合定位系统。
背景技术
对于机械装备的智能化程度得到了越来越多的重视与研究，具体到综采装备来说就是要给传统的“综采三机”加上智能的“眼睛”，而采煤机作为综采装备的核心装备之一，它的位置信息的获取是后续自动化开采工作的基础，准确获得了采煤机的位置才能开展后续的采煤机姿态及刮板输送机姿态的分析工作，进而对整个综采工作面的工作状况能有比较明确的判断和预估。
目前对于采煤机定位方法的研究多为利用惯性导航元件对采煤机进行定位，但是由于矿用惯性导航元件价格昂贵，国内仅有少数大中型煤矿能够在井下安装使用，大多数中小型煤矿并不能使用惯导进行采煤机的定位，且惯性导航元件受其累计误差的影响，无法实现长时间精准定位，因此需要寻找一种新的定位方式来对采煤机进行定位。激光雷达具有测量精度高，反应速度快的特点，且相比惯性导航元件来说其成本低廉且不存在累计误差，是一种合适的定位装置。
现有技术中，公开号为201910494772.8的“一种采煤机定位监测系统及其监测方法”使用了一台2维激光雷达、一台数字摄像机、一个3轴倾角传感器及测控微机，通过2维激光雷达对定向靶进行扫描测距确定采煤机纵向位置坐标及航向角，利用数字摄像机通过图像识别确定采煤机横向坐标，利用3轴倾角传感器监测采煤机俯仰角和翻滚角，从而实现了对采煤机位置与姿态的监测。
公开号为201910289310.2的“一种采煤机在工作面煤层三维模型中精确定位方法”使用了激光雷达与惯导获取了巷道三维模型和惯性坐标，提取巷道和工作面煤层三维模型特征点后利用KD树算法对特征点进行初始匹配建立基于NDT算法的特征粗匹配点集，利用RANSAC方法去除掉错误的匹配点对，精确对齐采煤机坐标系与工作面煤层三维模型坐标系，实现采煤机在工作面煤层三维模型中精确定位。
但是上述方法的缺陷在于：1）需要进行大量前置准备工作，如扫描巷道的三维点云数据、建立巷道扫描三维模型、标定定位靶，操作繁琐，降低了开采效率。2）现有利用激光雷达的定位方法几乎都只适用于水平底板这种理想环境，与井下真实的底板条件有很大的差距，因此实用性并不高。
发明内容
本发明为了当前中小型煤矿由于成本原因无法安装惯导导致的无法对采煤机进行精确定位的问题，提供一种基于激光雷达的采煤机虚实融合定位系统。
本发明采取以下技术方案：一种基于激光雷达的采煤机虚实融合定位系统，包括底层数据处理系统、数据修正系统和虚拟现实系统，底层数据处理系统包括精定位子系统与粗定位子系统；所述的数据修正系统对倾角传感器采集到的液压支架与采煤机姿态角信息的数据进行优化，优化后的数据通过数据库接入到精定位系统中作为已知变量使用；所述的精定位子系统对采煤机上的任意一点的相对位置进行定位；所述的粗定位子系统对采煤机在工作面上的整体位置进行定位；所述的虚拟现实系统包括虚拟仿真系统、人机交互界面和置信度判定系统，整体位置定位结果通过建立的动态链接库接入虚拟仿真系统中驱动虚拟场景运作，同时将场景中采集到的采煤机实时位置数据对定位结果的置信度进行判定，最终将定位结果、场景实时位置数据、判定置信度结果在人机交互界面中显示，依据判定结果对底层数据处理系统中的参数进行调整，再次将定位结果通过动态链接库与虚拟现实系统进行交互。
精定位子系统包括参数预处理模块、相对定位解算模块以及相对定位结果的获取，其中参数预处理模块获取相对定位所需的基本尺寸参数及根据液压支架和采煤机的相对姿态对定位解析过程中的部分公式进行修正；相对定位解算模块通过激光雷达扫描液压支架立柱获取距离及角度信息，通过在采煤机机身上安装的激光雷达处及对应液压支架上建立的数个空间直角坐标系进行三维空间坐标变换，确定采煤机上定位点在液压支架基准坐标系上的位置坐标，实现采煤机的相对定位结果的获取所述的参数预处理模块中，定位所需的基本尺寸参数由测试所选取的液压支架、采煤机、刮板输送机的装配图及三机配套图获得。精定位子系统中所使用的融合后的已知变量包括数据修正系统优化后的液压支架俯仰角、横滚角，采煤机机身的横滚角、俯仰角。
粗定位子系统中，整体定位解算模块通过对应支架判定及里程计数据解算判定采煤机精定位所选取的对应液压支架，判定完成后将精定位结果接入即可获得采煤机在工作面上的整体定位结果。
其中对应支架判定的具体过程为：采煤机在工作时，其路径由铺设好的刮板输送机确定，依靠滑靴沿着每一节中部槽在整个工作面上往复运动，实现采煤作业，而刮板输送机的每一节中部槽则由对应的一台液压支架进行推溜来使其朝着煤壁方向运动，采煤机的运动路径可以与排布在整个工作面上的液压支架群对应起来，从而实现采煤机在整个工作面上的定位。
里程计数据解算判定具体过程为：将获得的采煤机行程数据与对应型号的刮板输送机中部槽长度相除，借助雷达布置图与采煤机装配图计算出激光雷达所在的中部槽槽号，将与该节中部槽相连接的液压支架判定为雷达对应的液压支架。
数据修正系统中，将获取的历史数据与实时数据通过贝叶斯估计算法相融合，其中历史数据指的是前两刀截割过程中倾角传感器测得的采煤机机身姿态角及前一刀截割过程中倾角传感器测得的液压支架的姿态角；根据装备三机配套图可知一次截割过程中液压支架的俯仰角和横滚角大致可与前两刀采煤机机身的横滚角和俯仰角数值均值相同，而前一刀的液压支架姿态角可对均值结果进行修正，取修正后的数值作为贝叶斯估计算法的先验信息，贝叶斯估计算法中的样本信息由实时测量的液压支架及采煤机姿态角度获取，通过上述数据融合过程即可完成对倾角传感器采集到的液压支架与采煤机姿态角信息的优化。
虚拟仿真系统包括虚拟装备、虚拟煤层底板及虚拟雷达三个部分，虚拟装备包括虚拟液压支架、采煤机和刮板输送机，通过三维建模软件对真实装备进行1：1建模，经过格式转换后导入Unity软件中，将编写好的脚本挂载到虚拟装备上使得虚拟装备能够按照真实的工作过程运行；虚拟煤层底板是预先设定好底板的起伏变化情况，利用三维建模软件完成底板模型的构建再导入Unity软件中，给底板赋予刚体属性和碰撞体组件即可完成虚拟底板的布置，虚拟雷达的建立是将真实的雷达依照上述过程在Unity软件中建立其对应的数字孪生体，将编写的脚本挂载在虚拟雷达上使得其在扫描到碰撞体时到能够返回对应的距离及角度信息，以此模拟真实雷达的扫描过程。
一种基于激光雷达的采煤机虚实融合定位系统中相对定位解算模块的解算方法。
S100～在采煤机机身上布置两个激光雷达，分别为靠近采煤机机身上表面的上方激光雷达和远离采煤机机身上表面的下方激光雷达，二者布置于采煤机机身部分电控箱面板附近，具体安装位置可根据采煤机型号进行适当调整，需保证两个激光雷达上表面与机身上表面平行，水平投影重合，高度方向二者间隔200mm。
S200～建立四个空间直角坐标系，分别为以上方激光雷达为原点的采煤机基准坐标系A，以雷达扫描平面与液压支架左侧立柱相交所截得的椭圆截面的中心为原点的立柱过渡坐标系B，以左侧立柱底部转动副中心为原点的底座过渡坐标系C以及以支架下方液压缸安装销轴的几何中心处为原点的液压支架基准坐标系D。
S300～确定激光雷达到左右两侧立柱连线的距离。
S400～确定液压支架立柱倾角θ2。
S500～确定坐标系B到坐标系C之间的距离S1。
S600～利用所建立的四个坐标系进行坐标变换，将采煤机上任意一点M转换到支架推移机构处的坐标系D中表示。
步骤S300中具体计算过程如下，根据公式2.1,2.2和2.3
Figure RE-DEST_PATH_IMAGE001
（2.1）
Figure 535029DEST_PATH_IMAGE002
（2.2）
Figure RE-DEST_PATH_IMAGE003
（2.3）
式2.1中h1为上方激光雷达到两立柱连线的距离，m1、n1分别为上方激光雷达所测的到左右两立柱的距离加立柱半径，以此作为上方激光雷达到立柱扫描截面中心的距离，l1为两立柱间的截面中心距离；式2.2中各参数为下方激光雷达所测的数据，其含义与2.1中完全相同，且l1= l2；θ1为三角形的高与AB边的夹角。
步骤S400的具体计算公式为：
Figure 648479DEST_PATH_IMAGE004
（2.4）；
步骤S500的具体计算公式为：
Figure RE-DEST_PATH_IMAGE005
（2.5）
参数q1为雷达扫描平面到底板之间的距离，q2为立柱底部安装位置到底板之间的距离，S1为坐标系B到坐标系C之间的距离，q1、q2均可通过实物测量得到。
步骤S600中，坐标系变换过程如下：采煤机上任意一点M可由式2.15转换到支架推移机构处的坐标系D中表示，
Figure 100002_RE-DEST_PATH_IMAGE006
（2.15）
其中，
Figure RE-RE-DEST_PATH_IMAGE007
为任意一点M在坐标系A中的坐标，
Figure RE-RE-DEST_PATH_IMAGE009
为任意一点M在坐标系D中的坐标，
Figure RE-RE-DEST_PATH_IMAGE011
为从坐标系C到坐标系D的转换矩阵，
Figure RE-DEST_PATH_IMAGE013
、
Figure RE-RE-DEST_PATH_IMAGE015
定义方式与
Figure RE-RE-DEST_PATH_IMAGE017
相同；
令：
Figure 100002_RE-DEST_PATH_IMAGE018
（2.16）
Figure 100002_RE-DEST_PATH_IMAGE020
为从坐标系A到坐标系D的转换矩阵；
则式2.15可转变为式2.17。
Figure 100002_RE-DEST_PATH_IMAGE015
（2.17）
Figure 641340DEST_PATH_IMAGE016
（2.18）
Figure 100002_RE-DEST_PATH_IMAGE017
～
Figure 737339DEST_PATH_IMAGE018
为
Figure DEST_PATH_IMAGE019
矩阵中的各个元素，其中，
Figure 558533DEST_PATH_IMAGE020
（2.19）
其中
Figure 100002_RE-DEST_PATH_IMAGE021
为三角形的高与AB边的夹角，
Figure 124644DEST_PATH_IMAGE022
为液压支架立柱倾角，m1为上方激光雷达所测的到左立柱的距离加立柱半径，
Figure DEST_PATH_IMAGE023
为坐标系B到坐标系C之间的距离，
Figure 363995DEST_PATH_IMAGE024
、
Figure DEST_PATH_IMAGE025
、
Figure 678564DEST_PATH_IMAGE026
分别为坐标系C到坐标系D在Z、X、Y三个方向上的投影长度；。
Figure 800104DEST_PATH_IMAGE019
矩阵中其余各项均为0，如式2.20所示。
Figure 100002_RE-DEST_PATH_IMAGE027
(2.20)
至此，采煤机基准坐标系A表示的任意一点（XA,YA，ZA）均可在液压支架基准坐标系D中表示，选定坐标系A的原点作为采煤机的定位基准点。
一种基于激光雷达的采煤机虚实融合定位系统中参数预处理模块的处理方法，包括两部分修正。
第一部分修正～根据数据修正系统修正后的液压支架俯仰角和倾角传感器采集到的采煤机横滚角将液压支架和采煤机的相对姿态关系进行分类，针对不同情况对
Figure 107589DEST_PATH_IMAGE028
进行修正，其中θ2液压支架立柱倾角，h 1为上方激光雷达到两立柱连线的距离，h 2为下方激光雷达到两立柱连线的距离，获取不同底板条件下的液压支架立柱倾角θ2的表达式，对于修正过程中涉及到的角度由角度判定算法通过与参数所对应的原角度作差完成角度正负值的判定，具体修正过程如下：
设由
Figure 263763DEST_PATH_IMAGE028
直接解算得到的角度为
Figure DEST_PATH_IMAGE029
，液压支架的俯仰角为
Figure 247769DEST_PATH_IMAGE030
，采煤机的横滚角为
Figure DEST_PATH_IMAGE031
，则液压支架与采煤机的相对姿态关系可分为五种情况。
当
Figure 794288DEST_PATH_IMAGE030
=
Figure 702201DEST_PATH_IMAGE031
=0，即判定情况为（1）时，修正后
Figure 712882DEST_PATH_IMAGE032
=
Figure 366324DEST_PATH_IMAGE029
；
当
Figure 462456DEST_PATH_IMAGE030
>0,
Figure 174060DEST_PATH_IMAGE031
>0，即判定情况为（2）时，修正后
Figure 976931DEST_PATH_IMAGE032
=
Figure 115788DEST_PATH_IMAGE029
+
Figure 699216DEST_PATH_IMAGE030
-
Figure 401462DEST_PATH_IMAGE031
；
当
Figure 121156DEST_PATH_IMAGE030
>0,
Figure 430915DEST_PATH_IMAGE031
<0，即判定情况为（3）时，修正后
Figure 439322DEST_PATH_IMAGE032
=
Figure 492729DEST_PATH_IMAGE029
+
Figure 332509DEST_PATH_IMAGE030
+
Figure 501584DEST_PATH_IMAGE031
；
当
Figure 59605DEST_PATH_IMAGE030
<0,
Figure 588806DEST_PATH_IMAGE031
<0，即判定情况为（4）时，修正后
Figure 283093DEST_PATH_IMAGE032
=
Figure 200233DEST_PATH_IMAGE029
-
Figure 166921DEST_PATH_IMAGE030
+
Figure 499813DEST_PATH_IMAGE031
；
当
Figure 314186DEST_PATH_IMAGE030
<0,
Figure 136648DEST_PATH_IMAGE031
>0，即判定情况为（5）时，修正后
Figure 95027DEST_PATH_IMAGE032
=
Figure 293927DEST_PATH_IMAGE029
-
Figure 900489DEST_PATH_IMAGE030
-
Figure 893852DEST_PATH_IMAGE031
；
不同情况的判定过程通过参数预处理模块中的角度判定算法对
Figure 648182DEST_PATH_IMAGE030
、
Figure 572144DEST_PATH_IMAGE031
的角度正负值进行判定完成。
第二部分修正～根据数据修正系统修正后的液压支架横滚角和倾角传感器采集到的采煤机俯仰角将液压支架和采煤机的相对姿态关系进行分类，针对不同情况下列公式2.1、2.2进行修正。
Figure DEST_PATH_IMAGE033
（2.1）
Figure 95529DEST_PATH_IMAGE034
（2.2）
获取不同底板条件下雷达到两立柱连线的距离
Figure DEST_PATH_IMAGE035
、
Figure 463057DEST_PATH_IMAGE036
的表达式，具体修正过程如下：
设由式2.1直接解算得到的距离为p 1，液压支架的横滚角为
Figure DEST_PATH_IMAGE037
，采煤机的俯仰角为
Figure 393098DEST_PATH_IMAGE038
，则液压支架与采煤机的相对姿态关系可分为五种情况，
当
Figure 605905DEST_PATH_IMAGE037
=
Figure 249376DEST_PATH_IMAGE038
=0，即判定情况为（1）时，修正后：
Figure DEST_PATH_IMAGE039
；
当
Figure 771493DEST_PATH_IMAGE037
>0,
Figure 500414DEST_PATH_IMAGE038
>0，即判定情况为（2）时，
修正后；
Figure 516912DEST_PATH_IMAGE040
；
当
Figure 14889DEST_PATH_IMAGE037
>0,
Figure 786536DEST_PATH_IMAGE038
<0，即判定情况为（3）时，
修正后；
Figure DEST_PATH_IMAGE041
；
当
Figure 422660DEST_PATH_IMAGE037
<0,
Figure 242849DEST_PATH_IMAGE038
>0，即判定情况为（4）时，
修正后；
Figure 595333DEST_PATH_IMAGE042
；
当
Figure 537881DEST_PATH_IMAGE037
<0,
Figure 162766DEST_PATH_IMAGE038
<0，即判定情况为（5）时，
修正后；
Figure RE-DEST_PATH_IMAGE043
；
不同情况的判定过程通过参数预处理模块中的角度判定算法对
Figure 583383DEST_PATH_IMAGE037
、
Figure 993636DEST_PATH_IMAGE038
的角度正负值进行判定完成。
h 2的修正方法与h 1相同，将修正后θ2、h 1、h 2代入计算完成复杂底板条件下采煤机的相对定位。
与现有技术相比，本发明具有以下效果：
1、本发明对采煤机和液压支架的相对姿态关系进行了解析，不需要预设理想的底板条件，能够适用于真实井下起伏不平的复杂地形，对于底板起伏变化剧烈的煤矿来说具有很强的实用性。
2、本发明为中小型煤矿提供了一种高效低成本的采煤机定位方案，解决了中小型煤矿由于无法负担昂贵的惯导仪器而导致的采煤机无法准确定位的问题，有利于降低采煤机定位的投入成本。
3、采用激光雷达、倾角传感器对采煤机定位不存在累计误差，采集到的数据比较真实准确。相比采用惯导的采煤机定位方式来说避免了由于累计误差而造成的长时间定位不准确的问题。
4、相比已有的使用激光雷达和惯导的定位方法来说，本方案事先不需要进行复杂的定位靶标记或者地图构建准备工作，也不需要在工作过程中停车，利用激光雷达和倾角传感器及里程计元件即可完成实时定位过程，方案简便易行。
5、本方案利用虚拟现实技术在所构建的综采场景中能够实时显示采煤机的位置信息，同时可以在线验证方案的置信度。采用本方案所提供的系统，试验人员能够直观便捷地获取定位结果同时能够通过修改相应参数条件对不同环境下的定位系统进行测试，解决了实际井下环境中测试困难、测试成本大的问题，大幅提高了测试效率。
附图说明
图1为坐标系的建立示意图；
图2为雷达距离测量参数图；
图3为确定立柱倾角参数图；
图4为确认参数S1示意图；
图5为采煤机基准坐标系A到立柱过渡坐标系B的变换示意图；
图6为立柱过渡坐标系B到底座过渡坐标系C的变换示意图；
图7为底座过渡坐标系C到液压支架基准坐标系D的变换示意图；
图8为复杂底板情况下液压支架俯仰角与采煤机横滚角相对姿态关系；
图9为复杂底板情况下液压支架横滚角与采煤机俯仰角相对姿态关系；
图10为采煤机在整个工作面上的粗定位示意图；
图11为本发明系统的原理图。
具体实施方式
下面结合附图1至10对本发明做进一步详细的说明。
本发明克服现有技术的不足，提供了一种基于激光雷达的采煤机虚实融合定位方案。解决了当前中小型煤矿由于成本原因无法安装惯导导致的无法对采煤机进行精确定位的问题，所提出的定位方案适用于起伏不平的复杂底板情况，为后续多源数据融合定位研究提供了支持。
本发明提供了一种基于激光雷达的采煤机虚实融合定位系统，包括以下内容：底层数据处理系统、数据修正系统和虚拟现实系统。
底层数据处理系统包含精定位子系统与粗定位子系统。
精定位子系统包含参数预处理模块、相对定位解算模块及相对定位结果的获取。
参数预处理模块的功能是获取相对定位所需的基本尺寸参数及根据液压支架和采煤机的相对姿态对定位解析过程中的部分公式进行修正。定位所需的基本尺寸参数由测试所选取的液压支架、采煤机、刮板输送机的装配图及三机配套图获得。
相对定位解算模块的功能是通过雷达扫描液压支架立柱获取距离及角度信息，通过在采煤机机身上安装的激光雷达处及对应液压支架上建立的数个空间直角坐标系进行三维空间坐标变换，确定采煤机上定位点在液压支架基准坐标系上的位置坐标，从而实现采煤机的相对定位结果的获取。
为实现上述目的本系统实施步骤如下：
S100～在采煤机机身上布置本模块所需的两个YDLIDAR X4二维激光雷达，二者布置于采煤机机身部分电控箱面板附近具体安装位置可根据采煤机型号进行适当调整，需保证两个雷达上表面与机身上表面平行，水平投影重合，高度方向二者间隔200mm。布置方案如图1所示。
S200～建立本模块所需的四个空间直角坐标系，分别为以上方激光雷达为原点的采煤机基准坐标系A，以雷达扫描平面与液压支架左侧立柱相交所截得的椭圆截面的中心为原点的立柱过渡坐标系B，以左侧立柱底部转动副中心为原点的底座过渡坐标系C，和以支架下方液压缸安装销轴的几何中心处为原点的液压支架基准坐标系D。各坐标系具体位置及各坐标轴指向如图1所示。
S300～确定雷达到两立柱连线的距离，各参数关系如图2所示。推导过程见公式2.1-2.3。
Figure 107086DEST_PATH_IMAGE044
（2.1）
Figure 32316DEST_PATH_IMAGE002
（2.2）
Figure 945040DEST_PATH_IMAGE003
（2.3）
式2.1中h1为上方激光雷达到两立柱连线的距离，m1、n1分别为上方激光雷达所测的到左右两立柱的距离加立柱半径，以此作为上方激光雷达到立柱扫描截面中心的距离，l1为两立柱间的截面中心距离；式2.2中各参数为下方激光雷达所测的数据，其含义与2.1中完全相同，且l1= l2；θ1为三角形的高与AB边的夹角。
S400～确定液压支架立柱倾角θ2，各参数关系如图3所示。推导过程见公式2.4。
Figure 6537DEST_PATH_IMAGE004
（2.4）。
S500～确定立柱过渡坐标系B到底座过渡坐标系C之间的距离S1，各参数关系如图4所示。S1的推导过程见公式2.5。
Figure 290887DEST_PATH_IMAGE005
（2.5）
参数q1为雷达扫描平面到底板之间的距离，q2为立柱底部安装位置到底板之间的距离，S1为坐标系B到坐标系C之间的距离，q1、q2均可通过实物测量得到。
S600～利用所建立的四个坐标系进行坐标变换，将采煤机上任意一点M转换到支架推移机构处的坐标系D中表示。变换过程如下：
（1）从采煤机基准坐标系A到立柱过渡坐标系B的变换：
首先假设任意一点M在坐标系B中的坐标
Figure RE-DEST_PATH_IMAGE045
为（XB,YB，ZB），在坐标系A中的坐标
Figure 641097DEST_PATH_IMAGE046
为（XA,YA，ZA）。如图5所示。
Figure RE-DEST_PATH_IMAGE047
（2.6）
Figure 856047DEST_PATH_IMAGE048
（2.7）
将点M的三维坐标转化为齐次坐标：
Figure RE-DEST_PATH_IMAGE049
（2.8）
Figure 37630DEST_PATH_IMAGE050
（2.9）
Figure RE-DEST_PATH_IMAGE051
（2.10）。
(2) 从立柱过渡坐标系B到底座过渡坐标系C的变换：
过程与从坐标系A到坐标系B的变换类似，如图6所示。
C处坐标系的建立利用了D-H坐标系的规则，变量
Figure 164986DEST_PATH_IMAGE052
为关节扭转角，
Figure RE-DEST_PATH_IMAGE053
为杆件长度。与坐标系A到坐标系B的变换类似，进行公式推导，过程如下：
Figure 744435DEST_PATH_IMAGE054
（2.11）
Figure RE-DEST_PATH_IMAGE055
（2.12）
由D-H坐标系建立规则可知，
Figure 248229DEST_PATH_IMAGE052
=90°，故可得式2.13。
Figure 549897DEST_PATH_IMAGE056
（2.13）
D-H坐标系建立规则指的是在机器人关节运动学中在相邻两个关节处建立坐标系时所遵循的一种规则，具体为以两个关节旋转轴为z轴，前一个坐标的x轴沿关节连接杆件从自身z轴指向下一个z轴，此x轴垂直于两个z轴，y轴的建立按右手系确定。
（2）从底座过渡坐标系C到液压支架基准坐标系D的变换：
如图7所示。图7中参数S1、S2、S3分别为坐标系C到坐标系D在Z、X、Y三个方向上的投影长度，均可由实物测量获得。推导过程与上文类似，见式2.14。
Figure RE-DEST_PATH_IMAGE057
（2.14）
通过上述过程的推导，采煤机上任意一点M可由式2.15转换到支架推移机构处的坐标系D中表示。
Figure 97422DEST_PATH_IMAGE006
（2.15）
令：
Figure 484541DEST_PATH_IMAGE012
（2.16）
则式2.15可转变为式2.17。
Figure 854342DEST_PATH_IMAGE015
（2.17）
Figure 682621DEST_PATH_IMAGE016
（2.18）
其中，
Figure 479676DEST_PATH_IMAGE020
（2.19）
Figure 88512DEST_PATH_IMAGE019
矩阵中其余各项均为0，如式2.20所示。
Figure 950419DEST_PATH_IMAGE058
(2.20)
至此，采煤机基准坐标系A表示的任意一点（XA,YA，ZA）均可在液压支架基准坐标系D中表示，选定坐标系A的原点作为采煤机的定位基准点，由上述方法即可完成采煤机的相对定位。
参数预处理模块中对部分公式进行修正包含两部分，第一部分是根据数据修正系统修正后的液压支架俯仰角和倾角传感器采集到的采煤机横滚角将液压支架和采煤机的相对姿态关系进行分类，针对不同情况对式2.4进行修正，获取不同底板条件下的液压支架立柱倾角
Figure 961101DEST_PATH_IMAGE032
的表达式。对于修正过程中涉及到的角度由角度判定算法通过与参数所对应的原角度作差完成角度正负值的判定。具体修正过程如下：
设由式2.4直接解算得到的角度为
Figure 866740DEST_PATH_IMAGE029
，液压支架的俯仰角为
Figure 962872DEST_PATH_IMAGE030
，采煤机的横滚角为
Figure 674476DEST_PATH_IMAGE031
，则液压支架与采煤机的相对姿态关系可分为五种情况，如图8所示，
Figure 726614DEST_PATH_IMAGE030
、
Figure 865472DEST_PATH_IMAGE060
角度正负按图中规定为准。
当
Figure 448900DEST_PATH_IMAGE030
=
Figure 636299DEST_PATH_IMAGE031
=0，即判定情况为（1）时，修正后
Figure 621572DEST_PATH_IMAGE032
=
Figure 931331DEST_PATH_IMAGE029
；
当
Figure 687541DEST_PATH_IMAGE030
>0,
Figure 740947DEST_PATH_IMAGE031
>0，即判定情况为（2）时，修正后
Figure 518411DEST_PATH_IMAGE032
=
Figure 999071DEST_PATH_IMAGE029
+
Figure 291512DEST_PATH_IMAGE030
-
Figure 335560DEST_PATH_IMAGE031
；
当
Figure 29846DEST_PATH_IMAGE030
>0,
Figure 681408DEST_PATH_IMAGE031
<0，即判定情况为（3）时，修正后
Figure 664407DEST_PATH_IMAGE032
=
Figure 59616DEST_PATH_IMAGE029
+
Figure 608409DEST_PATH_IMAGE030
+
Figure 384867DEST_PATH_IMAGE031
；
当
Figure 651900DEST_PATH_IMAGE030
<0,
Figure 788483DEST_PATH_IMAGE031
<0，即判定情况为（4）时，修正后
Figure 191783DEST_PATH_IMAGE032
=
Figure 450726DEST_PATH_IMAGE029
-
Figure 392006DEST_PATH_IMAGE030
+
Figure 129018DEST_PATH_IMAGE031
；
当
Figure 219114DEST_PATH_IMAGE030
<0,
Figure 835909DEST_PATH_IMAGE031
>0，即判定情况为（5）时，修正后
Figure 811956DEST_PATH_IMAGE032
=
Figure 352658DEST_PATH_IMAGE029
-
Figure 933812DEST_PATH_IMAGE030
-
Figure 268979DEST_PATH_IMAGE031
。
不同情况的判定过程通过参数预处理模块中的角度判定算法对
Figure 686316DEST_PATH_IMAGE030
、
Figure 765130DEST_PATH_IMAGE031
的角度正负值进行判定完成。
修正的第二部分是根据数据修正系统修正后的液压支架横滚角和倾角传感器采集到的采煤机俯仰角将液压支架和采煤机的相对姿态关系进行分类，针对不同情况对式2.1、2.2进行修正，获取不同底板条件下雷达到两立柱连线的距离h1、h2的表达式。具体修正过程如下：
设由式2.1直接解算得到的距离为p 1，液压支架的横滚角为
Figure 263108DEST_PATH_IMAGE037
，采煤机的俯仰角为
Figure 706859DEST_PATH_IMAGE038
，则液压支架与采煤机的相对姿态关系可分为五种情况，如图9所示，
Figure 923076DEST_PATH_IMAGE037
、
Figure 805582DEST_PATH_IMAGE038
角度正负按图中规定为准。
当
Figure 345016DEST_PATH_IMAGE037
=
Figure 287564DEST_PATH_IMAGE038
=0，即判定情况为（1）时，修正后：
Figure 663182DEST_PATH_IMAGE039
；
当
Figure 83799DEST_PATH_IMAGE037
>0,
Figure 556369DEST_PATH_IMAGE038
>0，即判定情况为（2）时，
修正后；
Figure 89725DEST_PATH_IMAGE040
；
当
Figure 14956DEST_PATH_IMAGE037
>0,
Figure 239264DEST_PATH_IMAGE038
<0，即判定情况为（3）时，
修正后；
Figure 504023DEST_PATH_IMAGE041
；
当
Figure 788374DEST_PATH_IMAGE037
<0,
Figure 200900DEST_PATH_IMAGE038
>0，即判定情况为（4）时，
修正后；
Figure 150271DEST_PATH_IMAGE042
；
当
Figure 331853DEST_PATH_IMAGE037
<0,
Figure 724789DEST_PATH_IMAGE038
<0，即判定情况为（5）时，
修正后；
Figure 624611DEST_PATH_IMAGE043
。
不同情况的判定过程通过参数预处理模块中的角度判定算法对
Figure 190722DEST_PATH_IMAGE037
、
Figure 915227DEST_PATH_IMAGE038
的角度正负值进行判定完成。
h 2的修正方法与h 1相同，不再叙述。将修正后θ2代入式2.5～2.20，h 1、h 2代入式2.3、2.4中即可完成复杂底板条件下采煤机的相对定位。
采煤机的粗定位子系统包括整体定位解算模块及整体定位结果的获取。
整体定位解算模块的功能是通过对应支架判定算法及里程计数据解算判定采煤机精定位所选取的对应液压支架。判定完成后将精定位结果接入即可获得采煤机在工作面上的整体定位结果。
对应支架判定算法原理为采煤机在工作时，其路径由铺设好的刮板输送机确定，依靠滑靴沿着每一节中部槽在整个工作面上往复运动，实现采煤作业，而刮板输送机的每一节中部槽则由对应的一台液压支架进行推溜来使其朝着煤壁方向运动。因此，采煤机的运动路径可以与排布在整个工作面上的液压支架群对应起来，从而实现采煤机在整个工作面上的定位。
对应支架判定算法的具体过程为：当采煤机在刮板输送机机头位置时雷达开始扫描，实时记录扫描结果，当扫描平面内出现距离为d1的点且同时出现距离为e1的点时，记录一次；追踪距离为d1的点处距离值的变化，当其值变为e1时，再次记录，同时结束对该点的追踪；两次记录时间间隔内，可认为采煤机在对应的某台液压支架控制范围内运动，参数d1表示采煤机雷达到支架立柱间的最短距离，参数e1表示此时雷达到支架另一支柱的距离。
里程计数据解算判定具体过程为：将获得的采煤机行程数据与对应型号的刮板输送机中部槽长度相除，借助雷达布置图与采煤机装配图计算出激光雷达所在的中部槽槽号，将与该节中部槽相连接的液压支架判定为雷达对应的液压支架。
数据修正系统能够将获取到的历史数据与实时数据通过贝叶斯估计算法相融合，对倾角传感器采集到的液压支架与采煤机姿态角信息进行优化，优化后的数据通过数据库接入到精定位系统中作为已知变量使用。
历史信息指的是前两刀截割过程中倾角传感器测得的采煤机机身姿态角及前一刀截割过程中倾角传感器测得的液压支架的姿态角。根据装备三机配套图可知一次截割过程中液压支架的俯仰角和横滚角大致可与前两刀采煤机机身的横滚角和俯仰角数值均值相同，而前一刀的液压支架姿态角可对均值结果进行修正，取修正后的数值作为贝叶斯估计算法的先验信息。
贝叶斯估计算法中的样本信息由实时测量的液压支架及采煤机姿态角度获取，通过上述数据融合过程即可完成对倾角传感器采集到的液压支架与采煤机姿态角信息的优化。
虚拟现实系统包括虚拟仿真系统、人机交互界面和置信度判定系统。在虚拟现实环境下能够完成测试装备的工作过程与定位过程的仿真，定位结果通过建立的动态链接库接入仿真系统中驱动虚拟场景运作，同时将场景中采集到的采煤机实时位置数据以数据库的形式导出，在MATLAB中编写算法对定位结果的置信度进行判定，最终将定位结果、场景实时位置数据、判定置信度结果都在人机交互界面中显示出来以供研究人员分析，依据判定结果可对底层数据处理系统中的参数进行调整，再次将定位结果通过动态链接库与虚拟现实系统进行交互，以实现对定位结果的迭代优化。
所述虚拟仿真系统包括虚拟装备、虚拟煤层底板及虚拟雷达三个部分。虚拟装备指虚拟液压支架、采煤机和刮板输送机，通过三维建模软件对真实装备进行1：1建模，经过格式转换后导入Unity3D软件中，将编写好的C#脚本挂载到虚拟装备上使得虚拟装备能够按照真实的工作过程运行。虚拟底板是预先设定好底板的起伏变化情况，利用三维建模软件完成底板模型的构建再导入Unity3D软件中，给底板赋予刚体属性和Mesh碰撞体组件即可完成虚拟底板的布置。虚拟雷达的建立是将真实的雷达依照上述过程在Unity3D软件中建立其对应的数字孪生体，将编写的C#脚本挂载在虚拟雷达上使得其在旋转的过程中能够发射出扇形的红外射线族，同时给液压支架的立柱赋予collider碰撞体组件，当射线扫描到立柱时，能够返回对应的距离及角度信息。以此模拟真实雷达的扫描过程。
人机交互界面是由Unity3D软件自带的UGUI控件进行设计，预留定位结果显示面板、实时场景数据获取面板和置信度结果显示面板位置，将精定位与粗定位系统解算的结果通过动态链接库接入面板预留位置使得研究人员可以对定位结果进行分析。
置信度判定系统是利用MATLAB进行算法设计，将精定位与粗定位的结果从Excel导入SQL Server数据库中，在MATLAB中设置ODBC数据源，利用Database函数连接到数据源，再通过exec函数对数据库进行操作，完成前置工作后即可通过fetch函数进行数据的读取。根据采集到的数据特征选取合适的分布，将对应的置信度表格导入SQL Server数据库。通过脚本选取相应的置信度值，将结果接入到人机交互界面上对应的显示面板中即可完成置信度的判定。

Claims (10)

1.一种基于激光雷达的采煤机虚实融合定位系统，其特征在于：包括底层数据处理系统、数据修正系统和虚拟现实系统，底层数据处理系统包括精定位子系统与粗定位子系统；
所述的数据修正系统对倾角传感器采集到的液压支架与采煤机姿态角信息的数据进行优化，优化后的数据通过数据库接入到精定位系统中作为已知变量使用；
所述的精定位子系统对采煤机上的任意一点的相对位置进行定位；
所述的粗定位子系统对采煤机在工作面上的整体位置进行定位；
所述的虚拟现实系统包括虚拟仿真系统、人机交互界面和置信度判定系统，整体位置定位结果通过建立的动态链接库接入虚拟仿真系统中驱动虚拟场景运作，同时将场景中采集到的采煤机实时位置数据对定位结果的置信度进行判定，最终将定位结果、场景实时位置数据、判定置信度结果在人机交互界面中显示，依据判定结果对底层数据处理系统中的参数进行调整，再次将定位结果通过动态链接库与虚拟现实系统进行交互。
2.根据权利要求1所述的基于激光雷达的采煤机虚实融合定位系统，其特征在于：所述的精定位子系统包括参数预处理模块、相对定位解算模块以及相对定位结果的获取，其中参数预处理模块获取相对定位所需的基本尺寸参数及根据液压支架和采煤机的相对姿态对定位解析过程中的部分公式进行修正；相对定位解算模块通过激光雷达扫描液压支架立柱获取距离及角度信息，通过在采煤机机身上安装的激光雷达处及对应液压支架上建立的数个空间直角坐标系进行三维空间坐标变换，确定采煤机上定位点在液压支架基准坐标系上的位置坐标，实现采煤机的相对定位结果的获取所述的参数预处理模块中，定位所需的基本尺寸参数由测试所选取的液压支架、采煤机、刮板输送机的装配图及三机配套图获得；
精定位子系统中所使用的融合后的已知变量包括数据修正系统优化后的液压支架俯仰角、横滚角，采煤机机身的横滚角、俯仰角。
3.根据权利要求1所述的基于激光雷达的采煤机虚实融合定位系统，其特征在于：所述的粗定位子系统中，整体定位解算模块通过对应支架判定及里程计数据解算判定采煤机精定位所选取的对应液压支架，判定完成后将精定位结果接入即可获得采煤机在工作面上的整体定位结果；
其中对应支架判定的具体过程为：采煤机在工作时，其路径由铺设好的刮板输送机确定，依靠滑靴沿着每一节中部槽在整个工作面上往复运动，实现采煤作业，而刮板输送机的每一节中部槽则由对应的一台液压支架进行推溜来使其朝着煤壁方向运动，采煤机的运动路径可以与排布在整个工作面上的液压支架群对应起来，从而实现采煤机在整个工作面上的定位；
里程计数据解算判定具体过程为：将获得的采煤机行程数据与对应型号的刮板输送机中部槽长度相除，借助雷达布置图与采煤机装配图计算出激光雷达所在的中部槽槽号，将与该节中部槽相连接的液压支架判定为雷达对应的液压支架。
4.根据权利要求1所述的基于激光雷达的采煤机虚实融合定位系统，其特征在于：所述的数据修正系统中，将获取的历史数据与实时数据通过贝叶斯估计算法相融合，其中历史数据指的是前两刀截割过程中倾角传感器测得的采煤机机身姿态角及前一刀截割过程中倾角传感器测得的液压支架的姿态角；根据装备三机配套图可知一次截割过程中液压支架的俯仰角和横滚角大致可与前两刀采煤机机身的横滚角和俯仰角数值均值相同，而前一刀的液压支架姿态角可对均值结果进行修正，取修正后的数值作为贝叶斯估计算法的先验信息，贝叶斯估计算法中的样本信息由实时测量的液压支架及采煤机姿态角度获取，通过上述数据融合过程即可完成对倾角传感器采集到的液压支架与采煤机姿态角信息的优化。
5.根据权利要求1所述的基于激光雷达的采煤机虚实融合定位系统，其特征在于：所述的虚拟仿真系统包括虚拟装备、虚拟煤层底板及虚拟雷达三个部分，虚拟装备包括虚拟液压支架、采煤机和刮板输送机，通过三维建模软件对真实装备进行1：1建模，经过格式转换后导入Unity软件中，将编写好的脚本挂载到虚拟装备上使得虚拟装备能够按照真实的工作过程运行；虚拟煤层底板是预先设定好底板的起伏变化情况，利用三维建模软件完成底板模型的构建再导入Unity软件中，给底板赋予刚体属性和碰撞体组件即可完成虚拟底板的布置，虚拟雷达的建立是将真实的雷达依照上述过程在Unity软件中建立其对应的数字孪生体，将编写的脚本挂载在虚拟雷达上使得其在扫描到碰撞体时到能够返回对应的距离及角度信息，以此模拟真实雷达的扫描过程。
6.一种如权利要求2所述的基于激光雷达的采煤机虚实融合定位系统中相对定位解算模块的解算方法，其特征在于：
S100～在采煤机机身上布置两个激光雷达，分别为靠近采煤机机身上表面的上方激光雷达和远离采煤机机身上表面的下方激光雷达，二者布置于采煤机机身部分电控箱面板附近，具体安装位置可根据采煤机型号进行适当调整，需保证两个激光雷达上表面与机身上表面平行，水平投影重合，高度方向二者间隔200mm；
S200～建立四个空间直角坐标系，分别为以上方激光雷达为原点的采煤机基准坐标系A，以雷达扫描平面与液压支架左侧立柱相交所截得的椭圆截面的中心为原点的立柱过渡坐标系B，以左侧立柱底部转动副中心为原点的底座过渡坐标系C以及以支架下方液压缸安装销轴的几何中心处为原点的液压支架基准坐标系D；
S300～确定激光雷达到左右两侧立柱连线的距离；
S400～确定液压支架立柱倾角θ2；
S500～确定坐标系B到坐标系C之间的距离S1；
S600～利用所建立的四个坐标系进行坐标变换，将采煤机上任意一点M转换到支架推移机构处的坐标系D中表示。
7.根据权利要求6所述的基于激光雷达的采煤机虚实融合定位系统中相对定位解算模块的解算方法，其特征在于：所述的步骤S300中具体计算过程如下，根据公式2.1,2.2和2.3
Figure 623655DEST_PATH_IMAGE001
（2.1）
Figure 10774DEST_PATH_IMAGE002
（2.2）
Figure 52680DEST_PATH_IMAGE003
（2.3）
式2.1中h1为上方激光雷达到两立柱连线的距离，m1、n1分别为上方激光雷达所测的到左右两立柱的距离加立柱半径，以此作为上方激光雷达到立柱扫描截面中心的距离，l1为两立柱间的截面中心距离；式2.2中各参数为下方激光雷达所测的数据，其含义与2.1中完全相同，且l1= l2；θ1为三角形的高与AB边的夹角。
8.根据权利要求7所述的基于激光雷达的采煤机虚实融合定位系统中相对定位解算模块的解算方法，其特征在于：所述的步骤S400的具体计算公式为：
Figure 208855DEST_PATH_IMAGE004
（2.4）；
所述的步骤S500的具体计算公式为：
Figure 5909DEST_PATH_IMAGE005
（2.5）
参数q1为雷达扫描平面到底板之间的距离，q2为立柱底部安装位置到底板之间的距离，S1为坐标系B到坐标系C之间的距离，q1、q2均可通过实物测量得到。
9.根据权利要求8所述的基于激光雷达的采煤机虚实融合定位系统中相对定位解算模块的解算方法，其特征在于：所述的步骤S600中，坐标系变换过程如下：采煤机上任意一点M可由式2.15转换到支架推移机构处的坐标系D中表示，
Figure RE-DEST_PATH_IMAGE006
（2.15）
其中，
Figure RE-DEST_PATH_IMAGE007
为任意一点M在坐标系A中的坐标，
Figure RE-DEST_PATH_IMAGE009
为任意一点M在坐标系D中的坐标，
Figure RE-DEST_PATH_IMAGE011
为从坐标系C到坐标系D的转换矩阵，
Figure RE-RE-DEST_PATH_IMAGE013
、
Figure RE-DEST_PATH_IMAGE015
定义方式与
Figure RE-DEST_PATH_IMAGE017
相同；
令：
Figure RE-DEST_PATH_IMAGE018
（2.16）
Figure RE-DEST_PATH_IMAGE020
为从坐标系A到坐标系D的转换矩阵；
则式2.15可转变为式2.17；
Figure RE-DEST_PATH_IMAGE021
（2.17）
Figure RE-DEST_PATH_IMAGE022
（2.18）
Figure RE-DEST_PATH_IMAGE024
～
Figure RE-DEST_PATH_IMAGE026
为
Figure RE-DEST_PATH_IMAGE027
矩阵中的各个元素，其中，
Figure RE-DEST_PATH_IMAGE028
（2.19）
其中
Figure RE-DEST_PATH_IMAGE030
为三角形的高与AB边的夹角，
Figure RE-DEST_PATH_IMAGE032
为液压支架立柱倾角，m1为上方激光雷达所测的到左立柱的距离加立柱半径，
Figure RE-DEST_PATH_IMAGE034
为坐标系B到坐标系C之间的距离，
Figure RE-DEST_PATH_IMAGE036
、
Figure RE-DEST_PATH_IMAGE038
、
Figure RE-DEST_PATH_IMAGE040
分别为坐标系C到坐标系D在Z、X、Y三个方向上的投影长度；
Figure RE-171353DEST_PATH_IMAGE027
矩阵中其余各项均为0，如式2.20所示；
Figure RE-DEST_PATH_IMAGE042
(2.20)
至此，采煤机基准坐标系A表示的任意一点（XA,YA，ZA）均可在液压支架基准坐标系D中表示，选定坐标系A的原点作为采煤机的定位基准点。
10.一种如权利要求2所述的基于激光雷达的采煤机虚实融合定位系统中参数预处理模块的处理方法，其特征在于：包括两部分修正，
第一部分修正～根据数据修正系统修正后的液压支架俯仰角和倾角传感器采集到的采煤机横滚角将液压支架和采煤机的相对姿态关系进行分类，针对不同情况对
Figure 78185DEST_PATH_IMAGE027
进行修正，其中θ2液压支架立柱倾角，h 1为上方激光雷达到两立柱连线的距离，h 2为下方激光雷达到两立柱连线的距离，获取不同底板条件下的液压支架立柱倾角θ2的表达式，对于修正过程中涉及到的角度由角度判定算法通过与参数所对应的原角度作差完成角度正负值的判定，具体修正过程如下：
设由
Figure 166227DEST_PATH_IMAGE027
直接解算得到的角度为
Figure 433261DEST_PATH_IMAGE028
，液压支架的俯仰角为
Figure 304265DEST_PATH_IMAGE029
，采煤机的横滚角为
Figure 973143DEST_PATH_IMAGE030
，则液压支架与采煤机的相对姿态关系可分为五种情况；
当
Figure 232086DEST_PATH_IMAGE029
=
Figure 406322DEST_PATH_IMAGE030
=0，即判定情况为（1）时，修正后
Figure 408913DEST_PATH_IMAGE031
=
Figure 932299DEST_PATH_IMAGE028
；
当
Figure 34247DEST_PATH_IMAGE029
>0,
Figure 275872DEST_PATH_IMAGE030
>0，即判定情况为（2）时，修正后
Figure 3526DEST_PATH_IMAGE031
=
Figure 381417DEST_PATH_IMAGE028
+
Figure 982163DEST_PATH_IMAGE029
-
Figure 383189DEST_PATH_IMAGE030
；
当
Figure 727582DEST_PATH_IMAGE029
>0,
Figure 225560DEST_PATH_IMAGE030
<0，即判定情况为（3）时，修正后
Figure 420043DEST_PATH_IMAGE031
=
Figure 636261DEST_PATH_IMAGE028
+
Figure 518766DEST_PATH_IMAGE029
+
Figure 808933DEST_PATH_IMAGE030
；
当
Figure 485902DEST_PATH_IMAGE029
<0,
Figure 923837DEST_PATH_IMAGE030
<0，即判定情况为（4）时，修正后
Figure 796983DEST_PATH_IMAGE031
=
Figure 3974DEST_PATH_IMAGE028
-
Figure 117423DEST_PATH_IMAGE029
+
Figure 980337DEST_PATH_IMAGE030
；
当
Figure 204645DEST_PATH_IMAGE029
<0,
Figure 234785DEST_PATH_IMAGE030
>0，即判定情况为（5）时，修正后
Figure 519136DEST_PATH_IMAGE031
=
Figure 666084DEST_PATH_IMAGE028
-
Figure 631766DEST_PATH_IMAGE029
-
Figure 299DEST_PATH_IMAGE030
；
不同情况的判定过程通过参数预处理模块中的角度判定算法对
Figure 455551DEST_PATH_IMAGE029
、
Figure 355374DEST_PATH_IMAGE030
的角度正负值进行判定完成；
第二部分修正～根据数据修正系统修正后的液压支架横滚角和倾角传感器采集到的采煤机俯仰角将液压支架和采煤机的相对姿态关系进行分类，针对不同情况下列公式2.1、2.2进行修正，
Figure 859168DEST_PATH_IMAGE032
（2.1）
Figure 895257DEST_PATH_IMAGE033
（2.2）
获取不同底板条件下雷达到两立柱连线的距离
Figure 521410DEST_PATH_IMAGE034
、
Figure 331365DEST_PATH_IMAGE035
的表达式，具体修正过程如下：
设由式2.1直接解算得到的距离为p 1，液压支架的横滚角为
Figure 701167DEST_PATH_IMAGE036
，采煤机的俯仰角为
Figure 795025DEST_PATH_IMAGE037
，则液压支架与采煤机的相对姿态关系可分为五种情况，
当
Figure 592080DEST_PATH_IMAGE036
=
Figure 200915DEST_PATH_IMAGE037
=0，即判定情况为（1）时，修正后：
Figure 295779DEST_PATH_IMAGE038
；
当
Figure 306461DEST_PATH_IMAGE036
>0,
Figure 212100DEST_PATH_IMAGE037
>0，即判定情况为（2）时，
修正后；
Figure 308232DEST_PATH_IMAGE039
；
当
Figure 19836DEST_PATH_IMAGE036
>0,
Figure 836089DEST_PATH_IMAGE037
<0，即判定情况为（3）时，
修正后；
Figure 974946DEST_PATH_IMAGE040
；
当
Figure 292795DEST_PATH_IMAGE036
<0,
Figure 745773DEST_PATH_IMAGE037
>0，即判定情况为（4）时，
修正后；
Figure 731046DEST_PATH_IMAGE041
；
当
Figure 40805DEST_PATH_IMAGE036
<0,
Figure 32901DEST_PATH_IMAGE037
<0，即判定情况为（5）时，
修正后；
Figure 86307DEST_PATH_IMAGE042
；
不同情况的判定过程通过参数预处理模块中的角度判定算法对
Figure 863770DEST_PATH_IMAGE036
、
Figure 344430DEST_PATH_IMAGE037
的角度正负值进行判定完成；
h 2的修正方法与h 1相同，将修正后θ2、h 1、h 2代入计算完成复杂底板条件下采煤机的相对定位。
CN202111507050.5A 2021-12-10 2021-12-10 一种基于激光雷达的采煤机虚实融合定位系统 Active CN114970073B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202111507050.5A CN114970073B (zh) 2021-12-10 2021-12-10 一种基于激光雷达的采煤机虚实融合定位系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202111507050.5A CN114970073B (zh) 2021-12-10 2021-12-10 一种基于激光雷达的采煤机虚实融合定位系统

Publications (2)

Publication Number Publication Date
CN114970073A true CN114970073A (zh) 2022-08-30
CN114970073B CN114970073B (zh) 2024-04-02

Family

ID=82975343

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202111507050.5A Active CN114970073B (zh) 2021-12-10 2021-12-10 一种基于激光雷达的采煤机虚实融合定位系统

Country Status (1)

Country Link
CN (1) CN114970073B (zh)

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CA2815831A1 (en) * 2012-09-21 2014-03-21 Komatsu Ltd. Working vehicle periphery monitoring system and working vehicle
WO2019007439A1 (zh) * 2017-07-04 2019-01-10 中国矿业大学 基于采煤机震源超前探测的采煤机自动调高装置及方法
CN113051756A (zh) * 2021-03-24 2021-06-29 太原理工大学 一种虚实融合的采煤机记忆截割试验系统和方法

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CA2815831A1 (en) * 2012-09-21 2014-03-21 Komatsu Ltd. Working vehicle periphery monitoring system and working vehicle
WO2019007439A1 (zh) * 2017-07-04 2019-01-10 中国矿业大学 基于采煤机震源超前探测的采煤机自动调高装置及方法
CN113051756A (zh) * 2021-03-24 2021-06-29 太原理工大学 一种虚实融合的采煤机记忆截割试验系统和方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
方章云;袁亮;侯爱萍;吴金强;: "基于单目视觉与里程计的组合室内定位研究", 组合机床与自动化加工技术, no. 12, 20 December 2019 (2019-12-20) *
贾文;李玉虎;丰界泽;赵义;邸晟钧;刘顺;闫孝姮;: "基于记忆割煤方法的采煤机监控系统设计", 煤炭工程, no. 01, 20 January 2020 (2020-01-20) *

Also Published As

Publication number Publication date
CN114970073B (zh) 2024-04-02

Similar Documents

Publication Publication Date Title
CN110815180B (zh) 六自由度并联机器人运动分析建模及快速求解方法
CN108534679B (zh) 一种筒形件轴线位姿的无靶标自动测量装置及方法
CN109579831B (zh) 矿用悬臂式掘进机可视化辅助导引方法和系统
CN108801142B (zh) 一种特大尺寸工件双移动测量机器人系统及方法
CN110033489B (zh) 一种车辆定位准确性的评估方法、装置及设备
CN113128109B (zh) 一种面向智能化综采机器人生产系统的测试与评估方法
CN103899338B (zh) 一种基于空间坐标变换的液压支架工作姿态确定方法
Cho et al. A framework for rapid local area modeling for construction automation
CN112050732B (zh) 一种悬臂式掘进机空间位姿自动检测方法及系统
CN114004869A (zh) 一种基于3d点云配准的定位方法
CN113124797B (zh) 一种基于可调节底板的液压支架群位姿模拟系统
US20210354299A1 (en) External parameter calibration method for robot sensors and apparatus, robot and storage medium with the same
KR20200034869A (ko) 굴삭기 전용 3d 스캐너를 이용한 토공 지형정보 실시간 모델링 시스템 및 방법
Li et al. Virtual straightening of scraper conveyor based on the position and attitude solution of industrial robot model
CN117769691A (zh) 基于路点的导航地图的拓扑处理
CN117291959A (zh) 基于激光slam的工作面整体工作空间虚拟重构方法
Qingqing et al. Multi-modal lidar dataset for benchmarking general-purpose localization and mapping algorithms
Wang et al. A new method for measuring the attitude and straightness of hydraulic support groups based on point clouds
Horváth et al. Point cloud based robot cell calibration
CN113778096B (zh) 室内机器人的定位与模型构建方法及系统
Wang et al. A control method for hydraulic manipulators in automatic emulsion filling
Zeng et al. Measurement method and experiment of hydraulic support group attitude and straightness based on binocular vision
CN114970073A (zh) 一种基于激光雷达的采煤机虚实融合定位系统
CN111075489B (zh) 一种液压支架与刮板输送机浮动连接机构姿态描述方法
CN114170400A (zh) 基于三维点云的液压支架群空间直线度测量与调整方法

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant