[go: up one dir, main page]

CN114803861B - 一种煤矿井下单轨吊车高精度定位系统及定位方法 - Google Patents

一种煤矿井下单轨吊车高精度定位系统及定位方法 Download PDF

Info

Publication number
CN114803861B
CN114803861B CN202210402959.2A CN202210402959A CN114803861B CN 114803861 B CN114803861 B CN 114803861B CN 202210402959 A CN202210402959 A CN 202210402959A CN 114803861 B CN114803861 B CN 114803861B
Authority
CN
China
Prior art keywords
positioning
monorail crane
coordinate
unit
coordinate positioning
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
CN202210402959.2A
Other languages
English (en)
Other versions
CN114803861A (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.)
China University of Mining and Technology CUMT
Xuzhou Liren Monorail Transportation Equipment Co Ltd
Original Assignee
China University of Mining and Technology CUMT
Xuzhou Liren Monorail Transportation Equipment Co Ltd
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 China University of Mining and Technology CUMT, Xuzhou Liren Monorail Transportation Equipment Co Ltd filed Critical China University of Mining and Technology CUMT
Priority to CN202210402959.2A priority Critical patent/CN114803861B/zh
Publication of CN114803861A publication Critical patent/CN114803861A/zh
Priority to PCT/CN2022/123325 priority patent/WO2023201993A1/zh
Priority to AU2022348883A priority patent/AU2022348883A1/en
Priority to US18/247,874 priority patent/US12187332B2/en
Application granted granted Critical
Publication of CN114803861B publication Critical patent/CN114803861B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B61—RAILWAYS
    • B61L—GUIDING RAILWAY TRAFFIC; ENSURING THE SAFETY OF RAILWAY TRAFFIC
    • B61L25/00—Recording or indicating positions or identities of vehicles or trains or setting of track apparatus
    • B61L25/02—Indicating or recording positions or identities of vehicles or trains
    • B61L25/026—Relative localisation, e.g. using odometer
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B66—HOISTING; LIFTING; HAULING
    • B66C—CRANES; LOAD-ENGAGING ELEMENTS OR DEVICES FOR CRANES, CAPSTANS, WINCHES, OR TACKLES
    • B66C13/00—Other constructional features or details
    • B66C13/18—Control systems or devices
    • B66C13/46—Position indicators for suspended loads or for crane elements
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B66—HOISTING; LIFTING; HAULING
    • B66C—CRANES; LOAD-ENGAGING ELEMENTS OR DEVICES FOR CRANES, CAPSTANS, WINCHES, OR TACKLES
    • B66C11/00—Trolleys or crabs, e.g. operating above runways
    • B66C11/02—Trolleys or crabs, e.g. operating above runways with operating gear or operator's cabin suspended, or laterally offset, from runway or track
    • B66C11/04—Underhung trolleys
    • B66C11/06—Underhung trolleys running on monorails
    • 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/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • 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/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B61—RAILWAYS
    • B61B—RAILWAY SYSTEMS; EQUIPMENT THEREFOR NOT OTHERWISE PROVIDED FOR
    • B61B13/00—Other railway systems
    • B61B13/02—Rack railways
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
    • B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
    • B65G17/00—Conveyors having an endless traction element, e.g. a chain, transmitting movement to a continuous or substantially-continuous load-carrying surface or to a series of individual load-carriers; Endless-chain conveyors in which the chains form the load-carrying surface
    • B65G17/30—Details; Auxiliary devices
    • B65G17/48—Controlling attitudes of load-carriers during movement
    • B65G17/485—Controlling attitudes of load-carriers during movement the load carriers being suspended
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
    • B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
    • B65G19/00—Conveyors comprising an impeller or a series of impellers carried by an endless traction element and arranged to move articles or materials over a supporting surface or underlying material, e.g. endless scraper conveyors
    • B65G19/02—Conveyors comprising an impeller or a series of impellers carried by an endless traction element and arranged to move articles or materials over a supporting surface or underlying material, e.g. endless scraper conveyors for articles, e.g. for containers
    • B65G19/025—Conveyors comprising an impeller or a series of impellers carried by an endless traction element and arranged to move articles or materials over a supporting surface or underlying material, e.g. endless scraper conveyors for articles, e.g. for containers for suspended articles

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Mechanical Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Mining & Mineral Resources (AREA)
  • General Physics & Mathematics (AREA)
  • Physics & Mathematics (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • General Life Sciences & Earth Sciences (AREA)
  • Geochemistry & Mineralogy (AREA)
  • Geology (AREA)
  • Control And Safety Of Cranes (AREA)
  • Length Measuring Devices With Unspecified Measuring Means (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明公开了一种煤矿井下单轨吊车高精度定位系统及定位方法，该系统包括对称设置在工字钢轨道两侧的两个齿架；齿架上设有定位轮和若干行走轮，行走轮在工字钢轨道底板的上端面上行走，定位轮与工字钢轨道底板下端的齿条啮合传动；齿架上还设有安装架和用于连接单轨吊车的连接座，安装架上设有电性连接在一起的惯性测量单元与单片机；定位轮上设有转角传感器，转角传感器电性连接单片机；单轨吊车两端的车头上设有坐标更新单元；其利用定位轮与工字钢轨道上齿条的高精度啮合，再通过计算定位轮位移来实现单轨吊车的高精度定位。

Description

一种煤矿井下单轨吊车高精度定位系统及定位方法
技术领域
本发明涉及煤矿井下单轨吊车定位领域，具体涉及一种煤矿井下单轨吊车高精度定位系统及定位方法。
背景技术
单轨吊机车是专门运行在矿山巷道上空的特制工字钢上的一种有轨机车。随着井下无人化的发展，出于对单轨吊车驾驶员的安全考虑，需要对单轨吊机车的位置进行高精度的定位，以便于对无人驾驶的单轨吊车进行精准控制。但是由于单轨吊机车工作的矿山巷道中无法使用GPS信号，因此现有技术中一般采用UWB等定位技术进行单轨吊机车的位置定位。而UWB定位技术依靠网络信号，因此需要在单轨吊机车运行途中布设网络设备和基站，建造维护成本高。而且如果一旦出现任何一个网络设备出现故障，则会导致UWB定位出现问题，进而无法准确的对单轨吊机车的位置进行定位。因此，如何实现对单轨吊机车位置的高精度定位，实现智能化矿山的无人化发展要求，是本领域亟待解决的技术问题。
发明内容
针对上述存在的技术不足，本发明的目的是提供一种煤矿井下单轨吊车高精度定位系统及定位方法，其利用定位轮与工字钢轨道上齿条的高精度啮合，再通过计算定位轮位移来实现单轨吊车的高精度定位。
为解决上述技术问题，本发明采用如下技术方案：
本发明提供一种煤矿井下单轨吊车高精度定位系统及定位方法，包括齿轮式位移计量装置和若干均布在工字钢轨道上的坐标定位单元；所述齿轮式位移计量装置包括对称设置在工字钢轨道两侧的两个齿架，两个所述齿架固定连接在一起；
所述齿架上设有定位轮和若干行走轮，所述行走轮在工字钢轨道底板的上端面上行走，所述定位轮与工字钢轨道底板下端的齿条啮合传动；
所述齿架上还设有安装架和用于连接单轨吊车的连接座，所述安装架上设有电性连接在一起的惯性测量单元与单片机；
所述定位轮上还设有用于检测其转动角度的转角传感器，所述转角传感器电性连接单片机；
单轨吊车两端的车头上均设有能够与坐标定位单元传输信号的坐标更新单元，所述坐标更新单元电性连接单片机。
本发明还提供一种煤矿井下单轨吊车高精度定位系统的定位方法，包括以下步骤：
步骤S1：在计算机中建立所有工字钢轨道的全局路线；
步骤S2：利用惯性测量单元拾取单轨吊车的位姿信息，用来辨别单轨吊车的运行方向，绘制单轨吊车行走过程中的实时路线；
步骤S3：布置好坐标定位单元，获取坐标定位单元包含所处位置的三维坐标信息；
步骤S4：在相邻两个坐标定位单元之间，单片机利用转角传感器传输到的角度信息计算获得单轨吊车的行走里程数，结合惯性测量单元测得的方向信息，计算出单轨吊车在前进方向上行走的距离，结合单轨吊车在上一个坐标定位单元在全局路线中的坐标位置，获得单轨吊车在两个坐标定位单元之间的精确三维坐标位置；
步骤S5：当单轨吊经过坐标定位单元时，坐标定位单元对单轨吊车的精确位置进行矫正，更新单轨吊车在全局路线中的三维坐标位置；
同时，惯性测量单元与转角传感器传输的数据自动初始化，以更新点为起点，在下两个坐标定位单元之间按照步骤4中所述方法进行定位；
步骤S6：重复步骤S4-步骤S5，实时并精准显示单轨吊车在全局路线中的三维坐标位置。
优选地，步骤S1的具体方法为：
S1-1、事先采用激光雷达对工字钢轨道进行扫描，获得工字钢轨道及附近无关的点云数据，并将其传输至计算机中；
S1-2、对工字钢轨道及附近无关的点云数据进行处理，滤除无关点云数据，仅保留工字钢轨道的点云数据，并在计算机中将工字钢轨道的点云数据实体化，获得工字钢轨道的三维实体模型；
S1-3、根据工字钢轨道的三维实体模型，以工字钢轨道底面的中心线作为全局路线，并在计算机中赋予全局路线中每一点三维坐标，将坐标化后的全局路线传输至单片机中。
优选地，步骤S2中惯性测量单元的应用场景如下：
S2-1单轨吊车在直线路段前后运动时，所述惯性测量单元识别单轨吊车的行走方向；
S2-2单轨吊车进入道岔时，所述惯性测量单元识别单轨吊车究竟进入了哪条道岔。
优选地，步骤S3中，坐标定位单元的布置方式为：
首先，在单轨吊车的接入工字钢轨道的初始点及每个道岔口处均设置一个坐标定位单元；
然后，在上述已按照好的相邻的两个坐标定位单元之间，再按照间隔距离 d安装若干个坐标定位单元；
当安装到第个k个坐标定位单元与下一个道岔口处的坐标定位单元之间的距离s为d<s<2d时，再安装第k+1个坐标定位单元；
当安装到第k个坐标定位单元与下一个道岔口处的坐标定位单元之间的距离s为0<s<d时，停止安装第k+1个坐标定位单元；
最后，按照上述方法，完成所有坐标定位单元的安装。
优选地，步骤S3中，距离d的确定步骤如下：
首先，根据所选惯性测量单元对应品牌型号的技术参数，算出时间累计误差函数f(t)；
然后，然后，设定惯性测量单元的最大容许时间累计误差为△max，令 f(t1)＝△max，解算出t1，结合单轨吊车的平均运行速度v，这里取运行距离d ≤v*t1，同时还要小于等于定位轮产生最大位移误差时的行走距离。
优选地，单片机计算单轨吊车的行走里程数的方法为：设S为单轨吊车的位移，L为定位轮分度圆所旋转过的总弧长，n为定位轮的旋转角度，r为定位轮的分度圆半径，则S＝L＝nr。
优选地，所述坐标定位单元为条形码，所述条形码中包含其在所述全局路线中的坐标位置；所述坐标更新单元为激光扫描仪，所述激光扫描仪通过扫描坐标定位单元，对单轨吊车的位置进行更新。
本发明的有益效果在于：
1、本发明通过计算定位轮的旋转弧长能够精确地计算出单轨吊车的行走里程，结合构建的工字钢轨道的全局路线，能够精确地确定出单轨吊车在工字钢轨道上的所在位置，且本发明的定位精度与定位轮的尺寸有关系，可以通过减定位轮的齿距来提高定位精度；
2、本发明与目前较多使用的里程计相比，里程计测量里程数时，里程计安装于车轮上，但车辆在行驶过程中，车轮会有打滑现象，本发明通过齿轮啮合的方式降低了因车轮打滑带来的计算误差，提高了定位精度；
3、本发明中单轨吊车每经过一个坐标定位单元，就会对惯性测量单元和转角传感器的信息进行数据初始化，降低了惯性测量单元因时间累计所带来的计算误差。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。
图1为本发明实施例提供的一种煤矿井下单轨吊车高精度定位系统的结构示意图；
图2为本发明实施例提供的单片机安装位置示意图；
图3为本发明实施例提供的两个定位轮之间的位置关系示意图；
图4为本发明实施例提供的一种煤矿井下单轨吊车高精度定位系统在单轨吊车上的安装示意图；
图5为本发明实施例提供的图4中B部放大图；
图6为本发明实施例提供的坐标定位单元安装组成的全局路线图。
附图标记说明：
1-工字钢轨道；2-行走轮；3-连杆；4-定位轮；5-横杆；6-固定架；7-转角传感器；9-连接座；12-单片机；13-惯性测量单元；18-安装架；19-齿条； 24-坐标更新单元；26-电源；29-坐标定位单元。
具体实施方式
下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
如图1至图6所示，一种煤矿井下单轨吊车高精度定位系统，包括
齿轮式位移计量装置和若干均布在工字钢轨道1上的坐标定位单元29；
所述齿轮式位移计量装置包括对称设置在工字钢轨道1两侧的两个齿架，两个所述齿架固定连接在一起；
所述齿架上设有定位轮4和若干行走轮2，所述行走轮2在工字钢轨道1 底板的上端面上行走，所述定位轮4与工字钢轨道1底板下端的齿条19啮合传动；所述定位轮4的齿距很小，满足其定位精度比惯性测量单元13的定位精度更高。
所述齿架上还设有安装架18和用于连接单轨吊车的连接座9，所述安装架 18上设有电性连接在一起的惯性测量单元13与单片机12；
所述定位轮4上还设有用于检测其转动角度的转角传感器7，所述转角传感器7电性连接单片机12；
单轨吊车两端的车头上均设有能够与坐标定位单元29传输信号的坐标更新单元24，所述坐标更新单元24电性连接单片机12。
单片机12与外部控制中心通讯连接，用于通过外部控制中心对其进行控制与显示。
所述齿架包括连杆3，所述连杆3的两端对称设有两个行走轮2，所述连杆3两端还对称固定有两个固定架6，其中一个固定架6远离行走轮2的一端固定安装架18，另一个固定架6远离行走轮2的一端固定连接座9，两个定位轮4转动连接在同一个转轴上，转轴的两端分别转动连接有支撑板，所述支撑板上固定有两个横杆5，两个横杆5分别与同侧的两个固定架6固定连接。
本发明还提供一种煤矿井下单轨吊车高精度定位系统的定位方法，包括以下步骤：
步骤S1：在计算机中建立所有工字钢轨道1的全局路线；
步骤S1的具体方法为：
S1-1、事先采用激光雷达对工字钢轨道1进行扫描，获得工字钢轨道1及附近无关的点云数据，并将其传输至计算机中；
S1-2、对工字钢轨道1及附近无关的点云数据进行处理，滤除无关点云数据，仅保留工字钢轨道1的点云数据，并在计算机中将工字钢轨道1的点云数据实体化，获得工字钢轨道1的三维实体模型；
S1-3、根据工字钢轨道1的三维实体模型，以工字钢轨道1底面的中心线作为全局路线，并在计算机中赋予全局路线中每一点三维坐标，将坐标化后的全局路线传输至单片机12中。
步骤S2：利用惯性测量单元13拾取单轨吊车的位姿信息，用来辨别单轨吊车的运行方向，绘制单轨吊车行走过程中的实时路线；
惯性测量单元13的应用场景如下：
S2-1单轨吊车在直线路段前后运动时，所述惯性测量单元13识别单轨吊车的行走方向；
S2-2单轨吊车进入道岔时，所述惯性测量单元13识别单轨吊车究竟进入了哪条道岔。
步骤S3：布置好坐标定位单元29，获取坐标定位单元29包含所处位置的三维坐标信息；
坐标定位单元29的布置方式为：
首先，在单轨吊车的接入工字钢轨道1的初始点及每个道岔口处均设置一个坐标定位单元29；
然后，在上述已按照好的相邻的两个坐标定位单元29之间，再按照间隔距离d安装若干个坐标定位单元29；
当安装到第个k个坐标定位单元29与下一个道岔口处的坐标定位单元29 之间的距离s为d<s<2d时，再安装第k+1个坐标定位单元29；
当安装到第k个坐标定位单元29与下一个道岔口处的坐标定位单元29之间的距离s为0<s<d时，停止安装第k+1个坐标定位单元29；
最后，按照上述方法，完成所有坐标定位单元29的安装。
步骤S3中，距离d的确定步骤如下：
首先，根据所选惯性测量单元13对应品牌型号的技术参数，算出时间累计误差函数f(t)；
然后，设定惯性测量单元13的最大容许时间累计误差为△max，令f(t1)＝△max，解算出t1，结合单轨吊车的平均运行速度v，这里取运行距离d≤v*t1，同时还要小于等于定位轮4产生最大位移误差时的行走距离。
步骤S4：在相邻两个坐标定位单元29之间，单片机12利用转角传感器7 传输到的角度信息计算获得单轨吊车的行走里程数，结合惯性测量单元13测得的方向信息，计算出单轨吊车在前进方向上行走的距离，结合单轨吊车在上一个坐标定位单元29在全局路线中的坐标位置，获得单轨吊车在两个坐标定位单元29之间的精确三维坐标位置；
单片机12计算单轨吊车的行走里程数的方法为：设S为单轨吊车的位移， L为定位轮4分度圆所旋转过的总弧长，n为定位轮4的旋转角度，r为定位轮的分度圆半径，则S＝L＝nr。
步骤S5：当单轨吊经过坐标定位单元29时，坐标定位单元29对单轨吊车的精确位置进行矫正，更新单轨吊车在全局路线中的三维坐标位置；
同时，惯性测量单元13与转角传感器7传输的数据自动初始化，以更新点为起点，在下两个坐标定位单元29之间按照步骤4中所述方法进行定位；
步骤S6：重复步骤S4-步骤S5，实时并精准显示单轨吊车在全局路线中的三维坐标位置。
所述坐标定位单元29为条形码，所述条形码中包含其在所述全局路线中的坐标位置；所述坐标更新单元24为激光扫描仪，所述激光扫描仪通过扫描坐标定位单元29，对单轨吊车的位置进行更新。
本发明中，一方面，所述转角传感器7优选为MCJS型号的角度传感器，仅从转角传感器7自身的特性来说，测量角度误差约为0.05％，则单轨吊车每行走100m，行走误差约为5cm。另一方面，可通过减小齿距提高定位轮4的定位精度，若定位轮4的齿距为5mm,则所述单片机12计算定位轮4的位移时则是以5mm为单位增加，同理，若定位轮4的齿距为1mm,则所述单片机12计算定位轮4的位移时则是以1mm为单位增加，增加单位越小，则定位更加准确，此外还可以通过调节坐标定位单元29的位置，进一步提高定位轮4的定位精度，本发明的定位精度是可控的。
与UWB定位技术相比，UWB定位技术由于使用无线信号传输手段，室内定位精度始终只能达到10cm，且井下环境复杂，定位精度更差。
与惯性测量单元13相比，一般惯性测量单元13只能输出角速度与加速度，无法直接输出位移，需要通过积分手段，但积分手段会存在时间累计误差，工作时间越长，误差越高。以高精度光纤惯导为例，单轨吊车每行走100m，行走误差约为80cm。
与现有的里程计相比，现有里程计直接装在驱动轮上进行计数，若单过吊车进行频繁启停，则驱动轮由于打滑将会造成很大的定位误差，无法满足高精度定位需求。
显然，本领域的技术人员可以对本发明进行各种改动和变型而不脱离本发明的精神和范围。这样，倘若本发明的这些修改和变型属于本发明权利要求及其等同技术的范围之内，则本发明也意图包含这些改动和变型在内。

Claims (7)

1.一种煤矿井下单轨吊车高精度定位系统的定位方法，该定位系统包括齿轮式位移计量装置和若干均布在工字钢轨道（1）上的坐标定位单元（29）；
所述齿轮式位移计量装置包括对称设置在工字钢轨道（1）两侧的两个齿架，两个所述齿架固定连接在一起；
所述齿架上设有定位轮（4）和若干行走轮（2），所述行走轮（2）在工字钢轨道（1）底板的上端面上行走，所述定位轮（4）与工字钢轨道（1） 底板下端的齿条（19）啮合传动；
所述齿架上还设有安装架（18）和用于连接单轨吊车的连接座（9），所述安装架（18）上设有电性连接在一起的惯性测量单元（13）与单片机（12）；
所述定位轮（4）上还设有用于检测其转动角度的转角传感器（7），所述转角传感器（7）电性连接单片机（12）；
单轨吊车两端的车头上均设有能够与坐标定位单元（29）传输信号的坐标更新单元（24），所述坐标更新单元（24）电性连接单片机（12），其特征在于，所述定位方法包括以下步骤：
步骤S1：在计算机中建立所有工字钢轨道（1）的全局路线；
步骤S2：利用惯性测量单元（13）拾取单轨吊车的位姿信息，用来辨别单轨吊车的运行方向，绘制单轨吊车行走过程中的实时路线；
步骤S3：布置好坐标定位单元（29），获取坐标定位单元（29）包含所处位置的三维坐标信息；
步骤S4：在相邻两个坐标定位单元（29）之间，单片机（12）利用转角传感器（7）传输到的角度信息计算获得单轨吊车的行走里程数，结合惯性测量单元（13）测得的方向信息，计算出单轨吊车在前进方向上行走的距离，结合单轨吊车在上一个坐标定位单元（29）在全局路线中的坐标位置，获得单轨吊车在两个坐标定位单元（29）之间的精确三维坐标位置；
步骤S5：当单轨吊经过坐标定位单元（29）时，坐标定位单元（29）对单轨吊车的精确位置进行矫正，更新单轨吊车在全局路线中的三维坐标位置；
同时，惯性测量单元（13）与转角传感器（7）传输的数据自动初始化，以更新点为起点，在下两个坐标定位单元（29）之间按照步骤4中所述方法进行定位；
步骤S6：重复步骤S4-步骤S5，实时并精准显示单轨吊车在全局路线中的三维坐标位置。
2.如权利要求1所述的一种煤矿井下单轨吊车高精度定位系统的定位方法，其特征在于，步骤S1的具体方法为：
S1-1、事先采用激光雷达对工字钢轨道（1）进行扫描，获得工字钢轨道（1）及附近无关的点云数据，并将其传输至计算机中；
S1-2、对工字钢轨道（1）及附近无关的点云数据进行处理，滤除无关点云数据，仅保留工字钢轨道（1）的点云数据，并在计算机中将工字钢轨道（1）的点云数据实体化，获得工字钢轨道（1）的三维实体模型；
S1-3、根据工字钢轨道（1）的三维实体模型，以工字钢轨道（1）底面的中心线作为全局路线，并在计算机中赋予全局路线中每一点三维坐标，将坐标化后的全局路线传输至单片机（12）中。
3.如权利要求2所述的一种煤矿井下单轨吊车高精度定位系统的定位方法，其特征在于，步骤S2中惯性测量单元（13）的应用场景如下：
S2-1单轨吊车在直线路段前后运动时，所述惯性测量单元（13）识别单轨吊车的行走方向；
S2-2单轨吊车进入道岔时，所述惯性测量单元（13）识别单轨吊车究竟进入了哪条道岔。
4.如权利要求3所述的一种煤矿井下单轨吊车高精度定位系统的定位方法，其特征在于，步骤S3中，坐标定位单元（29）的布置方式为：
首先，在单轨吊车的接入工字钢轨道（1）的初始点及每个道岔口处均设置一个坐标定位单元（29）；
然后，在上述已按照好的相邻的两个坐标定位单元（29）之间，再按照间隔距离d安装若干个坐标定位单元（29）；
当安装到第个k个坐标定位单元（29）与下一个道岔口处的坐标定位单元（29）之间的距离s为d<s<2d时，再安装第k+1个坐标定位单元（29）；
当安装到第k个坐标定位单元（29）与下一个道岔口处的坐标定位单元（29）之间的距离s为0<s<d时，停止安装第k+1个坐标定位单元（29）；
最后，按照上述方法，完成所有坐标定位单元（29）的安装。
5.如权利要求4所述的一种煤矿井下单轨吊车高精度定位系统的定位方法，其特征在于，步骤S3中，距离d的确定步骤如下：
首先，根据所选惯性测量单元（13）对应品牌型号的技术参数，算出时间累计误差函数f(t)；
然后，设定惯性测量单元（13）的最大容许时间累计误差为△max，令f(t1)=△max，解算出t1，结合单轨吊车的平均运行速度v，这里取运行距离d≤v*t1，同时还要小于等于定位轮（4）产生最大允许位移误差时的行走距离。
6.如权利要求1所述的一种煤矿井下单轨吊车高精度定位系统的定位方法，其特征在于，步骤S4中，单片机（12）计算单轨吊车的行走里程数的方法为：设S为单轨吊车的位移，L为定位轮（4）分度圆所旋转过的总弧长，n为定位轮（4）的旋转角度，r为定位轮的分度圆半径，则S=L=nr。
7.如权利要求1所述的一种煤矿井下单轨吊车高精度定位系统的定位方法，其特征在于，
所述坐标定位单元（29）为条形码，所述条形码中包含其在所述全局路线中的坐标位置；
所述坐标更新单元（24）为激光扫描仪，所述激光扫描仪通过扫描坐标定位单元（29），对单轨吊车的位置进行更新。
CN202210402959.2A 2022-04-18 2022-04-18 一种煤矿井下单轨吊车高精度定位系统及定位方法 Active CN114803861B (zh)

Priority Applications (4)

Application Number Priority Date Filing Date Title
CN202210402959.2A CN114803861B (zh) 2022-04-18 2022-04-18 一种煤矿井下单轨吊车高精度定位系统及定位方法
PCT/CN2022/123325 WO2023201993A1 (zh) 2022-04-18 2022-09-30 一种煤矿井下单轨吊车高精度定位系统及定位方法
AU2022348883A AU2022348883A1 (en) 2022-04-18 2022-09-30 High-precision positioning system for underground monorail hoist in coal mine and positioning method thereof
US18/247,874 US12187332B2 (en) 2022-04-18 2022-09-30 High-precision positioning system for underground monorail hoist in coal mine and positioning method thereof

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210402959.2A CN114803861B (zh) 2022-04-18 2022-04-18 一种煤矿井下单轨吊车高精度定位系统及定位方法

Publications (2)

Publication Number Publication Date
CN114803861A CN114803861A (zh) 2022-07-29
CN114803861B true CN114803861B (zh) 2023-01-24

Family

ID=82536649

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210402959.2A Active CN114803861B (zh) 2022-04-18 2022-04-18 一种煤矿井下单轨吊车高精度定位系统及定位方法

Country Status (4)

Country Link
US (1) US12187332B2 (zh)
CN (1) CN114803861B (zh)
AU (1) AU2022348883A1 (zh)
WO (1) WO2023201993A1 (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114803861B (zh) 2022-04-18 2023-01-24 中国矿业大学 一种煤矿井下单轨吊车高精度定位系统及定位方法

Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP1666400A2 (en) * 2004-12-03 2006-06-07 SCAGLIA INDEVA SpA Apparatus for lifting and moving objects
CN102139704A (zh) * 2011-02-01 2011-08-03 中国铁道科学研究院基础设施检测研究所 一种基于射频技术的高精度列车定位系统及其定位方法
CN105651280A (zh) * 2016-01-17 2016-06-08 济南大学 一种矿井无人电机车组合定位方法
CN108248635A (zh) * 2018-02-05 2018-07-06 刘春梅 一种用于轨道交通隧道的智能检测系统
CN108750942A (zh) * 2018-08-15 2018-11-06 尤洛卡（山东）矿业科技有限公司 一种单轨吊驱动装置
CN110027593A (zh) * 2019-04-12 2019-07-19 成都宇俊盛科技有限公司 一种全自动无人驾驶轨道车辆安全保障系统
CN210505275U (zh) * 2019-08-27 2020-05-12 徐州鑫泰镀锌设备有限公司 一种有轨穿梭小车
CN111252670A (zh) * 2018-11-30 2020-06-09 西华大学 一种单轨吊的同步定位方法
CN111637887A (zh) * 2020-06-01 2020-09-08 太原理工大学 一种基于惯性模块的矿用单轨吊机车定位方法
CN111806520A (zh) * 2019-04-12 2020-10-23 泰雷兹管理与服务德国股份有限公司 安全、自主地确定列车在轨道上的位置信息的方法
CN113479771A (zh) * 2021-01-26 2021-10-08 山东新沙单轨运输装备有限公司 一种单轨吊机车定位方法及系统

Family Cites Families (23)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE3844161A1 (de) * 1988-12-23 1990-07-05 Mannesmann Ag Arbeitsgeraet
US5592883A (en) * 1994-05-16 1997-01-14 Andress, Iii; F. Jay Monorail transportation system and vehicle for traveling thereon
FR2791963B1 (fr) 1999-04-09 2001-06-29 Nfm Tech Procede de chargement d'un conteneur sur une plate-forme d'un moyen de transport et installation de stockage et de manutention de conteneurs
WO2003012470A2 (en) * 2001-08-02 2003-02-13 Siemens Aktiengesellschaft Material handling systems with high frequency radio location devices
DE10348259A1 (de) * 2003-10-16 2005-05-12 Duerr Automotion Gmbh Spurgeführtes Transportsystem
AT413950B (de) * 2004-05-26 2006-07-15 Voest Alpine Ind Anlagen Stranggiessanlage mit mindestens einem roboter und verfahren zum betrieb einer stranggiessanlage unter einbindung von mindestens einem roboter
SG120230A1 (en) * 2004-08-12 2006-03-28 Inventio Ag Lift installation with a cage and equipment for detecting a cage position as well as a method of operating such a lift installation
DE102007043498A1 (de) * 2007-09-12 2009-03-19 Pepperl + Fuchs Gmbh Verfahren zur Positionierung eines Fahrzeugs sowie Positioniersysteme
JP6096596B2 (ja) * 2013-05-30 2017-03-15 三菱重工業株式会社 運行管理装置、運行管理方法、車両、車両交通システム及びプログラム
JP6337528B2 (ja) * 2014-03-10 2018-06-06 村田機械株式会社 走行車輪の劣化検出方法と検出システム、及び走行台車
CN104370210A (zh) * 2014-10-24 2015-02-25 山东鑫鹏宇矿业装备有限公司 单轨吊车齿条轨道
US10279507B2 (en) * 2016-01-08 2019-05-07 Columbia Machine, Inc. Mold transfer assembly for concrete products forming machine
CN108698759A (zh) * 2016-03-03 2018-10-23 村田机械株式会社 临时保管系统
CN108862031A (zh) * 2018-08-27 2018-11-23 太原理工大学 一种单轨吊车的驱动装置、轨道单体及单轨吊车
CN109835368B (zh) * 2019-02-25 2020-08-25 太原理工大学 一种单轨吊车用道岔装置
US10722805B1 (en) * 2019-05-23 2020-07-28 Disney Enterprises, Inc. Techniques for concealed vehicle reset
AT522764B1 (de) * 2019-08-29 2021-01-15 Plasser & Theurer Export Von Bahnbaumaschinen Gmbh Verfahren und Messfahrzeug zur Ermittlung einer Ist-Lage eines Gleises
CN212315347U (zh) * 2020-03-11 2021-01-08 北京朗信智能科技有限公司 一种位置检测装置
EP4247746A1 (de) * 2021-01-27 2023-09-27 Liebherr-Werk Biberach GmbH Hebezeug sowie verfahren zum bestimmen von schlaffseil an dem hebezeug
CN113479221B (zh) * 2021-05-10 2022-09-06 凯盛重工有限公司 一种机械式动力快速分配的单轨吊驱动单元组
CN113741442B (zh) * 2021-08-25 2022-08-02 中国矿业大学 一种基于数字孪生驱动的单轨吊车自动驾驶系统及方法
CN114261431B (zh) * 2021-12-29 2024-03-29 淮北金源工贸有限责任公司 一种用于煤矿井下运输的单轨吊道岔司控安全管理系统
CN114803861B (zh) * 2022-04-18 2023-01-24 中国矿业大学 一种煤矿井下单轨吊车高精度定位系统及定位方法

Patent Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP1666400A2 (en) * 2004-12-03 2006-06-07 SCAGLIA INDEVA SpA Apparatus for lifting and moving objects
CN102139704A (zh) * 2011-02-01 2011-08-03 中国铁道科学研究院基础设施检测研究所 一种基于射频技术的高精度列车定位系统及其定位方法
CN105651280A (zh) * 2016-01-17 2016-06-08 济南大学 一种矿井无人电机车组合定位方法
CN108248635A (zh) * 2018-02-05 2018-07-06 刘春梅 一种用于轨道交通隧道的智能检测系统
CN108750942A (zh) * 2018-08-15 2018-11-06 尤洛卡（山东）矿业科技有限公司 一种单轨吊驱动装置
CN111252670A (zh) * 2018-11-30 2020-06-09 西华大学 一种单轨吊的同步定位方法
CN110027593A (zh) * 2019-04-12 2019-07-19 成都宇俊盛科技有限公司 一种全自动无人驾驶轨道车辆安全保障系统
CN111806520A (zh) * 2019-04-12 2020-10-23 泰雷兹管理与服务德国股份有限公司 安全、自主地确定列车在轨道上的位置信息的方法
CN210505275U (zh) * 2019-08-27 2020-05-12 徐州鑫泰镀锌设备有限公司 一种有轨穿梭小车
CN111637887A (zh) * 2020-06-01 2020-09-08 太原理工大学 一种基于惯性模块的矿用单轨吊机车定位方法
CN113479771A (zh) * 2021-01-26 2021-10-08 山东新沙单轨运输装备有限公司 一种单轨吊机车定位方法及系统

Also Published As

Publication number Publication date
CN114803861A (zh) 2022-07-29
US12187332B2 (en) 2025-01-07
WO2023201993A1 (zh) 2023-10-26
AU2022348883A1 (en) 2023-11-02
US20240043247A1 (en) 2024-02-08

Similar Documents

Publication Publication Date Title
CN108981580A (zh) 一种起重机轨道在线检测装置及方法
CN108592906A (zh) 基于二维码和惯性传感器的agv复合导航方法
CN107299568A (zh) 一种轨道动态测量系统及方法
CN103207403B (zh) 一种卫星导航与惯性测量组合轨道测量系统与方法
CN110147103B (zh) 自动驾驶集装箱卡车在码头岸桥区域的车道定位方法
CN102903258A (zh) 一种车辆自动导航方法、导航图案信息编制方法及其车辆导航设备
CN102251451A (zh) 基于多源信息融合的轨道几何状态测量系统和方法
CN110203223A (zh) 一种轨道不平顺性检测装置
CN112012759A (zh) 一种用于煤矿巷道的掘进装备导航定位系统
CN111927518A (zh) 一种基于惯导与里程计组合的综采工作面液压支架自动调直方法
CN203490506U (zh) 一种车载激光自动导向控制系统
CN104859681A (zh) 一种用于轨道几何参数测量的快速精调轨道检查仪
CN114132358A (zh) 一种多平台智能化轨道综合检测系统
CN114803861B (zh) 一种煤矿井下单轨吊车高精度定位系统及定位方法
CN110631559A (zh) 一种基于惯性测量的桥式吊车轨道检测装置
CN102679974B (zh) 高速定位免换站式盾构掘进姿态实时测量方法及系统
CN118422561A (zh) 一种无人标线机器人及道路标线方法
JP3124780B2 (ja) シールド測量方法
CN201826230U (zh) 一种远距离激光测量装置
CN208314566U (zh) 一种连采机快速准直控制系统
RU2802971C1 (ru) Высокоточная система позиционирования подземной однорельсовой подвижной лебедки внутри угольной шахты и способ такого позиционирования
CN114492703B (zh) 一种基于路径规划导航的隧道定位方法、装置及打孔方法
CN211471998U (zh) 一种动态轨道几何状态测量系统
CN115014203A (zh) 一种基于激光测距仪的惯导小车三维坐标测量方法及装置
CN110626383A (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