CN114536297A - 一种煤矿巷道空地巡检机器人及巡检方法 - Google Patents
一种煤矿巷道空地巡检机器人及巡检方法 Download PDFInfo
- Publication number
- CN114536297A CN114536297A CN202210343568.8A CN202210343568A CN114536297A CN 114536297 A CN114536297 A CN 114536297A CN 202210343568 A CN202210343568 A CN 202210343568A CN 114536297 A CN114536297 A CN 114536297A
- Authority
- CN
- China
- Prior art keywords
- wing
- control system
- flapping
- steering engine
- arm
- 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.)
- Pending
Links
- 239000003245 coal Substances 0.000 title claims abstract description 21
- 238000000034 method Methods 0.000 title claims abstract description 15
- 238000007689 inspection Methods 0.000 title claims description 28
- 230000007246 mechanism Effects 0.000 claims abstract description 80
- 239000011664 nicotinic acid Substances 0.000 claims abstract description 26
- 230000000007 visual effect Effects 0.000 claims abstract description 10
- 239000003638 chemical reducing agent Substances 0.000 claims description 42
- 210000001508 eye Anatomy 0.000 claims description 42
- 238000004458 analytical method Methods 0.000 claims description 28
- 230000005540 biological transmission Effects 0.000 claims description 18
- XEEYBQQBJWHFJM-UHFFFAOYSA-N Iron Chemical compound [Fe] XEEYBQQBJWHFJM-UHFFFAOYSA-N 0.000 claims description 16
- 210000005252 bulbus oculi Anatomy 0.000 claims description 12
- 230000001276 controlling effect Effects 0.000 claims description 11
- 229920000049 Carbon (fiber) Polymers 0.000 claims description 8
- 239000004917 carbon fiber Substances 0.000 claims description 8
- 229910052742 iron Inorganic materials 0.000 claims description 8
- VNWKTOKETHGBQD-UHFFFAOYSA-N methane Chemical compound C VNWKTOKETHGBQD-UHFFFAOYSA-N 0.000 claims description 7
- 230000008569 process Effects 0.000 claims description 6
- 239000013589 supplement Substances 0.000 claims description 5
- 238000012544 monitoring process Methods 0.000 claims description 3
- 230000001105 regulatory effect Effects 0.000 claims description 3
- 230000026676 system process Effects 0.000 claims description 3
- 230000007613 environmental effect Effects 0.000 claims description 2
- 238000010586 diagram Methods 0.000 description 8
- 238000001514 detection method Methods 0.000 description 4
- 230000005484 gravity Effects 0.000 description 4
- 230000008859 change Effects 0.000 description 3
- 230000033001 locomotion Effects 0.000 description 3
- 230000008054 signal transmission Effects 0.000 description 3
- 230000009471 action Effects 0.000 description 2
- 230000004075 alteration Effects 0.000 description 1
- 230000004888 barrier function Effects 0.000 description 1
- 230000003592 biomimetic effect Effects 0.000 description 1
- 239000002817 coal dust Substances 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000005286 illumination Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 239000012528 membrane Substances 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 239000011347 resin Substances 0.000 description 1
- 229920005989 resin Polymers 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J5/00—Manipulators mounted on wheels or on carriages
- B25J5/005—Manipulators mounted on wheels or on carriages mounted on endless tracks or belts
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J11/00—Manipulators not otherwise provided for
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
- B25J19/02—Sensing devices
- B25J19/04—Viewing devices
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/161—Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1661—Programme controls characterised by programming, planning systems for manipulators characterised by task planning, object-oriented languages
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1679—Programme controls characterised by the tasks executed
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- Fuzzy Systems (AREA)
- Mathematical Physics (AREA)
- Software Systems (AREA)
- Toys (AREA)
- Manipulator (AREA)
Abstract
本发明提出了一种煤矿巷道空地巡检机器人及巡检方法,该机器人包括履带车和四翼扑翼飞行器;履带车包括:主控制***、视觉机构;视觉结构由仿生眼搭建;四翼扑翼飞行器包括:起落架、机架、扑翼机构、副控制***;起落架,通电以与履带车的顶面磁性连接;机架包括上底座、下底座、翼臂、翼根、臂根连杆和扑翼;上底座上转动设置一对左右设置的翼臂;每根翼臂上均设置一扑翼机构;每根臂根连杆上均连接一对扑翼;扑翼的内侧与对应的臂根连杆固定连接;扑翼机构用于驱动对应的一对扑翼张合。本发明可实现地面行走和空中飞行。
Description
技术领域
本发明属于机器人技术领域,尤其涉及一种煤矿巷道空地巡检机器人及巡检方法。
背景技术
随着我国煤炭行业的大力发展,对于可以在特殊状况下进行检测的机器人的需求增大。目前,煤矿井下作业环境,时常发生一些危险情况,例如五种常见的灾害,分别是矿井水灾、矿井火灾、矿井瓦斯伤害、矿井煤尘灾害、矿井顶板灾害等,在这些灾害情况下,考虑到工作人员的安全,以及降低工人的劳动强度,就需要机器人进行巡检检测。
目前常见的井下巡检机器人,主要分为轨道式巡检机器人、行走式巡检机器人和无人机式巡检机器人三类,其中轨道式巡检机器人一般是将机器人悬挂在轨道上,通过驱动轮使机器人沿轨道行走,造价高,灵活度低;行走式巡检机器人一般采用履带或轮胎进行行走,在遇到一些障碍物时,很难再前进,就不能更加完整地对井下进行检测;无人机式巡检机器人一般采用旋翼无人机,尺寸很大,在狭小的井下空间内,操作灵活度受到了很大的局限,对井下环境的检测有很大难度。由此,现有技术中,并没有兼备地面行走和空中飞行的巡逻机器人。
发明内容
本发明的目的在于提供一种煤矿巷道空地巡检机器人及巡检方法,可实现地面行走和空中飞行。为实现上述目的,本发明采用如下技术方案:
一种煤矿巷道空地巡检机器人,包括:
履带车;
四翼扑翼飞行器,通电飞行以进行巡检,包括:
起落架,通电以与所述履带车的顶面磁性连接;所述起落架的顶端与一机架的下底座连接;
所述机架还包括一上底座,所述上底座和下底座之间通过左右设置的碳纤杆连接,所述上底座上转动设置一对左右设置的翼臂,每根所述翼臂的外端均延伸出所述上底座,内端均可沿上底座上的弧形槽移动;所述;每根所述翼臂上均设置一扑翼机构;每根所述碳纤杆上均套设一延伸出所述下底座的翼根,每根所述翼根的外端和对应的翼臂的外端之间通过一臂根连杆连接;每根臂根连杆上均连接一对扑翼;
所述扑翼的内侧与对应的臂根连杆固定连接,所述扑翼的顶端形成一杆体以与一扑翼机构的输出端可拆卸连接;
所述扑翼机构,用于驱动对应的一对所述扑翼张合,包括形成所述输出端的一对摇杆,一对所述摇杆呈上下设置且与所述翼臂转动连接;一对所述摇杆转动连接于同一点;每根所述摇杆上均连接一所述扑翼;每根摇杆与一个二级减速器从动轮之间均通过一曲柄连杆转动连接,两个所述二级减速器从动轮之间外啮合;两个所述二级减速器从动轮均转动安装于所述翼臂且其中一个二级减速器从动轮与一个二级减速器主动轮外啮合;所述二级减速器主动轮与一级减速器从动轮形成一双联齿轮,所述一级减速器从动轮转动安装于翼臂且与一级减速器主动轮外啮合,所述一级减速器主动轮与电机的输出轴连接,所述电机固定于所述翼臂;
主控制***和副控制***,所述主控制***设置于所述履带车上,所述副控***设置于所述四翼扑翼飞行器的机架上;所述机架上还设置一摄像单元,所述摄像单元依次与副控制***、主控制***信号连接。
优选地,进一步包括一与所述主控制***信号连接且设置于所述履带车上的视觉机构,所述视觉机构包括:
眼壳,包括可拆卸连接的前壳体和后壳体;所述眼壳转动设置于一视觉支撑架上;所述眼壳的外壁上设置补光灯;所述眼壳的内部设置一仿生眼;
所述仿生眼包括固定于所述后壳体上的第一直线舵机,所述第一直线舵机的舵机推杆可沿左右方向移动且与第一滑块连接;所述第一滑块连接第二直线舵机的外壳,所述第二直线舵机的舵机推杆可沿上下方向移动且与第二滑块的后端连接;所述第二滑块的前端与一球面端头球副连接;所述球面端头的前端固定于一伸缩套杆的后端,所述伸缩套杆的前端固定于一眼球,所述眼球与眼壳的前壳体球副连接。
优选地,所述机架的上底座上设置一用于调节两翼臂之间夹角以使得四翼扑翼飞行器进行俯仰的翼臂夹角调节机构,包括一夹角连杆,所述夹角连杆位于两所述翼臂之间,所述夹角连杆的左端有一左滑槽,一立柱穿过左滑槽卡设于左侧的翼臂上,右端有一右滑槽,一立柱穿过右滑槽卡设于右侧的翼臂;两所述立柱与上底座上的弧形槽配合设置;所述夹角连杆的上段固定于第三直线舵机的舵机推杆,所述第三直线舵机的舵机推杆可沿前后方向移动;所述第三直线舵机的机身固定于所述上底座。
优选地,所述机架的下底座上设置一使得四翼扑翼飞行器发生偏航的转向机构,包括一固定于所述下底座上的舵机,所述舵机的输出轴固定于一尾舵。
优选地,所述履带车顶面上设置一电磁铁;
所述起落架包括一支撑架,所述支撑架的上端形成一连接件以与所述机架的下底座可拆卸连接,所述支撑架上固定一无线充电接收器,所述无线充电接收器的输入端连接一无线充电器;所述无线充电器套设在所述电磁铁上;
所述无线充电接收器上设置一软铁片;所述电磁铁通电产生磁性吸引所述软铁片以连接履带车与四翼扑翼飞行器。
优选地,所述主控制***包括:
PC分析模块和主控制器,所述PC分析模块用于接收并分析仿生眼输出的环境信息和主控制器的输出信息,之后输出指令信息至主控制器,同时PC分析模块与地面控制中心进行信息传递;所述主控制器用于接收PC分析模块的输出指令信息并输出相应信号;所述主控制器的第一输出端信号连接一电机驱动模块的输入端,第二输出端信号连接一电流控制器的输入端,第三输出端信号连接一遥控模块的输入端,第四输出端与视觉机构的第一直线舵机和第二直线舵机连接;
所述地面控制中心,用于地面人员进行远程监测与控制;
所述电机驱动模块,用于控制履带机的速度,所述电机驱动模块的输出端与履带机上的履带车电机信号连接;
所述电流控制器用于控制电磁铁的通电和断电,所述电流控制器的输出端与电磁铁的正负极连接,主控制器发送调节信号给电流控制器,电流控制器根据信号调节电流大小,实现电磁铁的通电和断电;
所述遥控模块,用于改变翼臂夹角和尾舵的角度,所述遥控模块的输出端与所述副控制***的输入端信号连接。
优选地,所述副控制***包括:
接收器,用于接收所述遥控模块的输出信息,所述接收器的第一输出端与电调模块的输入端信号连接,第二输出端与翼臂夹角调节机构的第三直线舵机信号连接,第三输出端与转向机构的舵机信号连接;
所述电调模块,用于对扑翼机构的电机调速,所述电调模块的输出端信号连接所述电机;
电源模块和电量数传模块,所述电源模块用于获取四翼扑翼飞行器电池的电量,之后通过电量数传模块将电池量信号发送给PC分析模块,PC分析模块分析电量信息和行程信息,确定是否发送返航指令;其中,所述四翼扑翼飞行器电池设置于所述机架的上底座;所述履带车上设置履带车电池,所述履带车电池依次通过无线充电器、无线充电接收器、电源模块给四翼扑翼飞行器电池充电;
无线图传模块,四翼扑翼飞行器的摄像单元通过无线图传模块,将图像信息发送至PC分析模块。
一种煤矿巷道空地巡检方法,所述的煤矿巷道空地巡检机器人,包括以下步骤:
步骤1:将巷道信息输入至主控制***,所述主控制***进行路径规划,之后根据规划完成的路径驱动履带车上的履带车电机运行;
在履带车运行过程中,视觉机构通过改变仿生眼的位置以获取多方向信息,仿生眼输出图像信息至主控制***,主控制***对图像信息进行处理,并判断履带车前方是否有障碍物;
若是,则主控制***发出障碍指令,并分析履带车是否能继续前行;若履带车无法继续前行,则执行步骤2;
步骤2:主控制***连通副控制***,副控制***驱动扑翼机构的电机运行以实现四翼扑翼飞行器的飞行;
之后,主控制***控制履带车上的电磁铁断电,四翼扑翼飞行器脱离履带车;
在飞行过程中,四翼扑翼飞行器上的摄像单元实时采集巷道图像信息,并将其传输至主控制***;
运行设定时间后,副控制***获取四翼扑翼飞行器电池的电量,之后将电池量信号发送给主控制***,主控制***分析电量信息和行程信息,确定是否发送返航指令;如是,则执行步骤3;
步骤3:主控制***发送返航指令至副控制***,副控制***控制转向机构的第三直线舵机运行,使得四翼扑翼飞行器返航;
步骤4:履带车上的无线充电器依次连通四翼扑翼飞行器上的无线充电接收器、副控制***以对四翼扑翼飞行器电池充电。
与现有技术相比,本发明的优点为:
(1)本发明的空地巡检机器人兼具地面行走和空中飞行,履带车可以进行地面行走,当履带车遇到阻碍物不能前行,可以利用四翼扑翼飞行器接着进行一段路线的巡检。
(2)四翼扑翼飞行器采用“合拢-打开”高升力机制,具有很好的飞行性能。
(3)仿生眼的使用,使得整个视觉***的体积大大缩减,灵活度得到提高,克服了传统视觉***因云台的使用整体尺寸过大的问题。
(4)利用无线充电技术,四翼扑翼飞行器的续航能力得到提升,避免了常规飞行器因电量问题续航能力不足的问题。
附图说明
图1为本发明一实施例的煤矿巷道空地巡检机器人的立体图;
图2为图1中履带车的立体图;
图3为图1中四翼扑翼飞行器的立体图;
图4为图2中视觉机构的***图;
图5为图2中视觉机构的剖视图;
图6为图4中仿生眼的结构图;
图7为图6中中仿生眼的球面端头球心位置点与视觉方向对应图;
图8为四翼扑翼飞行器中机架的结构图;
图9为四翼扑翼飞行器中扑翼机构的结构图;
图10为四翼扑翼飞行器中翼臂夹角调节机构的结构图;
图11为四翼扑翼飞行器中转向机构的结构图;
图12为四翼扑翼飞行器中起落架的结构图;
图13为主控制***和副控制***的控制流程图;
图14为煤矿巷道空地巡检机器人的运行流程图;
图15为扑翼机构驱动扑翼贴合的状态图;
图16为扑翼机构驱动扑翼张开时扑翼机构状态图;
图17为扑翼机构驱动扑翼贴合时扑翼机构状态图;
图18为仿生眼中眼球识别与传递环境信息流程图。
其中,1-履带车,2-四翼扑翼飞行器,3-固定件,4-电磁铁,5-无线充电器 ,6-履带车电池,7-主控制***,24-PC分析模块,25-地面控制中心,71-主控制器,72-电机驱动模块,73-电流控制器,74-遥控模块,8-视觉机构,81-眼壳,82-旋转电机,83-补光灯,84-仿生眼,841-第一直线舵机,842-第二直线舵机,843-球面端头,844-伸缩套杆,845-眼球,8411-第一滑块,8421-第二滑块,8431-球面端头球心,8432-球心平面,8451-眼球球心 ,8452-视觉方向,8453-微型传感器,8454-摄像头,8455-信号传输模块,9-视觉支撑架,10-履带轮,11-履带,12-履带车电机,13-底盘,14-副控制***,141-接收器,142-电调模块,143-电源模块,144-电量数传模块,145-无线图传模块,15-机架,151-下底座,152-上底座,153-翼臂,154-翼根,155-碳纤杆,156-臂根连杆,16-扑翼机构,161-曲柄连杆,162-电机,163-一级减速器主动轮,164-一级减速器从动轮,165-二级减速器主动轮,166-二级减速器从动轮,167-摇杆,17-扑翼,18-翼臂夹角调节机构,181-第三直线舵机, 182-夹角连杆,19-转向机构,191-舵机 ,192-尾舵,20-起落架,201-连接件 ,202-支撑架,203-软铁片,21-无线充电接收器,22-摄像单元,23-四翼扑翼飞行器电池。
具体实施方式
下面将结合示意图对本发明进行更详细的描述,其中表示了本发明的优选实施例,应该理解本领域技术人员可以修改在此描述的本发明,而仍然实现本发明的有利效果。因此,下列描述应当被理解为对于本领域技术人员的广泛知道,而并不作为对本发明的限制。
如图1~15所示,一种煤矿巷道空地巡检机器人,包括履带车1和四翼扑翼飞行器2。
四翼扑翼飞行器2,通电飞行以进行巡检,包括:起落架20、机架15、扑翼机构16、翼臂夹角调节机构18、转向机构19、无线充电接收器21、摄像单元22、四翼扑翼飞行器电池23、副控制***14。扑翼机构16分为左、右扑翼机构16,左、右扑翼机构16上各连接着两个扑翼17,翼臂夹角调节机构18放置在机架15上方,转向机构19放置在机架15下方,起落架20放置在机架15最下方,支撑机身,连接履带车1。
在本实施例中,上下方向是指沿Z方向;左右方向是指沿X方向、前后方向是指沿Y方向。
起落架20,通电以与履带车1的顶面磁性连接,即履带车1和四翼扑翼飞行器2通过电磁铁4与起落架20进行连接,电磁铁4通过固定件3与履带车1连接在一起,通过控制电磁铁4通电断电,当电磁铁4通电,电磁铁4产生磁力,吸引四翼扑翼飞行器2的起落架20,使四翼扑翼飞行器2固定在履带车1上;当电磁铁4断电,磁力消失,四翼扑翼飞行器2脱离履带车1的连接,四翼扑翼飞行器2的质量很轻,给电磁铁4通小电流,就可以产生足够的吸力来稳定四翼扑翼飞行器2,耗电量很低。其中,在电磁铁4断电之前,四翼扑翼飞行器2的扑翼机构16已开始工作运行。
具体的,如图2所示,履带车1顶面上设置一电磁铁4;如图3、图12所示,起落架20的顶端与一机架15的下底座151连接;起落架20包括支撑架202、连接件201、软铁片203;支撑架202的上端形成一连接件201以与机架15的下底座151可拆卸连接,支撑架202上固定一无线充电接收器21,无线充电接收器21的输入端连接一无线充电器5;无线充电器5套设在电磁铁4上;无线充电接收器21上设置一软铁片203;电磁铁4通电产生磁性吸引软铁片203以连接履带车1与四翼扑翼飞行器2。
四翼扑翼飞行器2的机架15还包括上底座152、翼臂153、翼根154、碳纤杆155和臂根连杆156,如图8所示。
具体的,上底座152和下底座151之间通过左右设置的碳纤杆155连接,上底座152上转动设置一对左右设置的翼臂153,具体的,翼臂153通过销钉转动连接在上底座152上;每根翼臂153的外端均延伸出上底座152,内端均可沿上底座152上的弧形槽移动;每根翼臂153上均设置一扑翼机构16;每根碳纤杆155上均套设一延伸出下底座151的翼根154,每根翼根154的外端和对应的翼臂153的外端之间通过一臂根连杆156固定连接;每根臂根连杆156上均连接一对扑翼17;扑翼17的内侧与对应的臂根连杆156固定连接(如粘接),扑翼17的顶端形成一杆体以与一扑翼机构16的输出端可拆卸连接。
扑翼机构16,用于驱动对应的一对扑翼17张合,如图9所示,包括曲柄连杆161、电机162、一级减速器主动轮163、一级减速器从动轮164、二级减速器主动轮165、二级减速器从动轮166和摇杆167。
具体的,一对摇杆167形成翼机构的输出端,一对摇杆167呈上下设置且与翼臂153转动连接;一对摇杆167转动连接于同一点;每根摇杆167上均连接一扑翼17;每根摇杆167与一个二级减速器从动轮166之间均通过一曲柄连杆161转动连接,两个二级减速器从动轮166之间外啮合;两个二级减速器从动轮166均转动安装于翼臂153且其中一个二级减速器从动轮166与一个二级减速器主动轮165外啮合;二级减速器主动轮165与一级减速器从动轮164形成一双联齿轮,一级减速器从动轮164转动安装于翼臂153且与一级减速器主动轮163外啮合,一级减速器主动轮163与电机162的输出轴连接,电机162固定于翼臂153。
当电机162工作时,依次带动一级减速器主动轮163、一级减速器从动轮164、二级减速器主动轮165、二级减速器从动轮166、曲柄连杆161、摇杆167、扑翼17动作。每个摇杆167的运动幅度为60º左右,如图15、图17所示当扑翼机构16的两个摇杆167同时达到最高点时,同一侧的一对摇杆167上固定的扑翼17能够正好贴合,如图3、图16所示两扑翼17之间的最大夹角为120º左右,充分地利用“合拢-打开”机制,扑翼17的膜采用PVC薄膜制作,各种齿轮采用树脂材料制作。
翼臂夹角调节机构18,用于调节两翼臂153之间夹角以使得四翼扑翼飞行器2进行俯仰,如图3、图10所示,设置于机架15的上底座152上,包括第三直线舵机181和夹角连杆182,夹角连杆182位于两翼臂153之间,夹角连杆182的左端有一左滑槽,一立柱穿过左滑槽卡设于左侧的翼臂153上,右端有一右滑槽,一立柱穿过右滑槽卡设于右侧的翼臂153;两立柱均与上底座152上的弧形槽配合设置;夹角连杆182的上段固定于第三直线舵机181的舵机推杆,第三直线舵机181的舵机推杆可沿前后方向移动;第三直线舵机181的机身固定于上底座152。
每根翼臂153均形成一个绕着销钉转动的杠杆,当第三直线舵机181工作时,第三直线舵机181带动夹角连杆182,夹角连杆182带动左右两个翼臂153的内端移动(立柱在弧形槽内移动),翼臂153的另一端(外端)通过杠杆原理也会移动,左右两翼臂153之间夹角发生改变。夹角连杆182上带有滑槽(左滑槽和右滑槽),当直线舵机处在中间位置时,两翼臂153与夹角连杆182处在一条直线上,夹角正好为180º,第三直线舵机181向前向后行程一样,改变相同夹角。
转向机构19,使得四翼扑翼飞行器2发生偏航,如图11所示,设置于机架15的下底座151上,包括一固定于下底座151上的舵机191,舵机191的输出轴固定于一尾舵192。当舵机工作时,舵机的输出轴转动以带动尾舵192发生角度转动。
履带车1包括固定件3、电磁铁4、无线充电器5、履带车电池6、主控制***7、视觉机构8、视觉支撑架9、履带轮10、履带11、履带车电机12、底盘13。其中,履带轮10、履带11、履带车电机12、底盘13之间的连接关系为现有技术,在此不再赘述。
视觉机构8,与主控制***7信号连接且设置于履带车1上,如图4所示,包括:眼壳81、旋转电机82、补光灯83、仿生眼84;仿生眼84由小型的机械结构组成,可以灵活地对前方视野检测,补光灯83可以在黑暗的环境下,为仿生眼84提供照明,旋转电机82辅助仿生眼84进行前后左右的视野检测。具体的,眼壳81包括可拆卸连接的前壳体和后壳体;眼壳81通过旋转电机82转动设置于一视觉支撑架9上;眼壳81的外壁上设置补光灯;眼壳81的内部设置一仿生眼84。
仿生眼84,如图5、图6、图7所示,包括第一直线舵机841、第二直线舵机842、球面端头843,伸缩套杆844、眼球845。具体的,第一直线舵机841固定于后壳体上,第一直线舵机841的舵机推杆可沿左右方向移动且与第一滑块8411连接;第一滑块8411连接第二直线舵机842的外壳,第二直线舵机842的舵机推杆可沿上下方向移动且与第二滑块8421的后端连接;第二滑块8421的前端与一球面端头843球副连接;球面端头843的前端固定于一伸缩套杆844的后端,伸缩套杆844的前端固定于一眼球845,眼球845与眼壳81的前壳体球副连接,其中,眼球845是一种集成微型传感器8453、摄像头8454、信号传输模块8455的装置。
由此,球面端头球心8431随第二滑块8421可以移动,球面端头843可以围绕球面端头球心8431转动,眼球球心8451是固定的,眼球845可以围绕眼球球心8451转动。
第一直线舵机841与第二直线舵机842构成了一个丝杆十字装置,第一直线舵机841通过第一滑块8411带动第二直线舵机842整体左右移动,第二直线舵机842可以使第二滑块8421进行上下移动,所以第二滑块8421能够在空间内进行上下左右移动,第二滑块8421带动球面端头843移动,球面端头球心8431将会在固定的球心平面8432进行上下左右移动,并且球面端头843围绕球面端头球心8431转动,然后带动伸缩套杆844的位置和长度变化,引起眼球845在眼壳81的前壳体内围绕眼球球心8451转动,从而做出仿照动物眼的视觉方向8452变换,球面端头球心8431在球心平面8432上的每一个位置点都相对应仿生眼84的一个视觉方向8452。
主控制***7和副控制***14,主控制***7设置于履带车1上,副控***设置于四翼扑翼飞行器2的机架15上;机架15上还设置一摄像单元22,摄像单元22依次与副控制***14、主控制***7信号连接。
具体的,主控制***7,如图13、图14所示,包括:PC分析模块24、主控制器71、电机驱动模块72、电流控制器73、遥控模块74。
其中, PC分析模块24和主控制器71,所述PC分析模块24用于接收并分析仿生眼84输出的环境信息和主控制器71的输出信息,之后输出指令信息至主控制器71,同时PC分析模块24与地面控制中心25进行信息传递;所述主控制器71用于接收PC分析模块24的输出指令信息并输出相应信号;所述主控制器71的第一输出端信号连接一电机驱动模块72的输入端,第二输出端信号连接一电流控制器73的输入端,第三输出端信号连接一遥控模块74的输入端,第四输出端与视觉机构8的第一直线舵机841和第二直线舵机842连接。
地面控制中心25,用于地面人员进行远程监测与控制。
电机驱动模块72,用于控制履带机的速度,电机驱动模块72的输出端与履带机上的履带车电机12信号连接。
电流控制器73用于控制电磁铁4的通电和断电,电流控制器73的输出端与电磁铁4的正负极连接,主控制器7发送调节信号给电流控制器73,电流控制器73根据信号调节电流大小,实现电磁铁4的通电和断电。
遥控模块74,用于改变翼臂153夹角和尾舵192的角度,遥控模块74的输出端与副控制***14的输入端信号连接。
四翼扑翼飞行器2的副控制***14包括:接收器141、电调模块142、电源模块143、电量数传模块144和无线图传模块145。
接收器141,用于接收遥控模块74的输出信息,接收器141的第一输出端与电调模块142的输入端信号连接,第二输出端与翼臂夹角调节机构18的第三直线舵机181信号连接,第三输出端与转向机构19的舵机信号连接。
电调模块142,用于对扑翼机构16的电机162调速,电调模块142的输出端信号连接电机162。
电源模块143和电量数传模块144,电源模块143用于获取四翼扑翼飞行器电池23的电量,之后通过电量数传模块144将电池量信号发送给PC分析模块24,PC分析模块24分析电量信息和行程信息,确定是否发送返航指令;其中,四翼扑翼飞行器电池23设置于机架15的上底座152;履带车1上设置履带车电池6,履带车电池6依次通过无线充电器5、无线充电接收器21、电源模块143给四翼扑翼飞行器电池23充电。
无线图传模块145,四翼扑翼飞行器2的摄像单元22通过无线图传模块145,将图像信息发送至PC分析模块24。
即仿生眼84中眼球845的微型传感器8453和摄像头8454探测识别环境、信号传输模块8455把环境信息传至PC分析模块24(图18所示),PC分析模块24对图像信息进行分析,根据信息发出相应的警报或发送相应指令信息给主控制器71,主控制器71在发送给指定模块,视觉机构8可以通过改变仿生眼84的视觉方向8452获取多方向信息;电机驱动模块72可以对履带车电机12进行速度控制,实现前进、后退、差速转向;电流控制器73控制电磁铁4通电断电;遥控模块74可以发送相应信息给接收器141,接收器141根据相应信息实现不同线路信号传递,电调模块142得信号,对电机162进行调速;第三直线舵机181得信号,实现翼臂153夹角改变;舵机得信号,实现尾舵192角度变化。
电源模块143可以获取四翼扑翼飞行器电池23电量,通过电量数传模块144发送给PC分析模块24,PC分析模块24分析电量信息和行程信息,确定是否发送返航指令;
四翼扑翼飞行器2的摄像单元22通过无线图传模块145发送给PC分析模块24,履带车电池6供给履带车1上所有用电设备,可通过无线充电器5、无线充电接收器21、电源模块143给四翼扑翼飞行器电池23充电,其充电原理类似现有技术中的手机无线充电;四翼扑翼飞行器电池23供给四翼扑翼飞行器2上所有用电设备。
四翼扑翼飞行器2运动动作原理:
(1)升降悬停:
控制扑翼机构16上的电机162转速,改变扑翼频率,对升力进行调整,当升力大于重力,四翼扑翼飞行器2升起,当升力等于重力时,四翼扑翼飞行器2处于悬停状态,当升力小于重力时,四翼扑翼飞行器2下降。
(2)俯仰:控制翼臂夹角调节机构18中的第三直线舵机181的移动,带动夹角连杆182运动,使翼臂153夹角发生角度变化,使飞行器发生质心位置改变,以摄像单元22面对的方向是前,当翼臂153向后翻转,质心前移,在重力与升力的作用下,飞行器出现俯的动作,向前飞;同样,当翼臂153向前翻转,飞行器出现仰的动作,向后飞。
(3)偏航: 控制转向机构19中的舵机191,使尾舵192发生角度变化,气流在尾舵192舵面两侧的流速就会不同,从而产生压力差作用在舵面上,进而产生转动力矩,实现偏航。
一种煤矿巷道空地巡检方法,如图14所示,包括以下步骤:
步骤1:将巷道信息输入至主控制***,主控制***进行路径规划,之后根据规划完成的路径驱动履带车上的履带车电机运行。
在履带车运行过程中,视觉机构通过改变仿生眼的位置以获取多方向信息,仿生眼输出图像信息至主控制***,主控制***对图像信息进行处理,并判断履带车前方是否有障碍物。
若是,则主控制***发出障碍指令,并分析履带车是否能继续前行;若履带车无法继续前行,则执行步骤2。
步骤2:主控制***连通副控制***,副控制***驱动扑翼机构的电机运行以实现四翼扑翼飞行器的飞行;
同时,主控制***控制履带车上的电磁铁断电,四翼扑翼飞行器脱离履带车;
在飞行过程中,四翼扑翼飞行器上的摄像单元实时采集巷道图像信息,并将其传输至主控制***;
运行设定时间后,副控制***获取四翼扑翼飞行器电池的电量,之后将电池量信号发送给主控制***,主控制***分析电量信息和行程信息,确定是否发送返航指令;如是,则执行步骤3。
步骤3:主控制***发送返航指令至副控制***,副控制***控制转向机构的第三直线舵机运行,使得四翼扑翼飞行器返航。
步骤4:履带车上的无线充电器依次连通四翼扑翼飞行器上的无线充电接收器、副控制***以对四翼扑翼飞行器电池充电。
上述仅为本发明的优选实施例而已,并不对本发明起到任何限制作用。任何所属技术领域的技术人员,在不脱离本发明的技术方案的范围内,对本发明揭露的技术方案和技术内容做任何形式的等同替换或修改等变动,均属未脱离本发明的技术方案的内容,仍属于本发明的保护范围之内。
Claims (8)
1.一种煤矿巷道空地巡检机器人,其特征在于,包括:
履带车;
四翼扑翼飞行器,通电飞行以进行巡检,包括:
起落架,通电以与所述履带车的顶面磁性连接;所述起落架的顶端与一机架的下底座连接;
所述机架还包括一上底座,所述上底座和下底座之间通过左右设置的碳纤杆连接,所述上底座上转动设置一对左右设置的翼臂,每根所述翼臂的外端均延伸出所述上底座,内端均可沿上底座上的弧形槽移动;每根所述翼臂上均设置一扑翼机构;每根所述碳纤杆上均套设一延伸出所述下底座的翼根,每根所述翼根的外端和对应的翼臂的外端之间通过一臂根连杆连接;每根臂根连杆上均连接一对扑翼;
所述扑翼的内侧与对应的臂根连杆固定连接,所述扑翼的顶端形成一杆体以与一扑翼机构的输出端可拆卸连接;
所述扑翼机构,用于驱动对应的一对所述扑翼张合,包括形成所述输出端的一对摇杆,一对所述摇杆呈上下设置且与所述翼臂转动连接;一对所述摇杆转动连接于同一点;每根所述摇杆上均连接一所述扑翼;每根摇杆与一个二级减速器从动轮之间均通过一曲柄连杆转动连接,两个所述二级减速器从动轮之间外啮合;两个所述二级减速器从动轮均转动安装于所述翼臂且其中一个二级减速器从动轮与一个二级减速器主动轮外啮合;所述二级减速器主动轮与一级减速器从动轮形成一双联齿轮,所述一级减速器从动轮转动安装于翼臂且与一级减速器主动轮外啮合,所述一级减速器主动轮与电机的输出轴连接,所述电机固定于所述翼臂;
主控制***和副控制***,所述主控制***设置于所述履带车上,所述副控***设置于所述四翼扑翼飞行器的机架上;所述机架上还设置一摄像单元,所述摄像单元依次与副控制***、主控制***信号连接。
2.根据权利要求1所述的煤矿巷道空地巡检机器人,其特征在于,进一步包括一与所述主控制***信号连接且设置于所述履带车上的视觉机构,所述视觉机构包括:
眼壳,包括可拆卸连接的前壳体和后壳体;所述眼壳转动设置于一视觉支撑架上;所述眼壳的外壁上设置补光灯;所述眼壳的内部设置一仿生眼;
所述仿生眼包括固定于所述后壳体上的第一直线舵机,所述第一直线舵机的舵机推杆可沿左右方向移动且与第一滑块连接;所述第一滑块连接第二直线舵机的外壳,所述第二直线舵机的舵机推杆可沿上下方向移动且与第二滑块的后端连接;所述第二滑块的前端与一球面端头球副连接;所述球面端头的前端固定于一伸缩套杆的后端,所述伸缩套杆的前端固定于一眼球,所述眼球与眼壳的前壳体球副连接。
3.根据权利要求2所述的煤矿巷道空地巡检机器人,其特征在于,所述机架的上底座上设置一用于调节两翼臂之间夹角以使得四翼扑翼飞行器进行俯仰的翼臂夹角调节机构,包括一夹角连杆,所述夹角连杆位于两所述翼臂之间,所述夹角连杆的左端有一左滑槽,一立柱穿过左滑槽卡设于左侧的翼臂上,右端有一右滑槽,一立柱穿过右滑槽卡设于右侧的翼臂;两所述立柱与上底座上的弧形槽配合设置;所述夹角连杆的上段固定于第三直线舵机的舵机推杆,所述第三直线舵机的舵机推杆可沿前后方向移动;所述第三直线舵机的机身固定于所述上底座。
4.根据权利要求3所述的煤矿巷道空地巡检机器人,其特征在于,所述机架的下底座上设置一使得四翼扑翼飞行器发生偏航的转向机构,包括一固定于所述下底座上的舵机,所述舵机的输出轴固定于一尾舵。
5.根据权利要求4所述的煤矿巷道空地巡检机器人,其特征在于,所述履带车顶面上设置一电磁铁;
所述起落架包括一支撑架,所述支撑架的上端形成一连接件以与所述机架的下底座可拆卸连接,所述支撑架上固定一无线充电接收器,所述无线充电接收器的输入端连接一无线充电器;所述无线充电器套设在所述电磁铁上;
所述无线充电接收器上设置一软铁片;所述电磁铁通电产生磁性吸引所述软铁片以连接履带车与四翼扑翼飞行器。
6.根据权利要求5所述的煤矿巷道空地巡检机器人,其特征在于,所述主控制***包括:
PC分析模块和主控制器,所述PC分析模块用于接收并分析仿生眼输出的环境信息和主控制器的输出信息,之后输出指令信息至主控制器,同时PC分析模块与地面控制中心进行信息传递;所述主控制器用于接收PC分析模块的输出指令信息并输出相应信号;所述主控制器的第一输出端信号连接一电机驱动模块的输入端,第二输出端信号连接一电流控制器的输入端,第三输出端信号连接一遥控模块的输入端,第四输出端与视觉机构的第一直线舵机和第二直线舵机连接;
所述地面控制中心,用于地面人员进行远程监测与控制;
所述电机驱动模块,用于控制履带机的速度,所述电机驱动模块的输出端与履带机上的履带车电机信号连接;
所述电流控制器用于控制电磁铁的通电和断电,所述电流控制器的输出端与电磁铁的正负极连接,主控制器发送调节信号给电流控制器,电流控制器根据信号调节电流大小,实现电磁铁的通电和断电;
所述遥控模块,用于改变翼臂夹角和尾舵的角度,所述遥控模块的输出端与所述副控制***的输入端信号连接。
7.根据权利要求6所述的煤矿巷道空地巡检机器人,其特征在于,所述副控制***包括:
接收器,用于接收所述遥控模块的输出信息,所述接收器的第一输出端与电调模块的输入端信号连接,第二输出端与翼臂夹角调节机构的第三直线舵机信号连接,第三输出端与转向机构的舵机信号连接;
所述电调模块,用于对扑翼机构的电机调速,所述电调模块的输出端信号连接所述电机;
电源模块和电量数传模块,所述电源模块用于获取四翼扑翼飞行器电池的电量,之后通过电量数传模块将电池量信号发送给PC分析模块,PC分析模块分析电量信息和行程信息,确定是否发送返航指令;其中,所述四翼扑翼飞行器电池设置于所述机架的上底座;所述履带车上设置履带车电池,所述履带车电池依次通过无线充电器、无线充电接收器、电源模块给四翼扑翼飞行器电池充电;
无线图传模块,四翼扑翼飞行器的摄像单元通过无线图传模块,将图像信息发送至PC分析模块。
8.一种煤矿巷道空地巡检方法,基于权利要求4~7之任一项所述的煤矿巷道空地巡检机器人,其特征在于,包括以下步骤:
步骤1:将巷道信息输入至主控制***,所述主控制***进行路径规划,之后根据规划完成的路径驱动履带车上的履带车电机运行;
在履带车运行过程中,视觉机构通过改变仿生眼的视觉方向以获取多方向信息,仿生眼输出图像信息至主控制***,主控制***对图像信息进行处理,并判断履带车前方是否有障碍物;
若是,则主控制***发出障碍指令,并分析履带车是否能继续前行;若履带车无法继续前行,则执行步骤2;
步骤2:主控制***连通副控制***,副控制***驱动扑翼机构的电机运行以实现四翼扑翼飞行器的飞行;
之后,主控制***控制履带车上的电磁铁断电,四翼扑翼飞行器脱离履带车;
在飞行过程中,四翼扑翼飞行器上的摄像单元实时采集巷道图像信息,并将其传输至主控制***;
运行设定时间后,副控制***获取四翼扑翼飞行器电池的电量,之后将电池量信号发送给主控制***,主控制***分析电量信息和行程信息,确定是否发送返航指令;如是,则执行步骤3;
步骤3:主控制***发送返航指令至副控制***,副控制***控制转向机构的第三直线舵机运行,使得四翼扑翼飞行器返航;
步骤4:履带车上的无线充电器依次连通四翼扑翼飞行器上的无线充电接收器、副控制***以对四翼扑翼飞行器电池充电。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210343568.8A CN114536297A (zh) | 2022-03-31 | 2022-03-31 | 一种煤矿巷道空地巡检机器人及巡检方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210343568.8A CN114536297A (zh) | 2022-03-31 | 2022-03-31 | 一种煤矿巷道空地巡检机器人及巡检方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114536297A true CN114536297A (zh) | 2022-05-27 |
Family
ID=81664745
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210343568.8A Pending CN114536297A (zh) | 2022-03-31 | 2022-03-31 | 一种煤矿巷道空地巡检机器人及巡检方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114536297A (zh) |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107905835A (zh) * | 2017-12-22 | 2018-04-13 | 中国矿业大学 | 一种复合构型的井下救援机器人及其救援方法 |
CN112034868A (zh) * | 2020-08-06 | 2020-12-04 | 北京航空航天大学 | 一种仿生微型扑翼飞行器偏航控制方法和机构 |
WO2021196529A1 (zh) * | 2020-04-02 | 2021-10-07 | 同济人工智能研究院(苏州)有限公司 | 空地协同式智能巡检机器人及巡检方法 |
CN113858161A (zh) * | 2021-10-27 | 2021-12-31 | 中国矿业大学 | 一种基于仿生眼的轨道式搬运机器人及工作方法 |
CN114212159A (zh) * | 2021-11-24 | 2022-03-22 | 西北工业大学 | 一种单电机驱动的仿蝗虫跳跃扑翼双运动模式机构 |
-
2022
- 2022-03-31 CN CN202210343568.8A patent/CN114536297A/zh active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107905835A (zh) * | 2017-12-22 | 2018-04-13 | 中国矿业大学 | 一种复合构型的井下救援机器人及其救援方法 |
WO2021196529A1 (zh) * | 2020-04-02 | 2021-10-07 | 同济人工智能研究院(苏州)有限公司 | 空地协同式智能巡检机器人及巡检方法 |
CN112034868A (zh) * | 2020-08-06 | 2020-12-04 | 北京航空航天大学 | 一种仿生微型扑翼飞行器偏航控制方法和机构 |
CN113858161A (zh) * | 2021-10-27 | 2021-12-31 | 中国矿业大学 | 一种基于仿生眼的轨道式搬运机器人及工作方法 |
CN114212159A (zh) * | 2021-11-24 | 2022-03-22 | 西北工业大学 | 一种单电机驱动的仿蝗虫跳跃扑翼双运动模式机构 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104494818B (zh) | 四旋翼两栖机器人 | |
CN103192987A (zh) | 一种飞行和爬壁两栖机器人及其控制方法 | |
CN104627342A (zh) | 一种滑翔机器海豚 | |
CN202345914U (zh) | 一种可以追踪声源的智能充氦扑翼飞行器 | |
CN108583182B (zh) | 一种空陆两栖球形机器人 | |
CN110182365B (zh) | 一种煤矿井下防爆型四旋翼无人机 | |
CN109702756B (zh) | 水陆空八杆侦察机器人 | |
CN103112513A (zh) | 一种具有姿态调整功能的仿蝗虫机器人 | |
CN208395628U (zh) | 一种集成弯沉仪移动平台的检测装置 | |
CN114013230B (zh) | 一种具备墙面栖停与爬行能力的四旋翼机器人 | |
CN105923168A (zh) | 用于机载云台测试的旋翼机飞行模拟平台 | |
CN110815245A (zh) | 用于迎宾的服务机器人 | |
CN115951620A (zh) | 一种无人机智能化设备管控*** | |
CN209814271U (zh) | 一种四自由度扑翼飞行器装置 | |
CN104477385B (zh) | 一种无人扑翼飞行器 | |
CN109911197B (zh) | 一种四自由度扑翼飞行器装置 | |
CN111559212A (zh) | 一种海空双动力两栖无人机及其工作方法 | |
CN111152921A (zh) | 一种可垂直起降的无人机的控制*** | |
CN105667631A (zh) | 自主弹跳越障的遥控小车 | |
CN114536297A (zh) | 一种煤矿巷道空地巡检机器人及巡检方法 | |
CN113428253A (zh) | 一种地空协同检测机器人及船舱检测方法 | |
CN102699897A (zh) | 一种铁磁环境复杂地域全景探测机器人单体 | |
Probine et al. | A shared control teleoperation framework for robotic airships: Combining intuitive interfaces and an autonomous landing system | |
CN109228809B (zh) | 一种纳型空陆两用机器人 | |
CN109250110A (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 |