CN113766418A - 一种基于uwb技术的姿态自校正井下运输设备及其控制方法 - Google Patents
一种基于uwb技术的姿态自校正井下运输设备及其控制方法 Download PDFInfo
- Publication number
- CN113766418A CN113766418A CN202111008694.XA CN202111008694A CN113766418A CN 113766418 A CN113766418 A CN 113766418A CN 202111008694 A CN202111008694 A CN 202111008694A CN 113766418 A CN113766418 A CN 113766418A
- Authority
- CN
- China
- Prior art keywords
- attitude
- degree
- platform
- motion platform
- clamping
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 25
- 238000005516 engineering process Methods 0.000 title claims abstract description 18
- 238000012937 correction Methods 0.000 title claims abstract description 11
- 230000033001 locomotion Effects 0.000 claims abstract description 78
- 230000007246 mechanism Effects 0.000 claims abstract description 59
- 230000008569 process Effects 0.000 claims abstract description 11
- 238000009434 installation Methods 0.000 claims description 15
- 229910000831 Steel Inorganic materials 0.000 claims description 4
- 239000010959 steel Substances 0.000 claims description 4
- 238000004364 calculation method Methods 0.000 claims description 3
- 230000008878 coupling Effects 0.000 claims description 3
- 238000010168 coupling process Methods 0.000 claims description 3
- 238000005859 coupling reaction Methods 0.000 claims description 3
- 239000007787 solid Substances 0.000 claims description 3
- 238000005065 mining Methods 0.000 description 7
- 239000003245 coal Substances 0.000 description 6
- 230000006870 function Effects 0.000 description 3
- 230000008054 signal transmission Effects 0.000 description 3
- 239000007769 metal material Substances 0.000 description 2
- 230000008447 perception Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000000007 visual effect Effects 0.000 description 2
- CWYNVVGOOAEACU-UHFFFAOYSA-N Fe2+ Chemical compound [Fe+2] CWYNVVGOOAEACU-UHFFFAOYSA-N 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 239000000428 dust Substances 0.000 description 1
- 238000004880 explosion Methods 0.000 description 1
- 230000003137 locomotive effect Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000007958 sleep Effects 0.000 description 1
- 230000002195 synergetic effect Effects 0.000 description 1
Images
Classifications
-
- 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
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/02—Services making use of location information
- H04W4/023—Services making use of location information using mutual or relative location information between multiple location based services [LBS] targets or of distance thresholds
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60P—VEHICLES ADAPTED FOR LOAD TRANSPORTATION OR TO TRANSPORT, TO CARRY, OR TO COMPRISE SPECIAL LOADS OR OBJECTS
- B60P7/00—Securing or covering of load on vehicles
- B60P7/06—Securing of load
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/02—Services making use of location information
- H04W4/029—Location-based management or tracking services
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/30—Services specially adapted for particular environments, situations or purposes
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02D—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN INFORMATION AND COMMUNICATION TECHNOLOGIES [ICT], I.E. INFORMATION AND COMMUNICATION TECHNOLOGIES AIMING AT THE REDUCTION OF THEIR OWN ENERGY USE
- Y02D30/00—Reducing energy consumption in communication networks
- Y02D30/70—Reducing energy consumption in communication networks in wireless communication networks
Landscapes
- Engineering & Computer Science (AREA)
- Mining & Mineral Resources (AREA)
- Mechanical Engineering (AREA)
- Computer Networks & Wireless Communication (AREA)
- Signal Processing (AREA)
- Life Sciences & Earth Sciences (AREA)
- Geology (AREA)
- Geochemistry & Mineralogy (AREA)
- General Life Sciences & Earth Sciences (AREA)
- Transportation (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Manipulator (AREA)
- Control And Safety Of Cranes (AREA)
Abstract
本申请涉及一种基于UWB技术的姿态自校正井下运输设备及其控制方法。该方法包括:通六自由度运动平台的上平台的上表面安装有运输夹持紧固机构;姿态感知传感组中至少包括三个UWB标签,姿态感知传感组中的UWB标签均匀布置于六自由度运动平台的上平台的侧边上,用于采集位置信息;控制模块分别与姿态感知传感组、六自由度运动平台以及运输夹持紧固机构电连接,通过发送电信号驱动六自由度运动平台和运输夹持紧固机构实现待运输物品的夹取,收集姿态感知传感组的定位信息,对六自由度运动平台的姿态进行实时解算,结合期望位姿进行姿态调整,保持运输过程的平稳,通过布置若干UWB标签获得待运输物品的实时姿态,提高了姿态感知精度,以及平稳性需求。
Description
技术领域
本申请涉及井下运输技术领域,特别是涉及一种基于UWB技术的姿态自校正井下运输设备及其控制方法。
背景技术
煤炭目前仍是中国的主要支柱能源,煤炭采掘事关国家安全,目前煤炭的主要开采方式是井下开采,但随着这些年来煤矿资源的大量开采和深度挖掘,采矿条件逐步恶劣,开采难度增加,不安全因素增多,因此,井下无人化或少人化已经成为智慧矿山的重点攻关目标,而伴随井下工作面智能化程度的提升,大量的井下设备智能化程度也在提升,传统的井下设备运输方式易受到路线环境的影响而导致设备损坏或失效,因此对这些设备在井下的平稳运输成为了当前研究热点之一。
要实现井下设备平稳运输,首要解决的就是运输车辆的装载部的姿态感知和姿态矫正控制问题。而这些方面的研究基础较为薄弱,关于姿态感知,目前常用的技术手段有视觉感知、捷联惯导感知等,但是视觉感知技术对应用环境要求较高,在煤矿井下易受到高湿、高粉尘的影响而失效,捷联惯导技术的姿态感知精度受限于传感精度,高精度传感器造价成本高,不适于大量应用,同时捷联惯导传感器易受到运输车辆自身震动导致的测量数据误差增大,进而影响姿态感知精度,容易降低井下设备运输的平稳性。
发明内容
基于此,有必要针对上述技术问题,提供一种能够提高的运输车辆的装载部的姿态感知精度的基于UWB技术的姿态自校正井下运输设备及其控制方法。
一种基于UWB技术的姿态自校正井下运输设备,所述井下运输设备包括:六自由度运动平台、运输夹持紧固机构、姿态感知传感组和控制模块;
所述六自由度运动平台的上平台的上表面安装有运输夹持紧固机构;
所述姿态感知传感组中至少包括三个UWB标签,所述姿态感知传感组中的UWB标签均匀布置于所述六自由度运动平台的上平台的侧边上,用于采集位置信息;
所述控制模块分别与所述姿态感知传感组、所述六自由度运动平台以及运输夹持紧固机构电连接,通过发送电信号驱动所述六自由度运动平台和所述运输夹持紧固机构实现待运输物品的夹取,收集姿态感知传感组的定位信息,对所述六自由度运动平台的上平台的姿态进行实时解算,结合期望位姿进行姿态调整,保持运输过程的平稳。
在其中一个实施例中,所述运输夹持紧固机构包括:夹持部件、第一支座组、第二支座组和防爆伺服电机组;
所述夹持部件包括四个相同规格的滚珠丝杠,所述滚珠丝杠具有两个相对运动的滚珠螺母,各滚珠螺母上分别固定有一个夹爪,所述防爆伺服电机组包括四个防爆伺服电机,所述第一支座组包括两个第一支撑座,所述第二支座组包括两个第二支撑座;
各所述防爆伺服电机通过联轴器对应连接在滚珠丝杠的一端,其中两个所述滚珠丝杠的另一端分别***对应的第一支撑座中,另外两个所述滚珠丝杠的另一端分别***对应的第二支撑座中,其中两个所述防爆伺服电机并排固定于所述六自由度运动平台的上平台的上表面的第一位置,另外两个所述防爆伺服电机并排固定于所述六自由度运动平台的上平台的上表面的第二位置,各所述第一支撑座并排固定于所述六自由度运动平台的上平台的上表面的第三位置,各所述第二支撑座并排固定于所述六自由度运动平台的上平台的上表面的第四位置,所述第一位置、所述第二位置、所述第三位置和所述第四位置的选择,满足四个滚珠丝杠在述六自由度运动平台的上平台的上表面呈两横两纵的#形状布置。
在其中一个实施例中,所述六自由度运动平台包括:主支架、姿态驱动机构、上平台;
所述主支架的上表面与所述姿态驱动机构的尾端活动连接,所述姿态驱动机构活动的顶端连接于所述上平台的下表面,所述上平台的上表面安装有运输夹持紧固机构。
在其中一个实施例中,所述主支架为空心钢架。
在其中一个实施例中,所述上平台为实心平台。
在其中一个实施例中,所述姿态驱动机构包括六个防爆伺服电动缸,六个所述防爆伺服电动缸分为三组姿态驱动部件;
三组所述姿态驱动部件各防爆伺服电动缸的尾端通过万向球铰分别安装于所述主支架的上表面对应的安装点上,且满足三组所述姿态驱动部件各防爆伺服电动缸的尾端对应的安装点连接形成第一等边三角形;
所述三组所述姿态驱动部件各防爆伺服电动缸的顶端通过铰链分别安装于所述上平台的下表面对应的安装点上,且满足三组所述姿态驱动部件各防爆伺服电动缸的顶端对应的安装点连接形成第二等边三角形;
所述第一等边三角形的边大于第二等边三角形。
在其中一个实施例中,每一组姿态驱动部件的两个所述防爆伺服电动缸的尾端分别通过万向球铰并排安装于对应的安装点上;每一组姿态驱动部件的两个所述防爆伺服电动缸的顶端分别通过铰链并排安装于对应的安装点上。
在其中一个实施例中,所述控制模块是基于STM32平台的嵌入式核心控制器。
在其中一个实施例中,所述控制模块布置于所述六自由度运动平台的上平台上。
一种基于UWB技术的姿态自校正井下运输设备的控制方法,所述方法包括:
根据接收到的开始指令,向运输夹持紧固机构发送张开电信号,使所述运输夹持紧固机构的夹爪张开到最大;
向六自由度运动平台发送位置调整电信号,使六自由度运动平台的上平台移动至待运输物品的夹取位置;
当接收到所述待运输物品已放置的指令时,向运输夹持紧固机构发送夹持信号,使所述运输夹持紧固机构的夹爪夹紧所述待运输物品;
向姿态感知传感组发送唤醒信号,唤醒所述姿态感知传感组的各个UWB标签;
收集姿态感知传感组的初始定位信息进行姿态解算,获得所述六自由度运动平台的上平台的初始空间位姿;
判断所述初始空间位姿是否满足预设目标位姿;
不满足所述预设目标位姿时,发送位置调整电信号,使六自由度运动平台的上平台调整至满足所述预设目标位姿;
将满足所述预设目标位姿的空间位姿设为期望位姿;
当接收到的开始运输指令后,实时收集姿态感知传感组的定位信息,根据所述定位信息实时进行空间位姿解算,确定当前空间位姿;
根据所述期望位姿与所述当前空间位姿分析,确定是否需要进行姿态调整;
当需要进行姿态调整时,根据所述期望位姿与所述当前空间位姿解算出姿态调整参数,根据所述姿态调整参数发送位置调整电信号,控制六自由度运动平台的上平台调整至期望位姿。
上述基于UWB技术的姿态自校正井下运输设备及其控制方法,通过六自由度运动平台的上平台的上表面安装有运输夹持紧固机构;姿态感知传感组中至少包括三个UWB标签,姿态感知传感组中的UWB标签均匀布置于六自由度运动平台的上平台的侧边上,用于采集位置信息;控制模块分别与姿态感知传感组、六自由度运动平台以及运输夹持紧固机构电连接,通过发送电信号驱动六自由度运动平台和运输夹持紧固机构实现待运输物品的夹取,收集姿态感知传感组的定位信息,对六自由度运动平台的上平台的姿态进行实时解算,结合期望位姿进行姿态调整,保持运输过程的平稳。在姿态自感知方面,摒弃了易受干扰的高成本传统方案,借助矿井井下已有的普遍布置的UWB定位网络***,通过额外布置若干UWB标签采集定位信息并实时结算即可获得待运输物品的实时等效姿态,可有效减小成本,且提高了姿态感知精度,满足了井下设备运输的平稳性需求。
附图说明
图1为一个实施例中基于UWB技术的姿态自校正井下运输设备的结构示意图;
图2为一个实施例中基于UWB技术的姿态自校正井下运输设备的控制方法的流程示意图。
具体实施方式
为了使本申请的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本申请进行进一步详细说明。应当理解,此处描述的具体实施例仅仅用以解释本申请,并不用于限定本申请。
在一个实施例中,一种基于UWB技术的姿态自校正井下运输设备,包括:六自由度运动平台、运输夹持紧固机构、姿态感知传感组和控制模块10;
六自由度运动平台的上平台20的上表面安装有运输夹持紧固机构;姿态感知传感组中至少包括三个UWB标签30,姿态感知传感组中的UWB标签30均匀布置于六自由度运动平台的上平台20的侧边上,用于采集位置信息;控制模块10分别与姿态感知传感组、六自由度运动平台以及运输夹持紧固机构电连接,通过发送电信号驱动六自由度运动平台和运输夹持紧固机构实现待运输物品的夹取,收集姿态感知传感组的定位信息,对六自由度运动平台的上平台的姿态进行实时解算,结合期望位姿进行姿态调整,保持运输过程的平稳。
其中,各UWB标签30具有对应的编号,用于区分各UWB标签30的定位信息。控制模块10可以是计算机,也可以是嵌入式核心控制器等。控制模块10主要作用是收集UWB标签30的定位信息并本地实数运算解算出六自由度运动平台的上平台20的上表面的自身实时位姿,同时与期望位姿进行比较运输,求解出驱动信号并输出至姿态驱动机构,驱动姿态驱动机构配合工作进行姿态矫正,同时还起到对运输夹持紧固机构进行驱动。控制模块10的安装位置包括但不限于井下运输车辆车身上、运输主体的主支架40上、运输主体的六自由度运动平台的上平台20上等,可为该控制模块10提供安装基础的位置,为方便起见,控制模块10安装于运输主体的六自由度运动平台的上平台20上。
如图1所示,在一个实施例中,运输夹持紧固机构包括:所述运输夹持紧固机构包括:夹持部件、第一支座组、第二支座组和防爆伺服电机组;夹持部件包括四个相同规格的滚珠丝杠51,滚珠丝杠51具有两个相对运动的滚珠螺母,各滚珠螺母上分别固定有一个夹爪52,防爆伺服电机组包括四个防爆伺服电机53,第一支座组包括两个第一支撑座54,第二支座组包括两个第二支撑座55。
各防爆伺服电机53通过联轴器对应连接在滚珠丝杠51的一端,其中两个滚珠丝杠51的另一端分别***对应的第一支撑座54中,另外两个滚珠丝杠51的另一端分别***对应的第二支撑座55中,其中两个防爆伺服电机53并排固定于六自由度运动平台的上平台20的上表面的第一位置,另外两个防爆伺服电机53并排固定于六自由度运动平台的上平台20的上表面的第二位置,各第一支撑座54并排固定于六自由度运动平台的上平台20的上表面的第三位置,各第二支撑座55并排固定于六自由度运动平台的上平台20的上表面的第四位置,第一位置、第二位置、第三位置和第四位置的选择,满足四个滚珠丝杠在述六自由度运动平台的上平台20的上表面呈两横两纵的#形状布置。
其中,运输夹持紧固机构的主要作用是夹持并固定任意规格形状的待运输物品,主要由夹持部件、第一支座组、第二支座组和防爆伺服电机组组成。运输夹持紧固机构的全部机械主体均安装于六自由度运动平台的上平台20上。四个滚珠丝杠51通过相互独立的单独运动协同作用,带动同一滚珠丝杠的两个夹爪呈相向或相背的方式同步运动,实现对不同规格形状的待运输物品的对心夹持和固定。
在一个实施例中,六自由度运动平台包括:主支架40、姿态驱动机构、上平台20;主支架40的上表面与姿态驱动机构的尾端活动连接,姿态驱动机构活动的顶端连接于上平台20的下表面,上平台20的上表面安装有运输夹持紧固机构。
其中,主支架40可以是金属材料搭建的支架,如:钢、铁金属材料等。主支架40的结构形式包括但不限于三角形、圆形、正方形,满足在主支架40的下表面能够固定安装在井下运输车辆车身上,且主支架40的上表面能够形成内接等边三角形即可,主支架40的主要作用是为姿态驱动机构提供安装固定基础,同时也作为该运输设备与井下运输车辆如电机车、单轨吊等承载部的中间连接介体,为方便起见,可采用三角形结构。
在一个实施例中,主支架40为空心钢架。
在一个实施例中,上平台20为实心平台。
其中,上平台结构形式包括但不限于三角形、圆形、正方形,主要作用是为运输夹持紧固机构提供安装基础,为方便起见,可采用三角形结构。
在一个实施例中,姿态驱动机构包括六个防爆伺服电动缸61,六个防爆伺服电动缸61分为三组姿态驱动部件;三组姿态驱动部件各防爆伺服电动缸61的尾端通过万向球铰62分别安装于主支架40的上表面对应的安装点上,且满足三组姿态驱动部件各防爆伺服电动缸61的尾端对应的安装点连接形成第一等边三角形;三组姿态驱动部件各防爆伺服电动缸61的顶端通过铰链63分别安装于上平台20的下表面对应的安装点上,且满足三组姿态驱动部件各防爆伺服电动缸61的顶端对应的安装点连接形成第二等边三角形;第一等边三角形的边大于第二等边三角形。
在一个实施例中,每一组姿态驱动部件的两个防爆伺服电动缸61的尾端分别通过万向球铰62并排安装于对应的安装点上;每一组姿态驱动部件的两个防爆伺服电动缸61的顶端分别通过铰链63并排安装于对应的安装点上。
其中,通过六个防爆伺服电动缸61协同工作进行六自由度运动,实现姿态保持与自校正,提升了运输过程的平稳性。
在一个实施例中,控制模块10是基于STM32平台的嵌入式核心控制器。
其中,嵌入式核心控制器的核心功能包含运输夹持紧固机构驱动模块、六自由度运动平台驱动模块、UWB标签唤醒/信号传输模块以及其他辅助性功能模块。输夹持紧固机构驱动模块使用通用串行接口方式实现与输夹持紧固机构的每一个防爆伺服电机进行有线连接,并通过传输0~10V的电压信号进行驱动,六自由度运动平台驱动模块使用通用串行接口方式实现与运输的每一个防爆伺服电动缸进行有线连接,并通过传输-10V~10V的电压信号进行驱动,UWB标签唤醒/信号传输模块使用通用串行接口方式与每一个UWB标签进行有线连接,并以RS485协议传输信号,发出高电平的上沿唤醒UWB标签、低电平的下沿休眠UWB标签,并以16进制的方式对UWB标签的定位信息进行编码传输。
在一个实施例中,控制模块10布置于六自由度运动平台的上平台上。
上述基于UWB技术的姿态自校正井下运输设备,通过六自由度运动平台的上平台的上表面安装有运输夹持紧固机构;姿态感知传感组中至少包括三个UWB标签,姿态感知传感组中的UWB标签均匀布置于六自由度运动平台的上平台的侧边上,用于采集位置信息;控制模块分别与姿态感知传感组、六自由度运动平台以及运输夹持紧固机构电连接,通过发送电信号驱动六自由度运动平台和运输夹持紧固机构实现待运输物品的夹取,收集姿态感知传感组的定位信息,对六自由度运动平台的姿态进行实时解算,结合期望位姿进行姿态调整,保持运输过程的平稳。在姿态自感知方面,摒弃了易受干扰的高成本传统方案,借助矿井井下已有的普遍布置的UWB定位网络***,通过额外布置若干UWB标签采集定位信息并实时结算即可获得待运输物品的实时等效姿态,可有效减小成本,且提高了姿态感知精度,满足了井下设备运输的平稳性需求。
在一个实施例中,如图2所示,一种基于UWB技术的姿态自校正井下运输设备的控制方法,包括以下步骤:
根据接收到的开始指令,向运输夹持紧固机构发送张开电信号,使运输夹持紧固机构的夹爪张开到最大;向六自由度运动平台发送位置调整电信号,使六自由度运动平台的上平台移动至待运输物品的夹取位置;当接收到待运输物品已放置的指令时,向运输夹持紧固机构发送夹持信号,使运输夹持紧固机构的夹爪夹紧待运输物品;向姿态感知传感组发送唤醒信号,唤醒姿态感知传感组的各个UWB标签;收集姿态感知传感组的初始定位信息进行姿态解算,获得六自由度运动平台的上平台的初始空间位姿;判断初始空间位姿是否满足预设目标位姿;不满足预设目标位姿时,发送位置调整电信号,使六自由度运动平台的上平台调整至满足预设目标位姿;将满足预设目标位姿的空间位姿设为期望位姿;当接收到的开始运输指令后,实时收集姿态感知传感组的定位信息,根据定位信息实时进行空间位姿解算,确定当前空间位姿;根据期望位姿与当前空间位姿分析,确定是否需要进行姿态调整;当需要进行姿态调整时,根据期望位姿与当前空间位姿解算出姿态调整参数,根据姿态调整参数发送位置调整电信号,控制六自由度运动平台的上平台调整至期望位姿。
具体地:如图2所示,工作初始,运输夹持紧固机构的四个防爆伺服电机在嵌入式核心控制器的运输夹持紧固机构驱动模块输出的0~10V的电压信号(即张开电信号)驱动下反向运动,带动滚珠丝杆转动,驱动八个夹爪两两相背运行,使得夹持部分处于最大张开状态,以便夹取物品。
随后六自由度运动平台的6个防爆伺服电动缸在嵌入式核心控制器的六自由度运动平台驱动模块输出的-10V~10V的电压信号(即位置调整电信号)驱动下共同运动,使夹具安装平台到达指定位置(即待运输物品的夹取位置)等待放置物品。
待物品放置完成后,四个防爆伺服电机在嵌入式核心控制器的运输夹持紧固机构驱动模块输出的0~10V的电压信号(即夹持信号)驱动下正向运动,带动滚珠丝杆转动,驱动八个夹爪相向运动,实现对物品的对心夹紧。
待物品已经加紧固定后,嵌入式核心控制器的UWB标签唤醒/信号传输模块发出高电平的上沿信号(即唤醒信号),将UWB定位标签由休眠状态唤醒,随后与井下巷道内已具备的UWB定位基站建立通讯,获得各标签对应的空间坐标信息(即初始定位信息),并将空间坐标信息以16进制的编码方式回传至嵌入式核心控制器。
嵌入式核心控制器获得空间坐标信息后进行本地快速运算,得到此时六自由度运动平台的上平台的相对于大地坐标系的空间位姿,该位姿可等效认定为使所夹持的物品的空间位姿。
随后由嵌入式核心控制器与本地数据库对比通讯,或由工人手动操作,对待运输物品相对于大地坐标系的空间位姿进行初始化设置,该初始化位姿即后续运动过程中的期望位姿L0。
待全部初始化完成后,井下运输车辆开始运动,运动过程中UWB定位标签与井下运输车辆运行全程中井下巷道内已具备的各UWB定位基站实时通信,并将个标签的实时空间坐标回传嵌入式核心控制器以进行实时解算,得到待运输物品相对于大地坐标系的实时等效空间位姿L1(即当前空间位姿)。
随后嵌入式核心控制器内置的控制程序对L1与L0进行对比并求得位置偏差。利用坐标对应解算,将位置偏差分解为各个防爆伺服电动缸各自对应的伸缩量(即姿态调整参数),进行位移闭环控制,进而实现保证待运输物品实时处于期望的空间位姿,保证物品在运输过程中的平稳稳定。
应该理解的是,虽然图1的流程图中的各个步骤按照箭头的指示依次显示,但是这些步骤并不是必然按照箭头指示的顺序依次执行。除非本文中有明确的说明,这些步骤的执行并没有严格的顺序限制,这些步骤可以以其它的顺序执行。而且,图1中的至少一部分步骤可以包括多个子步骤或者多个阶段,这些子步骤或者阶段并不必然是在同一时刻执行完成,而是可以在不同的时刻执行,这些子步骤或者阶段的执行顺序也不必然是依次进行,而是可以与其它步骤或者其它步骤的子步骤或者阶段的至少一部分轮流或者交替地执行。
以上实施例的各技术特征可以进行任意的组合,为使描述简洁,未对上述实施例中的各个技术特征所有可能的组合都进行描述,然而,只要这些技术特征的组合不存在矛盾,都应当认为是本说明书记载的范围。
以上实施例仅表达了本申请的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本申请构思的前提下,还可以做出若干变形和改进,这些都属于本申请的保护范围。因此,本申请专利的保护范围应以所附权利要求为准。
Claims (10)
1.一种基于UWB技术的姿态自校正井下运输设备,其特征在于,所述井下运输设备包括:六自由度运动平台、运输夹持紧固机构、姿态感知传感组和控制模块;
所述六自由度运动平台的上平台的上表面安装有运输夹持紧固机构;
所述姿态感知传感组中至少包括三个UWB标签,所述姿态感知传感组中的UWB标签均匀布置于所述六自由度运动平台的上平台的侧边上,用于采集位置信息;
所述控制模块分别与所述姿态感知传感组、所述六自由度运动平台以及运输夹持紧固机构电连接,通过发送电信号驱动所述六自由度运动平台和所述运输夹持紧固机构实现待运输物品的夹取,收集姿态感知传感组的定位信息,对所述六自由度运动平台的上平台的姿态进行实时解算,结合期望位姿进行姿态调整,保持运输过程的平稳。
2.根据权利要求1所述的设备,其特征在于,所述运输夹持紧固机构包括:夹持部件、第一支座组、第二支座组和防爆伺服电机组;
所述夹持部件包括四个相同规格的滚珠丝杠,所述滚珠丝杠具有两个相对运动的滚珠螺母,各滚珠螺母上分别固定有一个夹爪,所述防爆伺服电机组包括四个防爆伺服电机,所述第一支座组包括两个第一支撑座,所述第二支座组包括两个第二支撑座;
各所述防爆伺服电机通过联轴器对应连接在滚珠丝杠的一端,其中两个所述滚珠丝杠的另一端分别***对应的第一支撑座中,另外两个所述滚珠丝杠的另一端分别***对应的第二支撑座中,其中两个所述防爆伺服电机并排固定于所述六自由度运动平台的上平台的上表面的第一位置,另外两个所述防爆伺服电机并排固定于所述六自由度运动平台的上平台的上表面的第二位置,各所述第一支撑座并排固定于所述六自由度运动平台的上平台的上表面的第三位置,各所述第二支撑座并排固定于所述六自由度运动平台的上平台的上表面的第四位置,所述第一位置、所述第二位置、所述第三位置和所述第四位置的选择,满足四个滚珠丝杠在述六自由度运动平台的上平台的上表面呈两横两纵的#形状布置。
3.根据权利要求1所述的设备,其特征在于,所述六自由度运动平台包括:主支架、姿态驱动机构、上平台;
所述主支架的上表面与所述姿态驱动机构的尾端活动连接,所述姿态驱动机构活动的顶端连接于所述上平台的下表面,所述上平台的上表面安装有运输夹持紧固机构。
4.根据权利要求3所述的设备,其特征在于,所述主支架为空心钢架。
5.根据权利要求3所述的设备,其特征在于,所述上平台为实心平台。
6.根据权利要求3所述的设备,其特征在于,所述姿态驱动机构包括六个防爆伺服电动缸,六个所述防爆伺服电动缸分为三组姿态驱动部件;
三组所述姿态驱动部件各防爆伺服电动缸的尾端通过万向球铰分别安装于所述主支架的上表面对应的安装点上,且满足三组所述姿态驱动部件各防爆伺服电动缸的尾端对应的安装点连接形成第一等边三角形;
所述三组所述姿态驱动部件各防爆伺服电动缸的顶端通过铰链分别安装于所述上平台的下表面对应的安装点上,且满足三组所述姿态驱动部件各防爆伺服电动缸的顶端对应的安装点连接形成第二等边三角形;
所述第一等边三角形的边大于第二等边三角形。
7.根据权利要求6所述的设备,其特征在于,每一组姿态驱动部件的两个所述防爆伺服电动缸的尾端分别通过万向球铰并排安装于对应的安装点上;每一组姿态驱动部件的两个所述防爆伺服电动缸的顶端分别通过铰链并排安装于对应的安装点上。
8.根据权利要求1所述的设备,其特征在于,所述控制模块是基于STM32平台的嵌入式核心控制器。
9.根据权利要求1所述的设备,其特征在于,所述控制模块布置于所述六自由度运动平台的上平台上。
10.一种基于UWB技术的姿态自校正井下运输设备的控制方法,其特征在于,所述方法包括:
根据接收到的开始指令,向运输夹持紧固机构发送张开电信号,使所述运输夹持紧固机构的夹爪张开到最大;
向六自由度运动平台发送位置调整电信号,使六自由度运动平台的上平台移动至待运输物品的夹取位置;
当接收到所述待运输物品已放置的指令时,向运输夹持紧固机构发送夹持信号,使所述运输夹持紧固机构的夹爪夹紧所述待运输物品;
向姿态感知传感组发送唤醒信号,唤醒所述姿态感知传感组的各个UWB标签;
收集姿态感知传感组的初始定位信息进行姿态解算,获得所述六自由度运动平台的上平台的初始空间位姿;
判断所述初始空间位姿是否满足预设目标位姿;
不满足所述预设目标位姿时,发送位置调整电信号,使六自由度运动平台的上平台调整至满足所述预设目标位姿;
将满足所述预设目标位姿的空间位姿设为期望位姿;
当接收到的开始运输指令后,实时收集姿态感知传感组的定位信息,根据所述定位信息实时进行空间位姿解算,确定当前空间位姿;
根据所述期望位姿与所述当前空间位姿分析,确定是否需要进行姿态调整;
当需要进行姿态调整时,根据所述期望位姿与所述当前空间位姿解算出姿态调整参数,根据所述姿态调整参数发送位置调整电信号,控制六自由度运动平台的上平台调整至期望位姿。
Priority Applications (5)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111008694.XA CN113766418B (zh) | 2021-08-31 | 2021-08-31 | 一种基于uwb技术的姿态自校正井下运输设备及其控制方法 |
PCT/CN2022/116082 WO2023030362A1 (zh) | 2021-08-31 | 2022-08-31 | 一种基于uwb技术的姿态自校正井下运输设备及其控制方法 |
DE112022000068.6T DE112022000068T5 (de) | 2021-08-31 | 2022-08-31 | Auf uwb-technologie basierendes, hinsichtlich der lage selbstkorrigierendes bohrlochtransportgerät und verfahren zu dessen steuerung |
US18/013,908 US20230349295A1 (en) | 2021-08-31 | 2022-08-31 | Attitude self-correcting underground transportation apparatus based on uwb technology and control method thereof |
AU2022291666A AU2022291666B2 (en) | 2021-08-31 | 2022-08-31 | Attitude self-correcting underground transportation apparatus based on UWB technology and control method thereof |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111008694.XA CN113766418B (zh) | 2021-08-31 | 2021-08-31 | 一种基于uwb技术的姿态自校正井下运输设备及其控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113766418A true CN113766418A (zh) | 2021-12-07 |
CN113766418B CN113766418B (zh) | 2022-07-15 |
Family
ID=78792017
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111008694.XA Active CN113766418B (zh) | 2021-08-31 | 2021-08-31 | 一种基于uwb技术的姿态自校正井下运输设备及其控制方法 |
Country Status (4)
Country | Link |
---|---|
US (1) | US20230349295A1 (zh) |
CN (1) | CN113766418B (zh) |
DE (1) | DE112022000068T5 (zh) |
WO (1) | WO2023030362A1 (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114333491A (zh) * | 2021-12-29 | 2022-04-12 | 江苏普旭科技股份有限公司 | 改善导杆自转效应的六自由度运动平台 |
CN114359477A (zh) * | 2021-12-16 | 2022-04-15 | 北京天玛智控科技股份有限公司 | 煤矿井下智能定位方法和*** |
WO2023030362A1 (zh) * | 2021-08-31 | 2023-03-09 | 中国矿业大学 | 一种基于uwb技术的姿态自校正井下运输设备及其控制方法 |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116713487A (zh) * | 2023-06-17 | 2023-09-08 | 哈尔滨理工大学 | 一种3d金属打印机的多姿态成型平台机构 |
Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1290591A (zh) * | 2000-10-24 | 2001-04-11 | 中国科学院合肥智能机械研究所 | 一种多传感器机器人手爪及方法 |
CN101116968A (zh) * | 2007-09-06 | 2008-02-06 | 上海交通大学 | 六维力传感器装配机械手姿态及力的控制方法 |
CN101451933A (zh) * | 2008-12-18 | 2009-06-10 | 北京林业大学 | 六维加载材料力学试验机 |
CN202367749U (zh) * | 2011-12-08 | 2012-08-08 | 华南理工大学 | 具有力感觉的六自由度操作端 |
CN102701076A (zh) * | 2012-06-18 | 2012-10-03 | 中国矿业大学 | 六自由度起重吊装协作柔索并联构型装备控制装置及方法 |
CN103085060A (zh) * | 2012-12-31 | 2013-05-08 | 中国科学院自动化研究所 | 基于力视混合检测的对接/分离装置及其方法 |
CN104265171A (zh) * | 2014-09-19 | 2015-01-07 | 合肥工业大学 | 一种垂直钻井自动调整装置及调整方法 |
CN105675407A (zh) * | 2016-01-11 | 2016-06-15 | 西南石油大学 | 一种滤饼强度分层测试装置及方法 |
CN106275501A (zh) * | 2016-08-30 | 2017-01-04 | 深圳市劲拓自动化设备股份有限公司 | 一种六自由度调姿平台的控制***及控制方法 |
CN109715349A (zh) * | 2016-07-15 | 2019-05-03 | 快砖知识产权私人有限公司 | 安装在柔性臂上的机器人臂的动态补偿 |
US20190243468A1 (en) * | 2016-10-27 | 2019-08-08 | Fluidity Technologies, Inc. | Dynamically Balanced, Multi-Degrees-of-Freedom Hand Controller |
CN112077850A (zh) * | 2020-09-17 | 2020-12-15 | 中国矿业大学 | 基于机械手的超声无损检测探头自准直装置及工作方法 |
CN112753007A (zh) * | 2018-07-27 | 2021-05-04 | 奇跃公司 | 虚拟角色的姿势空间变形的姿势空间维度减小 |
Family Cites Families (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CA2306424A1 (en) * | 2000-04-20 | 2001-10-20 | Patrick Ketchmark | Tool caddy |
WO2011160213A1 (en) * | 2010-06-25 | 2011-12-29 | Trusted Positioning Inc. | Moving platform ins range corrector (mpirc) |
US11093722B2 (en) * | 2011-12-05 | 2021-08-17 | Adasa Inc. | Holonomic RFID reader |
CN202970796U (zh) * | 2012-12-17 | 2013-06-05 | 中国瑞林工程技术有限公司 | 一种重型设备的超宽带井下定位*** |
US20150168953A1 (en) * | 2013-12-13 | 2015-06-18 | Itrack Llc | Autonomous self-leveling vehicle |
US9722640B2 (en) * | 2015-01-06 | 2017-08-01 | Discovery Robotics | Method and system for determining precise robotic position and orientation using near-simultaneous radio frequency measurements |
US11402402B2 (en) * | 2016-01-12 | 2022-08-02 | Bigmotion Technologies Inc. | Systems and methods for human body motion capture |
WO2019140699A1 (en) * | 2018-01-22 | 2019-07-25 | SZ DJI Technology Co., Ltd. | Methods and system for multi-target tracking |
CN111045438B (zh) * | 2019-10-21 | 2023-09-08 | 贵州省水利水电勘测设计研究院 | 一种船载自稳平台及其控制***和方法 |
CN113766418B (zh) * | 2021-08-31 | 2022-07-15 | 中国矿业大学 | 一种基于uwb技术的姿态自校正井下运输设备及其控制方法 |
-
2021
- 2021-08-31 CN CN202111008694.XA patent/CN113766418B/zh active Active
-
2022
- 2022-08-31 US US18/013,908 patent/US20230349295A1/en active Pending
- 2022-08-31 WO PCT/CN2022/116082 patent/WO2023030362A1/zh unknown
- 2022-08-31 DE DE112022000068.6T patent/DE112022000068T5/de active Pending
Patent Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1290591A (zh) * | 2000-10-24 | 2001-04-11 | 中国科学院合肥智能机械研究所 | 一种多传感器机器人手爪及方法 |
CN101116968A (zh) * | 2007-09-06 | 2008-02-06 | 上海交通大学 | 六维力传感器装配机械手姿态及力的控制方法 |
CN101451933A (zh) * | 2008-12-18 | 2009-06-10 | 北京林业大学 | 六维加载材料力学试验机 |
CN202367749U (zh) * | 2011-12-08 | 2012-08-08 | 华南理工大学 | 具有力感觉的六自由度操作端 |
CN102701076A (zh) * | 2012-06-18 | 2012-10-03 | 中国矿业大学 | 六自由度起重吊装协作柔索并联构型装备控制装置及方法 |
CN103085060A (zh) * | 2012-12-31 | 2013-05-08 | 中国科学院自动化研究所 | 基于力视混合检测的对接/分离装置及其方法 |
CN104265171A (zh) * | 2014-09-19 | 2015-01-07 | 合肥工业大学 | 一种垂直钻井自动调整装置及调整方法 |
CN105675407A (zh) * | 2016-01-11 | 2016-06-15 | 西南石油大学 | 一种滤饼强度分层测试装置及方法 |
CN109715349A (zh) * | 2016-07-15 | 2019-05-03 | 快砖知识产权私人有限公司 | 安装在柔性臂上的机器人臂的动态补偿 |
CN106275501A (zh) * | 2016-08-30 | 2017-01-04 | 深圳市劲拓自动化设备股份有限公司 | 一种六自由度调姿平台的控制***及控制方法 |
US20190243468A1 (en) * | 2016-10-27 | 2019-08-08 | Fluidity Technologies, Inc. | Dynamically Balanced, Multi-Degrees-of-Freedom Hand Controller |
CN112753007A (zh) * | 2018-07-27 | 2021-05-04 | 奇跃公司 | 虚拟角色的姿势空间变形的姿势空间维度减小 |
CN112077850A (zh) * | 2020-09-17 | 2020-12-15 | 中国矿业大学 | 基于机械手的超声无损检测探头自准直装置及工作方法 |
Non-Patent Citations (3)
Title |
---|
FULONG HOU;MEIZHU LUO;ZIJIAO ZHANG: "An inverse kinematic analysis modeling on a 6-PSS compliant parallel platform for optoelectronic packaging", 《CES TRANSACTIONS ON ELECTRICAL MACHINES AND SYSTEMS》 * |
任怀伟;赵国瑞;周杰;文治国;丁艳: "智能开采装备全位姿测量及虚拟仿真控制技术", 《煤炭学报》 * |
李翔; 朱真才; 沈刚; 汤裕: "双绳缠绕式煤矿深井提升***容器位姿调平控制方法", 《煤炭学报》 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2023030362A1 (zh) * | 2021-08-31 | 2023-03-09 | 中国矿业大学 | 一种基于uwb技术的姿态自校正井下运输设备及其控制方法 |
CN114359477A (zh) * | 2021-12-16 | 2022-04-15 | 北京天玛智控科技股份有限公司 | 煤矿井下智能定位方法和*** |
CN114333491A (zh) * | 2021-12-29 | 2022-04-12 | 江苏普旭科技股份有限公司 | 改善导杆自转效应的六自由度运动平台 |
CN114333491B (zh) * | 2021-12-29 | 2023-10-20 | 江苏普旭科技股份有限公司 | 改善导杆自转效应的六自由度运动平台 |
Also Published As
Publication number | Publication date |
---|---|
US20230349295A1 (en) | 2023-11-02 |
WO2023030362A1 (zh) | 2023-03-09 |
AU2022291666A1 (en) | 2023-03-16 |
DE112022000068T5 (de) | 2023-06-22 |
CN113766418B (zh) | 2022-07-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113766418B (zh) | 一种基于uwb技术的姿态自校正井下运输设备及其控制方法 | |
EP2604524B1 (en) | Autonomous carrier system for moving aircraft structures | |
EP2824439A2 (en) | Apparatus and method for moving a structure in a manufacturing environment | |
CN110068286B (zh) | 基于大型龙门倒挂协作机械臂的三维全外形测量***及方法 | |
CN107611849A (zh) | 一种自走式输电线缆巡检机器人 | |
CN102554595A (zh) | 用于飞机的蒙皮制造装配*** | |
CN109870156B (zh) | 一种车用低成本微机械惯导***自主导航定位方法 | |
CN102303588A (zh) | 基于直角坐标机器人的电动乘用车底盘电池快换*** | |
CN210514100U (zh) | 一种路桥裂缝检测与修复一体化机器人 | |
CN115262303B (zh) | 一种基于智能控制的轨排自动拼装***及方法 | |
CN202130434U (zh) | 基于直角坐标机器人的电动乘用车底盘电池快换*** | |
CN105397145A (zh) | 一种柴油机气缸盖旋转钻孔加工控制*** | |
CN202089044U (zh) | 电动乘用车底盘电池快换机器人 | |
CN110926541A (zh) | 一种跨座式单轨pc轨道梁检测装置 | |
CN216076171U (zh) | 一种瓷砖智能铺贴机器人 | |
CN103528538A (zh) | 基于激光跟踪仪的大型面自动化测量辅助装置 | |
CN111169018B (zh) | 一种3d打印设备、3d打印***及3d打印方法 | |
CN104607836B (zh) | 一种船舶肋板纵桁垂直摆动自动化焊接装置 | |
Božić et al. | Mobile Wall-Climbing Robot for NDT inspection of vertical concrete structures | |
AU2022291666B2 (en) | Attitude self-correcting underground transportation apparatus based on UWB technology and control method thereof | |
CN210011756U (zh) | 一种高温超导磁悬浮轨检车 | |
CN110308731B (zh) | 高精度移动机器人二次定位装置 | |
CN204479086U (zh) | 基于激光扫描的采煤机定位定姿***的校准装置 | |
CN108044622A (zh) | 一种道面修复机器人*** | |
CN207593801U (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 |