CN112229394B - 基于红外运动捕捉的煤矿井下移动设备定位定姿系统 - Google Patents

基于红外运动捕捉的煤矿井下移动设备定位定姿系统 Download PDF

Info

Publication number
CN112229394B
CN112229394B CN202011096677.1A CN202011096677A CN112229394B CN 112229394 B CN112229394 B CN 112229394B CN 202011096677 A CN202011096677 A CN 202011096677A CN 112229394 B CN112229394 B CN 112229394B
Authority
CN
China
Prior art keywords
infrared
lens
distance
mobile equipment
identification point
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.)
Active
Application number
CN202011096677.1A
Other languages
English (en)
Other versions
CN112229394A (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.)
Jiangsu Zhongji Mine Equipment Co ltd
China University of Mining and Technology CUMT
Original Assignee
Jiangsu Zhongji Mine Equipment Co ltd
China University of Mining and Technology CUMT
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 Jiangsu Zhongji Mine Equipment Co ltd, China University of Mining and Technology CUMT filed Critical Jiangsu Zhongji Mine Equipment Co ltd
Priority to CN202011096677.1A priority Critical patent/CN112229394B/zh
Publication of CN112229394A publication Critical patent/CN112229394A/zh
Application granted granted Critical
Publication of CN112229394B publication Critical patent/CN112229394B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/005—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
    • E—FIXED CONSTRUCTIONS
    • E21—EARTH OR ROCK DRILLING; MINING
    • E21D—SHAFTS; TUNNELS; GALLERIES; LARGE UNDERGROUND CHAMBERS
    • E21D9/00—Tunnels or galleries, with or without linings; Methods or apparatus for making thereof; Layout of tunnels or galleries
    • E—FIXED CONSTRUCTIONS
    • E21—EARTH OR ROCK DRILLING; MINING
    • E21F—SAFETY DEVICES, TRANSPORT, FILLING-UP, RESCUE, VENTILATION, OR DRAINING IN OR OF MINES OR TUNNELS
    • E21F13/00—Transport specially adapted to underground conditions
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20—Instruments for performing navigational calculations
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Mining & Mineral Resources (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • General Life Sciences & Earth Sciences (AREA)
  • Geochemistry & Mineralogy (AREA)
  • Geology (AREA)
  • Manufacturing & Machinery (AREA)
  • Environmental & Geological Engineering (AREA)
  • Mechanical Engineering (AREA)
  • Length Measuring Devices By Optical Means (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明公开了一种基于红外运动捕捉的煤矿井下移动设备定位定姿系统，包括红外姿态捕捉数据采集模块(2)、姿态校准模块(3)、移动设备刚体建模模块(4)、移动设备位姿解算模块(5)；所述红外姿态捕捉数据采集模块(2)布置在煤矿井下巷道(1‑1)两侧壁面上方，用于巷道内移动设备(1‑2)的位姿参数采集；所述姿态校准模块(3)用于定位定姿系统初始化的标定和校准；所述移动设备刚体建模模块(4)按照移动设备特征布置于移动设备(1‑2)表面，用于构建移动设备刚体模型(4‑2)；所述移动设备位姿解算模块(5)用于测量数据的处理，并对移动设备的位姿进行实时解算和显示。其突破现有定位技术在井下的环境限制问题。

Description

基于红外运动捕捉的煤矿井下移动设备定位定姿系统
技术领域
本发明涉及煤矿井下移动设备定位技术领域，尤其涉及一种基于红外运动捕捉的煤矿井下移动设备定位定姿系统。
背景技术
巷道是煤矿井下的典型环境，掘进机、煤矿机器人及运输车等为矿井巷道最常见的移动设备，普遍面临着工作环境恶劣，电磁环境复杂，高粉尘和低光照等难题，移动设备的精确位姿确定成为煤矿智能化发展的关键问题。诸多矿井移动设备组合导航措施被提出，已有煤矿井下移动设备定位方法通常基于惯性测量单元、倾角仪、超宽带节点、RFID、激光雷达、机器视觉、全站仪、里程计、磁力计或几种方式的联合方法进行，但现有基于惯性传感器的定位方式存在误差发散的不足，超宽带节点定位容易受巷道避免反射而产生的多径效应出现定位偏移，RFID定位误差较大无法适用于狭长巷道环境下的移动设备定位，激光雷达和全站仪的定位方式应用最为广泛但价格昂贵且需要频繁移动定位基站，机器视觉及工业相机对于高粉尘和低光照下的目标定位效果较差，里程计定位误差无法应对移动设备在井下湿滑路面出现的滑移现象，而磁力计和电子罗盘受井下复杂的电磁环境影响严重且定位精度低，基于多种定位方式组合的移动设备定位方法或可减弱部分环境影响，但仍尚无在定位精度、巷道环境和定位成本中取得一种较为平衡的位姿确定方式，能为实现煤矿智能化提供可靠的技术支撑。
发明内容
针对以上问题，本发明提出一种基于红外运动捕捉的煤矿井下移动设备定位定姿系统，能够解决现有技术中煤矿井下移动设备位姿无法实时准确估计的问题。
为实现本发明的目的，提供一种基于红外运动捕捉的煤矿井下移动设备定位定姿系统，包括红外姿态捕捉数据采集模块、姿态校准模块、移动设备刚体建模模块、移动设备位姿解算模块；
所述红外姿态捕捉数据采集模块布置在煤矿井下巷道两侧壁面上方，用于巷道内移动设备的位姿参数采集；所述姿态校准模块用于定位定姿系统初始化的标定和校准；所述移动设备刚体建模模块按照移动设备特征布置于移动设备表面，用于构建移动设备刚体模型；所述移动设备位姿解算模块用于测量数据的处理，并对移动设备的位姿进行实时解算和显示。
在一个实施例中，所述红外姿态捕捉数据采集模块包括多个红外捕捉镜头、距离采集系统和数据集成转换装置，距离采集系统集成在红外捕捉镜头装置中并一同安装在巷道壁面上方，红外捕捉镜头之间间隔设定距离，并布置在巷道两侧以保证巷道中移动设备机体的标识点能够全时域的被3个以上的红外捕捉镜头捕捉，红外捕捉镜头发射红外光谱，红外光谱经过移动设备机体上安装的标识点反射后，由距离采集系统采集到并计算出标识点与红外捕捉镜头的距离；所述数据集成转换装置通过网线与红外捕捉镜头和移动设备位姿解算模块中的系统计算机相连接，用于实现所有红外标识点在所有红外捕捉镜头中的距离数据集成和转换，并将距离数据集成和转换得到的结果发送至所述移动设备位姿解算模块。
在一个实施例中，所述姿态校准模块包括设定数量的红外标识点，所述姿态校准模块放置在所有红外捕捉镜头采集范围内，红外捕捉镜头和数据集成转换装置获取姿态校准模块中所有红外标识点的距离数据，通过姿态校准模块中标识点的实际间距反推出系统定位定姿系统的距离与真实距离的映射关系，实现该定位定姿系统在启动初始化时的标定和校准。
在一个实施例中，所述移动设备刚体建模标识模块包括若干红外标识点、由标识点连接成的移动设备刚体模型，若干标识点按照目标移动设备的结构特征固定布置在机体各关节上并能够完全反应机体各关节的运动特征，按照一定的构型规则将红外标识点在软件中连接并定义为机体刚体模型。
在一个实施例中，所述移动设备位姿解算模块包括系统计算机和位姿转换软件；系统计算机连接红外姿态捕捉数据采集模块的数据集成转换装置，用于集成采集的数据并进行统计处理，位姿转换软件用于进行移动设备刚体模型的自由度位姿的实时解算和输出。
具体地，移动设备位姿解算模块在计算得到红外标识点的距离数据后，结合移动设备刚体模型，转换得到移动设备的位姿数据。
具体地，所述移动设备包括巷道内的第一运输车和第二运输车；所述红外捕捉镜头包括第一镜头、第二镜头和第三镜头，红外标识点包括第一标识点、第二标识点、第三标识点、第四标识点、第五标识点、第六标识点、第七标识点、第八标识点和第九标识点；第一运输车上设置第一标识点、第二标识点、第三标识点和第四标识点；第二运输车上设置第六标识点、第七标识点、第八标识点和第九标识点；第一运输车和第二运输车的连接点处设置第五标志点；红外捕捉镜头发射红外光谱，红外光谱经过移动设备机体上安装的标识点反射后，由距离采集系统采集到并计算出标识点与红外捕捉镜头的距离，第一标志点至第一镜头的距离为V1C1，第一标志点至第二镜头的距离为V1C2，第一标志点至第三镜头的距离为V1C3；第二标志点至第一镜头的距离为V2C1，第二标志点至第二镜头的距离为V2C2，第二标志点至第三镜头的距离为V2C3；第三标志点至第一镜头的距离为V3C1，第三标志点至第二镜头的距离为V3C2，第三标志点至第三镜头的距离为V3C3；第四标志点至第一镜头的距离为V4C1，第四标志点至第二镜头的距离为V4C2，第四标志点至第三镜头的距离为V4C3；第五标志点至第一镜头的距离为V5C1，第五标志点至第二镜头的距离为V5C2，第五标志点至第三镜头的距离为V5C3；第六标志点至第一镜头的距离为V6C1，第六标志点至第二镜头的距离为V6C2，第六标志点至第三镜头的距离为V6C3；第七标志点至第一镜头的距离为V7C1，第七标志点至第二镜头的距离为V7C2，第七标志点至第三镜头的距离为V7C3；第八标志点至第一镜头的距离为V8C1，第八标志点至第二镜头的距离为V8C2，第八标志点至第三镜头的距离为V8C3；第九标志点至第一镜头的距离为V9C1，第九标志点至第二镜头的距离为V9C2，第九标志点至第三镜头的距离为V9C3；
第一镜头的位置点为C1(xc1,yc1,zc1)，第二镜头的位置点为C2(xc2,yc2,zc2)，第三镜头的位置点为C3(xc3,yc3,zc3)；第一标识点的坐标为V1(x1,y1,z1)，第二标识点的坐标为V2(x2,y2,z2)，第三标识点的坐标为V3(x3,y3,z3)，第四标识点的坐标为V4(x4,y4,z4)，第五标识点的坐标为V5(x5,y5,z5)，第六标识点的坐标为V6(x6,y6,z6)，第七标识点的坐标为V7(x7,y7,z7)，第八标识点的坐标为V8(x8,y8,z8)，第九标识点的坐标为V9(x9,y9,z9)；
第一运输车的位置Vm(xm,ym,zm)和第二运输车的第二位置Vn(xn,yn,zn)为：
第一运输车的姿态Am(γm,θm,ψm)、第二运输车的姿态An(γn,θn,ψn)，以及第一运输车和第二运输车之间的相对位姿Amn(γmn,θmn,ψmn)包括：
在一个实施例中，所述移动设备刚体建模模块的工作过程包括：
a、由技术人员提前获取移动设备中各主体转动部件和移动部件的分类、运动部件的结构组成划分；
b、根据移动设备操作工艺和运动部件的结构组成划分来设定机体红外标识点的布置位置；
c、根据各镜头捕捉所有红外标识点在机体上的位置并在系统计算机和位姿转换软件中查看，根据步骤a中的主体转动部件和移动部件的分类情况依次连接各部件所属的红外标识点，形成移动设备刚体模型。
上述基于红外运动捕捉的煤矿井下移动设备定位定姿系统具有如下技术效果：
完全适用于煤矿井下巷道条件，突破现有定位技术在井下的环境限制问题。
基于红外运动捕捉进行煤矿井下移动设备的刚体系统模型搭建，通过对移动设备刚体模型进行运动部件划分来独立精确计算各个部件的6自由度位姿参数，提升了现有位姿测量手段的精度。
采用直接法测量机体表面红外标识点的位置参数，避免了现有位姿测量方法受电磁干扰和机体振动影响较大的难题，提升煤矿井下移动设备定位定姿的实时性和鲁棒性。
附图说明
图1是一个实施例中基于红外运动捕捉的煤矿井下移动设备定位定姿系统结构示意图；
图2是一个实施例中系统标定和校准示意图；
图3是一个实施例中煤矿井下移动设备刚体建模示意图；
图4是一个实施例中煤矿井下移动设备位姿解算示意图；
图5为一个实施例中基于红外运动捕捉的煤矿井下移动设备定位定姿方法流程图；
附图中各个标号的含义包括：1-1表示煤矿井下巷道，1-2表示巷道内的移动设备(如掘进机)，2表示红外姿态捕捉数据采集模块，2-1表示红外捕捉镜头，2-2表示距离采集系统，2-3表示数据集成转换装置，3表示姿态校准模块，4表示移动设备刚体建模模块，4-1表示红外标识点，4-2表示移动设备刚体模型，4-2-1表示移动设备刚体模型部件1，4-2-2表示移动设备刚体模型部件2，5表示移动设备位姿解算模块，5-1表示系统计算机，5-2表示位姿转换软件。
具体实施方式
为了使本申请的目的、技术方案及优点更加清楚明白，以下结合附图及实施例，对本申请进行进一步详细说明。应当理解，此处描述的具体实施例仅仅用以解释本申请，并不用于限定本申请。
在本文中提及“实施例”意味着，结合实施例描述的特定特征、结构或特性可以包含在本申请的至少一个实施例中。在说明书中的各个位置出现该短语并不一定均是指相同的实施例，也不是与其它实施例互斥的独立的或备选的实施例。本领域技术人员显式地和隐式地理解的是，本文所描述的实施例可以与其它实施例相结合。
参考图1所示，图1为一个实施例的基于红外运动捕捉的煤矿井下移动设备定位定姿系统结构示意图，包括红外姿态捕捉数据采集模块2、姿态校准模块3、移动设备刚体建模模块4、移动设备位姿解算模块5；
所述红外姿态捕捉数据采集模块2布置在煤矿井下巷道1-1两侧壁面上方，用于巷道内移动设备1-2的位姿参数采集；所述姿态校准模块3用于定位定姿系统初始化的标定和校准；所述移动设备刚体建模模块4按照移动设备特征布置于移动设备1-2表面，用于构建移动设备1-2刚体模型4-2；所述移动设备位姿解算模块5用于测量数据的处理，并对移动设备的位姿进行实时解算和显示。
上述移动设备1-2主要包括巷道掘进机、运输车、连续采煤机、掘锚一体机、煤矿机器人及运输车等轮式和/或履带移动设备装备等。
上述红外姿态捕捉数据采集模块2中的红外捕捉镜头2-1数量可以随着巷道环境的不断延伸而不断增加。红外捕捉镜头2-1之间的间距应与红外光强度及镜头(红外捕捉镜头)属性相对应。红外捕捉镜头2-1、数据集成转换装置2-3、系统计算机5-1等硬件均为本质安全型，以适应煤矿井下环境。
在一个实施例中，所述红外姿态捕捉数据采集模块2包括多个红外捕捉镜头2-1、距离采集系统2-2和数据集成转换装置2-3，距离采集系统2-2集成在红外捕捉镜头2-1装置中并一同安装在巷道1-1壁面上方，红外捕捉镜头之间间隔设定距离，并布置在巷道两侧以保证巷道中移动设备1-2机体的标识点能够全时域的被3个以上的红外捕捉镜头2-1捕捉，红外捕捉镜头2-1发射红外光谱，红外光谱经过移动设备1-2机体上安装的标识点4-1反射后，由距离采集系统2-2采集到并计算出标识点4-1与红外捕捉镜头2-1的距离；所述数据集成转换装置2-3通过网线与红外捕捉镜头2-1和移动设备位姿解算模块5中的系统计算机5-1相连接，用于实现所有红外标识点4-1在所有红外捕捉镜头2-1中的距离数据集成和转换，并将距离数据集成和转换得到的结果发送至所述移动设备位姿解算模块5。
在一个实施例中，如图2所示，所述姿态校准模块3包括设定数量的红外标识点4-1(一般为4个标识点的T型装置)，各个红外标识点4-1形成红外标识装置，上述红外标识装置具有固定尺寸和形状，所述姿态校准模块3放置在所有红外捕捉镜头2-1采集范围内，红外捕捉镜头2-1和数据集成转换装置2-3获取姿态校准模块3中所有红外标识点4-1的距离数据，通过姿态校准模块3中标识点的实际间距反推出系统定位定姿系统的距离与真实距离的映射关系，实现该定位定姿系统在启动初始化时的标定和校准。
在一个实施例中，所述移动设备刚体建模标识模块4包括若干红外标识点4-1、由标识点4-1连接成的移动设备刚体模4-2，若干标识点4-1按照目标移动设备1-2的结构特征固定布置在机体各关节上并能够完全反应机体各关节的运动特征，按照一定的构型规则将红外标识点4-1在软件中连接并定义为机体刚体模型4-2。
在一个实施例中，参考图3所示，所述移动设备刚体建模模块4构建移动设备刚体模型4-2的过程包括：
a、由技术人员提前获取移动设备1-2中各主体转动部件和移动部件的分类、运动部件的结构组成划分；即获取移动设备1-2的结构和运动特性，主要包括各主体转动部件和移动部件的分类、运动部件的结构组成划分。
b、根据移动设备操作工艺和运动部件的结构组成划分来设定机体红外标识点4-1的布置位置。
c、根据各镜头2-1捕捉所有红外标识点4-1在机体上的位置并在系统计算机5-1和位姿转换软件5-2中查看，根据步骤a中的主体转动部件和移动部件的分类情况依次连接各部件所属的红外标识点4-1，形成移动设备刚体模型4-2。
优选地，所述移动设备刚体模型4-2在能够反映移动设备结构、运动特性和冗余度的基础上尽可能少的红外标识点4-1，以减小系统的实时计算量。
在一个实施例中，所述移动设备位姿解算模块5包括系统计算机5-1和位姿转换软件5-2；系统计算机5-1连接红外姿态捕捉数据采集模块2的数据集成转换装置2-3，用于集成采集的数据并进行统计处理，位姿转换软件5-2用于进行移动设备刚体模型4-2的自由度位姿的实时解算和输出。
具体地，移动设备位姿解算模块5在计算得到红外标识点4-1的距离数据后，结合移动设备刚体模型4-2，转换得到移动设备1-2的位姿数据。
具体地，参考图4所示，以巷道运输车为例，所述移动设备1-2包括巷道内的第一运输车和第二运输车；所述红外捕捉镜头2-1包括第一镜头、第二镜头和第三镜头，红外标识点4-1包括第一标识点、第二标识点、第三标识点、第四标识点、第五标识点、第六标识点、第七标识点、第八标识点和第九标识点；第一运输车上设置第一标识点、第二标识点、第三标识点和第四标识点；第二运输车上设置第六标识点、第七标识点、第八标识点和第九标识点；第一运输车和第二运输车的连接点处设置第五标志点；红外捕捉镜头2-1发射红外光谱，红外光谱经过移动设备1-2机体上安装的标识点反射后，由距离采集系统2-2采集到并计算出标识点与红外捕捉镜头2-1的距离，第一标志点至第一镜头的距离为V1C1，第一标志点至第二镜头的距离为V1C2，第一标志点至第三镜头的距离为V1C3；第二标志点至第一镜头的距离为V2C1，第二标志点至第二镜头的距离为V2C2，第二标志点至第三镜头的距离为V2C3；第三标志点至第一镜头的距离为V3C1，第三标志点至第二镜头的距离为V3C2，第三标志点至第三镜头的距离为V3C3；第四标志点至第一镜头的距离为V4C1，第四标志点至第二镜头的距离为V4C2，第四标志点至第三镜头的距离为V4C3；第五标志点至第一镜头的距离为V5C1，第五标志点至第二镜头的距离为V5C2，第五标志点至第三镜头的距离为V5C3；第六标志点至第一镜头的距离为V6C1，第六标志点至第二镜头的距离为V6C2，第六标志点至第三镜头的距离为V6C3；第七标志点至第一镜头的距离为V7C1，第七标志点至第二镜头的距离为V7C2，第七标志点至第三镜头的距离为V7C3；第八标志点至第一镜头的距离为V8C1，第八标志点至第二镜头的距离为V8C2，第八标志点至第三镜头的距离为V8C3；第九标志点至第一镜头的距离为V9C1，第九标志点至第二镜头的距离为V9C2，第九标志点至第三镜头的距离为V9C3；
第一镜头的位置点为C1(xc1,yc1,zc1)，第二镜头的位置点为C2(xc2,yc2,zc2)，第三镜头的位置点为C3(xc3,yc3,zc3)；第一标识点的坐标为V1(x1,y1,z1)，第二标识点的坐标为V2(x2,y2,z2)，第三标识点的坐标为V3(x3,y3,z3)，第四标识点的坐标为V4(x4,y4,z4)，第五标识点的坐标为V5(x5,y5,z5)，第六标识点的坐标为V6(x6,y6,z6)，第七标识点的坐标为V7(x7,y7,z7)，第八标识点的坐标为V8(x8,y8,z8)，第九标识点的坐标为V9(x9,y9,z9)；
第一运输车的位置Vm(xm,ym,zm)和第二运输车的第二位置Vn(xn,yn,zn)为：
第一运输车的姿态Am(γm,θm,ψm)、第二运输车的姿态An(γn,θn,ψn)，以及第一运输车和第二运输车之间的相对位姿Amn(γmn,θmn,ψmn)包括：
在一个示例中，上述第一运输车的位置Vm(xm,ym,zm)、第二运输车的第二位置Vn(xn,yn,zn)、第一运输车的姿态Am(γm,θm,ψm)、第二运输车的姿态An(γn,θn,ψn)，以及第一运输车和第二运输车之间的相对位姿Amn(γmn,θmn,ψmn)的推导过程可以包括：
在一个实施例中，参考图5所示，上述基于红外运动捕捉的煤矿井下移动设备定位定姿系统的使用过程包括：
a、启动基于红外运动捕捉的煤矿井下巷道移动设备定位定姿系统，为红外姿态捕捉数据采集模块2和移动设备位姿解算模块5通电，设定红外捕捉镜头2-1数量和网络IP地址；
b、将姿态校准模块放置3在红外捕捉镜头2-1视野中，调整红外捕捉镜头2-1的焦距和进光量使得捕捉点完整且清晰，完成系统尺度标定；多次将姿态校准模块3动态布置在红外捕捉镜头2-1视野范围内，使校准模块能将所有区域扫描，即完成系统校准；
c、根据目标移动设备的结构特征和运动特点将红外标识点4-1固定在移动设备1-2机体表面易于观察的位置，并使用相应刚体模型构建方法进行煤矿巷道目标移动设备刚体模型4-2的构建；
d、实时移动目标移动设备1-2，移动设备位姿解算模块5实时获取目标移动设备的机体标识点4-1距离，通过集成数据转换解算得到移动设备特定点和指定部件的位置和姿态，并实时输出和显示。
本实施例能够实时捕捉煤矿井下巷道移动设备的自由度位姿参数，对巷道移动设备进行结构和运动分析后在巷道移动设备表面布置红外标识点，建立巷道移动设备的刚体模型，通过红外捕捉镜头实时获取巷道移动设备机体表面外红标识点的距离而获得巷道移动设备的位姿参数，实时掌握巷道移动设备的运行状态和形式轨迹，增强煤矿井下移动设备的定位定姿精度和鲁棒性，能够为煤矿井下巷道移动设备的智能化控制和自动化作业提供条件。
需要说明的是，本申请实施例所涉及的术语“第一\第二\第三”仅仅是区别类似的对象，不代表针对对象的特定排序，可以理解地，“第一\第二\第三”在允许的情况下可以互换特定的顺序或先后次序。应该理解“第一\第二\第三”区分的对象在适当情况下可以互换，以使这里描述的本申请的实施例能够以除了在这里图示或描述的那些以外的顺序实施。
本申请实施例的术语“包括”和“具有”以及它们任何变形，意图在于覆盖不排他的包含。例如包含了一系列步骤或模块的过程、方法、装置、产品或设备没有限定于已列出的步骤或模块，而是可选地还包括没有列出的步骤或模块，或可选地还包括对于这些过程、方法、产品或设备固有的其它步骤或模块。
以上所述实施例仅表达了本申请的几种实施方式，其描述较为具体和详细，但并不能因此而理解为对发明专利范围的限制。应当指出的是，对于本领域的普通技术人员来说，在不脱离本申请构思的前提下，还可以做出若干变形和改进，这些都属于本申请的保护范围。因此，本申请专利的保护范围应以所附权利要求为准。

Claims (5)

1.一种基于红外运动捕捉的煤矿井下移动设备定位定姿系统，其特征在于，包括红外姿态捕捉数据采集模块(2)、姿态校准模块(3)、移动设备刚体建模模块(4)、移动设备位姿解算模块(5)；
所述红外姿态捕捉数据采集模块(2)布置在煤矿井下巷道(1-1)两侧壁面上方，用于巷道内移动设备(1-2)的位姿参数采集；所述姿态校准模块(3)用于定位定姿系统初始化的标定和校准；所述移动设备刚体建模模块(4)按照移动设备特征布置于移动设备(1-2)表面，用于构建移动设备刚体模型(4-2)；所述移动设备位姿解算模块(5)用于测量数据的处理，并对移动设备的位姿进行实时解算和显示；
所述红外姿态捕捉数据采集模块(2)包括多个红外捕捉镜头(2-1)、距离采集系统(2-2)和数据集成转换装置(2-3)；
所述姿态校准模块(3)包括设定数量的红外标识点(4-1)，所述姿态校准模块(3)放置在所有红外捕捉镜头(2-1)采集范围内，红外捕捉镜头(2-1)和数据集成转换装置(2-3)获取姿态校准模块(3)中所有红外标识点(4-1)的距离数据，通过姿态校准模块(3)中红外标识点(4-1)的实际间距反推出定位定姿系统的距离与真实距离的映射关系，实现该定位定姿系统在启动初始化时的标定和校准；
所述移动设备位姿解算模块(5)包括系统计算机(5-1)和位姿转换软件(5-2)；系统计算机(5-1)连接红外姿态捕捉数据采集模块(2)的数据集成转换装置(2-3)，用于集成采集的数据并进行统计处理，位姿转换软件(5-2)用于进行移动设备刚体模型(4-2)的自由度位姿的实时解算和输出；
所述移动设备刚体建模模块(4)的工作过程包括：
a、由技术人员提前获取移动设备(1-2)中各主体转动部件和移动部件的分类、运动部件的结构组成划分；
b、根据移动设备操作工艺和运动部件的结构组成划分来设定机体红外标识点(4-1)的布置位置；
c、根据各镜头(2-1)捕捉所有红外标识点(4-1)在机体上的位置并在系统计算机(5-1)和位姿转换软件(5-2)中查看，根据步骤a中的主体转动部件和移动部件的分类情况依次连接各部件所属的红外标识点(4-1)，形成移动设备刚体模型(4-2)。
2.根据权利要求1所述的基于红外运动捕捉的煤矿井下移动设备定位定姿系统，其特征在于，距离采集系统(2-2)集成在红外捕捉镜头(2-1)装置中并一同安装在巷道(1-1)壁面上方，红外捕捉镜头之间间隔设定距离，并布置在巷道两侧以保证巷道中移动设备(1-2)机体的红外标识点(4-1)能够全时域的被3个以上的红外捕捉镜头(2-1)捕捉，红外捕捉镜头(2-1)发射红外光谱，红外光谱经过移动设备(1-2)机体上安装的红外标识点(4-1)反射后，由距离采集系统(2-2)采集到并计算出红外标识点(4-1)与红外捕捉镜头(2-1)的距离；所述数据集成转换装置(2-3)通过网线与红外捕捉镜头(2-1)和移动设备位姿解算模块(5)中的系统计算机(5-1)相连接，用于实现所有红外标识点(4-1)在所有红外捕捉镜头(2-1)中的距离数据集成和转换，并将距离数据集成和转换得到的结果发送至所述移动设备位姿解算模块(5)。
3.根据权利要求1所述的基于红外运动捕捉的煤矿井下移动设备定位定姿系统，其特征在于，所述移动设备刚体建模模块(4)包括若干红外标识点(4-1)、由红外标识点(4-1)连接成的移动设备刚体模型(4-2)，若干红外标识点(4-1)按照移动设备(1-2)的结构特征固定布置在机体各关节上并能够完全反应机体各关节的运动特征，将红外标识点(4-1)在软件中连接并定义为移动设备刚体模型(4-2)。
4.根据权利要求1所述的基于红外运动捕捉的煤矿井下移动设备定位定姿系统，其特征在于，移动设备位姿解算模块(5)在计算得到红外标识点(4-1)的距离数据后，结合移动设备刚体模型(4-2)，转换得到移动设备(1-2)的位姿数据。
5.根据权利要求4所述的基于红外运动捕捉的煤矿井下移动设备定位定姿系统，其特征在于，所述移动设备(1-2)包括巷道内的第一运输车和第二运输车；红外捕捉镜头(2-1)包括第一镜头、第二镜头和第三镜头，红外标识点(4-1)包括第一标识点、第二标识点、第三标识点、第四标识点、第五标识点、第六标识点、第七标识点、第八标识点和第九标识点；第一运输车上设置第一标识点、第二标识点、第三标识点和第四标识点；第二运输车上设置第六标识点、第七标识点、第八标识点和第九标识点；第一运输车和第二运输车的连接点处设置第五标识点；红外捕捉镜头(2-1)发射红外光谱，红外光谱经过移动设备(1-2)机体上安装的标识点反射后，由距离采集系统(2-2)采集到并计算出标识点与红外捕捉镜头(2-1)的距离，第一标识点至第一镜头的距离为V1C1，第一标识点至第二镜头的距离为V1C2，第一标识点至第三镜头的距离为V1C3；第二标识点至第一镜头的距离为V2C1，第二标识点至第二镜头的距离为V2C2，第二标识点至第三镜头的距离为V2C3；第三标识点至第一镜头的距离为V3C1，第三标识点至第二镜头的距离为V3C2，第三标识点至第三镜头的距离为V3C3；第四标识点至第一镜头的距离为V4C1，第四标识点至第二镜头的距离为V4C2，第四标识点至第三镜头的距离为V4C3；第五标识点至第一镜头的距离为V5C1，第五标识点至第二镜头的距离为V5C2，第五标识点至第三镜头的距离为V5C3；第六标识点至第一镜头的距离为V6C1，第六标识点至第二镜头的距离为V6C2，第六标识点至第三镜头的距离为V6C3；第七标识点至第一镜头的距离为V7C1，第七标识点至第二镜头的距离为V7C2，第七标识点至第三镜头的距离为V7C3；第八标识点至第一镜头的距离为V8C1，第八标识点至第二镜头的距离为V8C2，第八标识点至第三镜头的距离为V8C3；第九标识点至第一镜头的距离为V9C1，第九标识点至第二镜头的距离为V9C2，第九标识点至第三镜头的距离为V9C3；
第一镜头的位置点为C1(xc1,yc1,zc1)，第二镜头的位置点为C2(xc2,yc2,zc2)，第三镜头的位置点为C3(xc3,yc3,zc3)；第一标识点的坐标为V1(x1,y1,z1)，第二标识点的坐标为V2(x2,y2,z2)，第三标识点的坐标为V3(x3,y3,z3)，第四标识点的坐标为V4(x4,y4,z4)，第五标识点的坐标为V5(x5,y5,z5)，第六标识点的坐标为V6(x6,y6,z6)，第七标识点的坐标为V7(x7,y7,z7)，第八标识点的坐标为V8(x8,y8,z8)，第九标识点的坐标为V9(x9,y9,z9)；
第一运输车的位置Vm(xm,ym,zm)和第二运输车的第二位置Vn(xn,yn,zn)为：
第一运输车的姿态Am(γm,θm,ψm)、第二运输车的姿态An(γn,θn,ψn)，以及第一运输车和第二运输车之间的相对位姿Amn(γmn,θmn,ψmn)包括：
CN202011096677.1A 2020-10-14 2020-10-14 基于红外运动捕捉的煤矿井下移动设备定位定姿系统 Active CN112229394B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202011096677.1A CN112229394B (zh) 2020-10-14 2020-10-14 基于红外运动捕捉的煤矿井下移动设备定位定姿系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202011096677.1A CN112229394B (zh) 2020-10-14 2020-10-14 基于红外运动捕捉的煤矿井下移动设备定位定姿系统

Publications (2)

Publication Number Publication Date
CN112229394A CN112229394A (zh) 2021-01-15
CN112229394B true CN112229394B (zh) 2024-04-16

Family

ID=74113578

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202011096677.1A Active CN112229394B (zh) 2020-10-14 2020-10-14 基于红外运动捕捉的煤矿井下移动设备定位定姿系统

Country Status (1)

Country Link
CN (1) CN112229394B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115388911A (zh) * 2022-08-24 2022-11-25 Oppo广东移动通信有限公司 光学动作捕捉系统的精度测量方法、装置、电子设备

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103323813A (zh) * 2013-06-05 2013-09-25 天地（常州）自动化股份有限公司 矿井机车信标定位系统及其定位方法
CN104729538A (zh) * 2015-04-03 2015-06-24 中国矿业大学 基于激光扫描的采煤机定位定姿系统的校准方法及装置
CN106600627A (zh) * 2016-12-07 2017-04-26 成都通甲优博科技有限责任公司 一种基于标志点的刚体运动捕捉方法及系统
WO2018219062A1 (zh) * 2017-05-31 2018-12-06 中国矿业大学 一种采煤机绝对位姿检测方法
WO2019095149A1 (zh) * 2017-11-15 2019-05-23 深圳市瑞立视多媒体科技有限公司 一种刚体配置方法、装置、终端设备和计算机存储介质

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103323813A (zh) * 2013-06-05 2013-09-25 天地（常州）自动化股份有限公司 矿井机车信标定位系统及其定位方法
CN104729538A (zh) * 2015-04-03 2015-06-24 中国矿业大学 基于激光扫描的采煤机定位定姿系统的校准方法及装置
CN106600627A (zh) * 2016-12-07 2017-04-26 成都通甲优博科技有限责任公司 一种基于标志点的刚体运动捕捉方法及系统
WO2018219062A1 (zh) * 2017-05-31 2018-12-06 中国矿业大学 一种采煤机绝对位姿检测方法
WO2019095149A1 (zh) * 2017-11-15 2019-05-23 深圳市瑞立视多媒体科技有限公司 一种刚体配置方法、装置、终端设备和计算机存储介质

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
基于红外视频的矿井机车监控研究;韩永峰 等;煤矿机械;第34卷(第10期);全文 *
煤矿辅助运输机器人关键技术研究;袁晓明 等;工矿自动化;第46卷(第8期);全文 *

Also Published As

Publication number Publication date
CN112229394A (zh) 2021-01-15

Similar Documents

Publication Publication Date Title
AU2018295572B2 (en) Real time position and orientation tracker
US10509983B2 (en) Operating device, operating system, operating method, and program therefor
US10972717B2 (en) Automated feature analysis of a structure
CN107830854A (zh) 基于orb稀疏点云与二维码的视觉定位方法
US9183638B2 (en) Image based position determination
CN106855411A (zh) 一种机器人及其以深度摄像头和避障系统构建地图的方法
CN106289235A (zh) 基于建筑结构图的自主计算精度可控室内定位导航方法
CN111595342B (zh) 一种可大规模部署的室内定位方法及系统
Yang et al. Infrared LEDs-based pose estimation with underground camera model for boom-type roadheader in coal mining
US20220282967A1 (en) Method and mobile detection unit for detecting elements of infrastructure of an underground line network
WO2020075954A1 (ko) 다종 센서 기반의 위치인식 결과들을 혼합한 위치 측위 시스템 및 방법
CN110675455A (zh) 一种基于自然场景的车身环视相机自标定方法和系统
CN109540140A (zh) 一种融合ssd目标识别和里程计信息的移动机器人定位方法
CN112229394B (zh) 基于红外运动捕捉的煤矿井下移动设备定位定姿系统
KR20160027605A (ko) 사용자기기의 실내 위치를 측정하기 위한 측위방법 및 이를 구현하기 위한 장치
CN106225779A (zh) 基于三激光标记点图像的掘进机定位系统及定位方法
KR100564236B1 (ko) 이동 로봇의 자기위치인식 장치 및 방법
KR101720097B1 (ko) 사용자 기기의 측위방법
JP6289317B2 (ja) モデル化データ算出方法及びモデル化データ算出装置
CN112684797B (zh) 一种障碍物地图构建方法
US8717579B2 (en) Distance measuring device using a method of spanning separately targeted endpoints
CN111536976A (zh) 一种校园穿梭防控系统
CN111881899B (zh) 机器人的定位部署方法、装置、设备及存储介质
KR100939213B1 (ko) 인공 표식물의 위치 획득 장치 및 그 방법
CN115932879B (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
TA01 Transfer of patent application right

Effective date of registration: 20231108

Address after: 221116 No. 1 Tongshan University Road, Xuzhou City, Jiangsu Province

Applicant after: CHINA University OF MINING AND TECHNOLOGY

Applicant after: JIANGSU ZHONGJI MINE EQUIPMENT Co.,Ltd.

Address before: 221116 No. 1 Tongshan University Road, Xuzhou City, Jiangsu Province

Applicant before: CHINA University OF MINING AND TECHNOLOGY

TA01 Transfer of patent application right
GR01 Patent grant
GR01 Patent grant