CN112157662B - Blasting robot - Google Patents
Blasting robot Download PDFInfo
- Publication number
- CN112157662B CN112157662B CN202010924096.6A CN202010924096A CN112157662B CN 112157662 B CN112157662 B CN 112157662B CN 202010924096 A CN202010924096 A CN 202010924096A CN 112157662 B CN112157662 B CN 112157662B
- Authority
- CN
- China
- Prior art keywords
- module
- mechanical arm
- push rod
- blasting
- hole
- 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
Links
- 238000005422 blasting Methods 0.000 title claims abstract description 72
- 210000000078 claw Anatomy 0.000 claims abstract description 30
- 230000000007 visual effect Effects 0.000 claims description 43
- 239000002360 explosive Substances 0.000 claims description 11
- 230000010365 information processing Effects 0.000 claims description 9
- 238000006243 chemical reaction Methods 0.000 claims description 8
- 238000000034 method Methods 0.000 claims description 7
- 230000006641 stabilisation Effects 0.000 claims 2
- 238000011105 stabilization Methods 0.000 claims 2
- 230000007613 environmental effect Effects 0.000 abstract description 17
- 238000010586 diagram Methods 0.000 description 2
- 238000009825 accumulation Methods 0.000 description 1
- 230000004888 barrier function Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 210000000245 forearm Anatomy 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 230000004807 localization Effects 0.000 description 1
- 239000000463 material Substances 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
- 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
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
-
- 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/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
-
- 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
-
- 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/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F42—AMMUNITION; BLASTING
- F42D—BLASTING
- F42D1/00—Blasting methods or apparatus, e.g. loading or tamping
-
- 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
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- General Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
Abstract
Description
技术领域technical field
本发明涉及爆破机器人技术领域,尤其涉及一种爆破机器人。The invention relates to the technical field of blasting robots, in particular to a blasting robot.
背景技术Background technique
在铁路、矿山、水库、隧道、旧建筑物等工程中,爆破技术起到了非常关键的作用。近年来,随着科学技术的发展,用爆破机器人自动完成旧建筑物、隧道、工程中炸药、雷管和塞孔物的填充主要是采取人工填充的方式,在旧建筑物、隧道、矿山等壁面、立柱上事先进行打孔,然后依靠工人经验将炸药、雷管和塞孔物依次填充入孔。In railways, mines, reservoirs, tunnels, old buildings and other projects, blasting technology has played a very critical role. In recent years, with the development of science and technology, the automatic filling of explosives, detonators and plug holes in old buildings, tunnels and projects with blasting robots is mainly done manually. 1. Drill holes on the column in advance, and then rely on the experience of workers to fill the holes with explosives, detonators and plugs in sequence.
但随着爆破工程量的增大,需要填充的孔数量大大增加,从而导致工人的劳动强度和人身安全风险增大。爆破现场环境恶劣,会有碎石堆积以及泥泞的路段,这就需要爆破机器人也有一定攀越障碍物的能力。现在机器人的实用性不强,无法满足爆破工程的要求。However, with the increase in the amount of blasting work, the number of holes to be filled increases greatly, resulting in increased labor intensity and personal safety risks for workers. The environment of the blasting site is harsh, and there will be accumulation of gravel and muddy road sections, which requires the blasting robot to have the ability to climb over obstacles. The practicability of the robot is not strong at present, and it cannot meet the requirements of blasting engineering.
同时,由于旧建筑物、隧道、矿山等壁面、立柱上的孔众多,仅仅通过爆破机器人的机械臂无法实现对每个孔的自动识别。如申请号为CN201621035834.7的专利所涉及的爆破机器人,虽然安装有机械臂,但是无法实现对需堵塞孔的准确定位和自动识别。At the same time, due to the many holes on the walls and columns of old buildings, tunnels, mines, etc., automatic identification of each hole cannot be realized only through the mechanical arm of the blasting robot. For example, the blasting robot involved in the patent with the application number CN201621035834.7, although equipped with a mechanical arm, cannot accurately locate and automatically identify the hole to be plugged.
发明内容Contents of the invention
有鉴于此,有必要提供一种爆破机器人,用以解决目前爆破机器人无法越障以及无法对需堵塞孔进行定位和识别的问题。In view of this, it is necessary to provide a blasting robot to solve the problems that the current blasting robot cannot overcome obstacles and cannot locate and identify holes to be plugged.
本发明提供一种爆破机器人,包括行走越障底盘、机械臂底座、机械臂、机械爪、电动推杆、工控机和采集装置,其中,The invention provides a blasting robot, which includes a walking obstacle-crossing chassis, a mechanical arm base, a mechanical arm, a mechanical claw, an electric push rod, an industrial computer and a collection device, wherein,
所述机械臂底座和所述工控机均固定安装在所述行走越障底盘上,所述机械臂固定于所述机械臂底座上,所述机械爪和所述电动推杆均固定于所述机械臂的末端,所述电动推杆用于将机械爪上夹持的塞孔物推入需堵塞孔中,所述工控机与所述行走越障底盘、机械臂、机械爪和电动推杆电连接;Both the base of the mechanical arm and the industrial computer are fixedly installed on the chassis of the walking obstacle, the mechanical arm is fixed on the base of the mechanical arm, the claws and the electric push rod are fixed on the The end of the mechanical arm, the electric push rod is used to push the plug hole held on the mechanical claw into the hole to be plugged, the industrial computer is connected with the walking obstacle chassis, mechanical arm, mechanical claw and electric push rod electrical connection;
所述采集装置包括采集装置底座、云台升降机构、视觉传感器、激光传感器、视觉传感器控制装置和激光传感器控制装置,所述采集装置底座固定安装在所述行走越障底盘上,所述云台升降机构固定于所述采集装置底座上,所述视觉传感器、激光传感器、视觉传感器控制装置和激光传感器控制装置均固定安装在所述云台升降机构上,所述视觉传感器与所述视觉传感器控制装置电连接,所述云台升降机构、所述视觉传感器控制装置和激光传感器控制装置均与所述工控机电连接;The collection device includes a collection device base, a pan-tilt lifting mechanism, a visual sensor, a laser sensor, a visual sensor control device, and a laser sensor control device. The collection device base is fixedly installed on the walking obstacle-crossing chassis. The lifting mechanism is fixed on the base of the acquisition device, the visual sensor, laser sensor, visual sensor control device and laser sensor control device are all fixedly installed on the pan-tilt lifting mechanism, and the visual sensor and the visual sensor control The device is electrically connected, and the pan-tilt lifting mechanism, the visual sensor control device and the laser sensor control device are all electrically connected to the industrial control machine;
所述视觉传感器控制装置用于根据需堵塞孔的图像信息发出第一控制指令至所述工控机,以使所述工控机控制所述机械臂动作并对准需堵塞孔;所述激光传感器控制装置用于根据激光传感器采集的环境信息发出第二控制指令至所述工控机,以使所述工控机控制所述行走越障底盘行走到预定位置。。The visual sensor control device is used to send a first control instruction to the industrial computer according to the image information of the hole to be blocked, so that the industrial computer controls the movement of the mechanical arm and aligns the hole to be blocked; the laser sensor controls The device is used to send a second control instruction to the industrial computer according to the environmental information collected by the laser sensor, so that the industrial computer controls the walking obstacle-crossing chassis to move to a predetermined position. .
优选的,所述的爆破机器人中,所述机械臂为六自由度机械臂。Preferably, in the blasting robot, the robotic arm is a six-degree-of-freedom robotic arm.
优选的,所述的爆破机器人中,所述云台升降机构包括稳定云台以及升降装置,所述稳定云台固定设置在所述升降装置上,所述升降装置固定设置在所述采集装置底座上。Preferably, in the blasting robot, the platform lifting mechanism includes a stable platform and a lifting device, the stable platform is fixed on the lifting device, and the lifting device is fixed on the base of the collection device superior.
优选的,所述的爆破机器人中,所述视觉传感器控制装置包括依次连接的捕捉模块、信息处理模块以及第一控制模块,其中,Preferably, in the blasting robot, the visual sensor control device includes a capture module, an information processing module and a first control module connected in sequence, wherein,
所述捕捉模块用于捕捉所述视觉传感器采集的图像信息;The capture module is used to capture the image information collected by the visual sensor;
所述信息处理模块用于根据所述图像信息生成需堵塞孔的位置和尺寸信息;The information processing module is used to generate position and size information of holes to be blocked according to the image information;
所述第一控制模块用于根据所述需堵塞孔的位置和尺寸信息生成第一控制指令,并发送给所述工控机。The first control module is used to generate a first control instruction according to the position and size information of the hole to be plugged, and send it to the industrial computer.
优选的,所述的爆破机器人中,所述捕捉模块具体用于捕捉所述视觉传感器采集的或者预先输入的需堵塞孔的图像信息。Preferably, in the blasting robot, the capture module is specifically used to capture the image information of the hole to be blocked collected by the vision sensor or input in advance.
优选的,所述的爆破机器人中,所述第一控制模块具体用于确定需堵塞孔的位置和尺寸信息对应的工控机目标状态,根据确定的工控机目标状态生成所述第一控制命令;或者Preferably, in the blasting robot, the first control module is specifically configured to determine the target state of the industrial computer corresponding to the position and size information of the hole to be plugged, and generate the first control command according to the determined target state of the industrial computer; or
将需堵塞孔的位置和尺寸信息与预设的基准信息进行比较,根据比较结果和工控机基准状态,确定工控机目标状态后,根据确定的工控机目标状态,生成所述第一控制命令。Comparing the position and size information of the hole to be plugged with the preset reference information, determining the target state of the industrial computer according to the comparison result and the reference state of the industrial computer, and generating the first control command according to the determined target state of the industrial computer.
优选的,所述的爆破机器人中,所述第一控制指令至少包括包括机械臂动作路径控制指令以及云台升降机构控制指令。Preferably, in the blasting robot, the first control instruction includes at least a control instruction of the movement path of the mechanical arm and a control instruction of the pan-tilt lifting mechanism.
优选的,所述的爆破机器人中,所述捕捉模块还用于在生成第一控制命令之前,捕捉待填充面的地图信息。Preferably, in the blasting robot, the capture module is further configured to capture map information of the surface to be filled before generating the first control command.
优选的,所述的爆破机器人中,所述激光传感器控制装置包括采集模块、信息转换模块、生成模块、判断模块以及第二控制模块,其中,Preferably, in the blasting robot, the laser sensor control device includes an acquisition module, an information conversion module, a generation module, a judgment module and a second control module, wherein,
所述采集模块用于获取激光传感器采集的环境信息;The collection module is used to obtain the environmental information collected by the laser sensor;
所述信息转换模块用于根据所述环境信息进行处理;The information conversion module is used for processing according to the environmental information;
所述生成模块用于根据处理后的环境信息生成爆破地面环境的二维地图;The generating module is used to generate a two-dimensional map of the blasting ground environment according to the processed environmental information;
所述判断模块用于根据生成的爆破地面环境的二维地图对爆破机器人的当前位置进行定位,并判断当前位置与预定位置的偏差;The judging module is used to locate the current position of the blasting robot according to the generated two-dimensional map of the blasting ground environment, and judge the deviation between the current position and the predetermined position;
所述第二控制模块用于根据当前位置与预定位置的偏差生成第二控制指令,并将所述第二控制指令发送至所述工控机。The second control module is used to generate a second control command according to the deviation between the current position and the predetermined position, and send the second control command to the industrial computer.
优选的,所述的爆破机器人中,所述第二控制指令至少包括爆破机器人行进速度控制指令和爆破机器人行进方向控制指令。Preferably, in the blasting robot, the second control instruction includes at least a traveling speed control instruction and a traveling direction control instruction of the blasting robot.
【有益效果】【Beneficial effect】
本发明提供的爆破机器人,通过设置机械臂、机械爪和电动推杆,可以实现对炸药、雷管等塞孔物的抓取和填充,通过设置行走越障底盘,使爆破机器人具有一定的攀越障碍物的能力,通过视觉传感器控制装置的图像处理功能,能够实现对需堵塞孔的孔口尺寸位置的识别和定位;通过激光传感器控制装置的环境信息处理功能,能够实现爆破机器人的导航和定位。The blasting robot provided by the present invention can grasp and fill the plug holes such as explosives and detonators by setting up the mechanical arm, the mechanical claw and the electric push rod. The ability of obstacles, through the image processing function of the visual sensor control device, can realize the identification and positioning of the size and position of the hole to be blocked; through the environmental information processing function of the laser sensor control device, it can realize the navigation and positioning of the blasting robot .
附图说明Description of drawings
图1为本发明提供的爆破机器人的一较佳实施例的结构示意图;Fig. 1 is a schematic structural view of a preferred embodiment of the blasting robot provided by the present invention;
图2为本发明提供的爆破机器人中,所述视觉传感器控制装置的一较佳实施例的结构框图;Fig. 2 is a structural block diagram of a preferred embodiment of the visual sensor control device in the blasting robot provided by the present invention;
图3为本发明提供的爆破机器人中,所述激光传感器控制装置的一较佳实施例的结构框图;Fig. 3 is a structural block diagram of a preferred embodiment of the laser sensor control device in the blasting robot provided by the present invention;
图4为本发明提供的爆破机器人在进行一个孔的填装的一具体实施例的流程图。Fig. 4 is a flow chart of a specific embodiment of the blasting robot provided by the present invention filling a hole.
具体实施方式Detailed ways
下面结合附图来具体描述本发明的优选实施例,其中,附图构成本申请一部分,并与本发明的实施例一起用于阐释本发明的原理,并非用于限定本发明的范围。Preferred embodiments of the present invention will be described in detail below in conjunction with the accompanying drawings, wherein the accompanying drawings constitute a part of the application and together with the embodiments of the present invention are used to explain the principle of the present invention and are not intended to limit the scope of the present invention.
请参阅图1,本发明实施例提供的爆破机器人,包括行走越障底盘1、机械臂底座2、机械臂3、机械爪4、电动推杆5、工控机6和采集装置7,其中,Please refer to Fig. 1, the blasting robot provided by the embodiment of the present invention includes a walking obstacle surmounting chassis 1, a
所述机械臂底座2和所述工控机6均固定安装在所述行走越障底盘1上,所述机械臂3固定于所述机械臂底座2上,所述机械爪4和所述电动推杆5均固定于所述机械臂3的末端,所述电动推杆5用于将机械爪4上夹持的塞孔物(例如炸药、雷管等物品)推入需堵塞孔中,所述工控机6与所述行走越障底盘1、机械臂3、机械爪4和电动推杆5电连接;Both the
所述采集装置7包括采集装置底座71、云台升降机构72、视觉传感器73、激光传感器74、视觉传感器控制装置75和激光传感器控制装置76,所述采集装置底座71固定安装在所述行走越障底盘1上,所述云台升降机构72固定于所述采集装置底座71上,所述视觉传感器73、激光传感器74、视觉传感器控制装置75和激光传感器控制装置76均固定安装在所述云台升降机构72上,所述视觉传感器73与所述视觉传感器控制装置75电连接,所述云台升降机构72、所述视觉传感器控制装置75和激光传感器控制装置76均与所述工控机6电连接;The
所述视觉传感器控制装置75用于根据需堵塞孔的图像信息发出第一控制指令至所述工控机6,以使所述工控机6控制所述机械臂3动作并对准需堵塞孔;所述激光传感器控制装置76用于根据激光传感器74采集的环境信息发出第二控制指令至所述工控机6,以使所述工控机6控制所述行走越障底盘1行走到预定位置。The visual sensor control device 75 is used to send a first control instruction to the
具体来说,本发明中爆破机器人由于设置有行走越障底盘1,能够承受整个爆破机器人的重量,并承载爆破机器人越障行走,机械臂3能够带动用于夹持塞孔物的机械爪4运动,从而使机械爪4将塞孔物夹持到需堵塞孔处,然后通过电动推杆5将机械爪4夹持的塞孔物推入需堵塞孔中;云台升降机构72可以改变视觉传感器73和激光传感器74的位置,从而获取各个方位的图像信息和环境信息;所述视觉传感器73用于采集需堵塞孔的图像信息,以使所述视觉传感器控制装置75能够根据采集的图像信息识别出需堵塞孔的大小和位置,进而发出第一控制指令给工控机6,使所述工控机6能够控制机械臂3对准需堵塞孔,然后由电动推杆5将机械爪4上夹持的塞孔物推入需堵塞孔中,从而实现对需堵塞孔的尺寸及位置识别和定位;所述激光传感器74用于采集环境信息,使所述激光传感器控制装置76能够发出第二控制指令至所述工控机6,进而使工控机6控制行走越障底盘1运动至目标地点。Specifically, since the blasting robot in the present invention is provided with a walking obstacle-crossing chassis 1, it can bear the weight of the entire blasting robot, and carry the blasting robot to walk over obstacles. The
本发明可以实现对炸药、雷管等塞孔物的抓取和填充,通过视觉传感器控制装置的图像处理功能,能够实现对需堵塞孔的孔口尺寸位置的识别和定位;通过激光传感器控制装置的环境信息处理功能,能够实现爆破机器人的导航和定位。The invention can realize the grabbing and filling of plugging materials such as explosives and detonators, and can realize the recognition and positioning of the size and position of the hole to be plugged through the image processing function of the visual sensor control device; The environmental information processing function can realize the navigation and positioning of the blasting robot.
进一步的实施例中,所述行走越障底盘1为履带式坦克底盘,包括两个主履带,能够承受机械系统和采集系统的重量,并承载爆破机器人本体越障行走。In a further embodiment, the obstacle-crossing chassis 1 is a crawler-type tank chassis, including two main crawlers, which can bear the weight of the mechanical system and the acquisition system, and carry the body of the blasting robot to walk over obstacles.
进一步的实施例中,请继续参阅图1,所述机械臂3为六自由度机械臂,由六个关节组成,且每个关节均通过所述工控机6的控制可以实现精确的位置和角度控制,所述机械臂3通过CAN总线连接所述工控机6。所述六自由度机械臂的具体结构为现有技术,在此不再赘述。In a further embodiment, please continue to refer to FIG. 1 , the
请继续参阅图1,所述机械爪4包括机械爪本体以及若干个驱动电机,所述机械爪本体具有至少两个卡爪,各个所述驱动电机分别连接一卡爪,并用于驱动各个卡爪相互靠近或远离,以使所述机械爪本体能够自由开合,进而夹持或松开塞孔物,各个所述驱动电机与所述工控机6电连接,由所述工控机6控制动作,具体通过CAN总线连接。Please continue to refer to Figure 1, the mechanical gripper 4 includes a mechanical gripper body and several drive motors, the mechanical gripper body has at least two grippers, each of the drive motors is connected to a gripper respectively, and is used to drive each gripper close to or far away from each other, so that the mechanical claw body can be opened and closed freely, and then clamp or loosen the plug hole, each of the drive motors is electrically connected to the
请继续参阅图1,所述电动推杆5包括直流电机、缸套、推杆和活塞,所述直流电机的输出轴与所述活塞的一端连接,所述缸套套设在所述活塞上,所述活塞的另一端连接所述推杆,所述推杆用于将机械爪4上夹持的塞孔物推入需堵塞孔中,所述直流电机与所述工控机6电连接,具体通过CAN总线连接。电动推杆4安装在机械臂3前臂的正下方,采用直流电机驱动,最小推杆行程为500mm,最小推力为1000N。当工控机6发出信号,控制推杆推出时,推杆的运动轨迹位于机械爪4的中心,从而使得推杆能够精确的将机械爪4所抓取的炸药、雷管和塞孔物推入孔内。Please continue to refer to Figure 1, the
所述云台升降机构72包括稳定云台721以及升降装置722,所述稳定云台721固定设置在所述升降装置722上,所述升降装置722固定设置在所述采集装置底座71上,所述升降装置722用于实现稳定云台721的上升和下降,所述稳定云台721用于实现三轴旋转自适应调节。所述视觉传感器73、激光传感器74、视觉传感器控制装置75和激光传感器控制装置76均安装在稳定云台721上,视觉传感器73和视觉传感器控制装置75安装在稳定云台721的一侧,激光传感器74和视觉传感器控制装置76安装在稳定云台721的另一侧,易于保持云台升降机构72的相对平衡。The cloud
请一并参阅图2,所述视觉传感器控制装置75包括依次连接的捕捉模块751、信息处理模块752以及第一控制模块753,其中,Please also refer to FIG. 2, the visual sensor control device 75 includes a
所述捕捉模块751用于捕捉所述视觉传感器73采集的图像信息;The
所述信息处理模块752用于根据所述图像信息生成需堵塞孔的位置和尺寸信息;The
所述第一控制模块753用于根据所述需堵塞孔的位置和尺寸信息生成第一控制指令,并发送给所述工控机6。The
具体的,所述捕捉模块751具体用于捕捉所述视觉传感器采集的或者预先输入的需堵塞孔的图像信息。换而言之,所述捕捉模块751可以直接获取视觉传感器73采集的需堵塞孔的图像信息,亦可以获取由操作人员预先输入需堵塞孔的图像信息。Specifically, the
进一步来说,在一个实施例中,所述第一控制模块753具体用于确定需堵塞孔的位置和尺寸信息对应的工控机目标状态,根据确定的工控机目标状态生成所述第一控制命令。Further, in one embodiment, the
在另一个实施例中,所述第一控制模块753具体将需堵塞孔的位置和尺寸信息与预设的基准信息进行比较,根据比较结果和工控机基准状态,确定工控机目标状态后,根据确定的工控机目标状态,生成所述第一控制命令。In another embodiment, the
进一步来说,所述第一控制指令为针对爆破机器人自身的控制命令,至少包括机械臂动作路径控制指令以及云台升降机构控制指令。所述工控机6可根据第一控制指令来实现对机械臂3或者云台升降机构72的控制。Further, the first control command is a control command for the blasting robot itself, at least including a control command for the movement path of the mechanical arm and a control command for the pan-tilt lifting mechanism. The
进一步的实施例中,所述捕捉模块751还用于在根据需堵塞孔的图像信息生成对应的第一控制命令之前,捕捉待填充墙面、柱面等地图信息中的至少一种。故为了保证生成的第一控制指令可以精准的控制机械臂对准需堵塞孔,所述第一控制模块753还用于根据待填充墙面、柱面等地图信息中的至少一种,以及需堵塞孔的图像信息,生成对应的第一控制命令。In a further embodiment, the
请一并参阅图3,所述激光传感器控制装置76包括采集模块761、信息转换模块762、生成模块763、判断模块764以及第二控制模块765,其中,Please also refer to FIG. 3 , the laser sensor control device 76 includes an
所述采集模块761用于获取激光传感器74采集的环境信息,所述环境信息包括地面环境信息、地图信息和障碍物信息中的至少一种;The
所述信息转换模块762用于根据所述环境信息进行处理,具体对所述环境信息进行识别和计算处理;The
所述生成模块763用于根据处理后的环境信息生成爆破地面环境的二维地图,具体根据所述环境信息和编码器8的信息融合后生成所述二维地图;The
所述判断模块764用于根据生成的爆破地面环境的二维地图对爆破机器人的当前位置进行定位,并判断当前位置与预定位置的偏差;The judging
所述第二控制模块765用于根据当前位置与预定位置的偏差生成第二控制指令,并将所述第二控制指令发送至所述工控机6,以使所述工控机6控制所述行走越障底盘1进行相应的运动。The
具体的,采集模块761的信号输入端与激光传感器74的输出单元相连接,信息转换模块762的信号输入端与采集模块761的信号输出端相连接,生成模块763的信号输入端与信息转换模块762的信号输出端相连接,编码器8的信号输出端与生成模块763的另一信号输入端相连接,判断模块764的信号输入端与生成模块763的信号输出端相连接,控制指令模块765的信号输入端与判断模块764的信号输出端相连接。Specifically, the signal input end of the
进一步的,所述第二控制指令至少包括爆破机器人行进速度控制指令和爆破机器人行进方向控制指令。可精准的控制爆破机器人的行走速度和方向。Further, the second control instruction includes at least a traveling speed control instruction of the blasting robot and a traveling direction control instruction of the blasting robot. It can precisely control the walking speed and direction of the blasting robot.
为了更好的理解本发明,以下结合图4举例说明爆破机器人完成一个孔的填装任务的工作方法,包括如下步骤:In order to better understand the present invention, below in conjunction with Fig. 4, illustrate the working method of blasting robot to finish the filling task of a hole, comprise the steps:
步骤一、爆破机器人通过激光传感器74导航行走到需要填充炸药和雷管等壁面、柱子等前方的位置,并通过视觉传感器73获得需要填充的孔口位置;Step 1. The blasting robot navigates and walks to the position in front of walls, pillars, etc. that need to be filled with explosives and detonators through the laser sensor 74, and obtains the position of the orifice that needs to be filled through the visual sensor 73;
步骤二、爆破机器人控制所述机械爪4抓取并夹持住炸药,爆破机器人控制所述机械臂3运动到孔口位置;
步骤三、爆破机器人向电动推杆5发送推杆指令,电动推杆5接收到推杆指令并完成推杆动作后缩回;
步骤四、爆破机器人控制机械爪4抓取并夹持住雷管,爆破机器人控制机械臂3运动到孔口位置后,重复步骤三;Step 4. The blasting robot controls the mechanical claw 4 to grab and hold the detonator. After the blasting robot controls the
步骤五、爆破机器人控制机械爪3抓取并夹持住塞孔物,爆破机器人控制机械臂3运动到孔口位置后,重复步骤三;
步骤六、机械臂3接收到电动推杆5到位信号后,收起机械臂3,完成一个孔的填装任务。Step 6: After the
综上所述,本发明提供的爆破机器人,通过设置机械臂、机械爪和电动推杆,可以实现对炸药、雷管等塞孔物的抓取和填充,通过设置行走越障底盘,使爆破机器人具有一定的攀越障碍物的能力,通过视觉传感器控制装置的图像处理功能,能够实现对需堵塞孔的孔口尺寸位置的识别和定位;通过激光传感器控制装置的环境信息处理功能,能够实现爆破机器人的导航和定位。In summary, the blasting robot provided by the present invention can grasp and fill the plug holes such as explosives and detonators by setting the mechanical arm, the mechanical claw and the electric push rod. With a certain ability to climb over obstacles, through the image processing function of the visual sensor control device, it can realize the identification and positioning of the size and position of the hole to be blocked; through the environmental information processing function of the laser sensor control device, it can realize blasting Navigation and localization of robots.
以上所述,仅为本发明较佳的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本发明的保护范围之内。The above is only a preferred embodiment of the present invention, but the scope of protection of the present invention is not limited thereto. Any person skilled in the art within the technical scope disclosed in the present invention can easily think of changes or Replacement should be covered within the protection scope of the present invention.
Claims (5)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010924096.6A CN112157662B (en) | 2020-09-04 | 2020-09-04 | Blasting robot |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010924096.6A CN112157662B (en) | 2020-09-04 | 2020-09-04 | Blasting robot |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112157662A CN112157662A (en) | 2021-01-01 |
CN112157662B true CN112157662B (en) | 2023-07-07 |
Family
ID=73858520
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010924096.6A Active CN112157662B (en) | 2020-09-04 | 2020-09-04 | Blasting robot |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112157662B (en) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114800478A (en) * | 2021-01-28 | 2022-07-29 | 南京埃尔乔亿自控设备有限公司 | Crawler-type barrier-breaking robot |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2003311670A (en) * | 2002-04-17 | 2003-11-05 | Denso Wave Inc | Robot arm position control method and robot apparatus |
CN105415380A (en) * | 2015-12-11 | 2016-03-23 | 国网山东省电力公司电力科学研究院 | Transformer substation inspection robot system for detecting equipment in box and method thereof |
CN110147106A (en) * | 2019-05-29 | 2019-08-20 | 福建(泉州)哈工大工程技术研究院 | Intelligent mobile service robot with laser and visual fusion obstacle avoidance system |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN2667451Y (en) * | 2003-11-03 | 2004-12-29 | 陈海文 | Remote-control automatic charge machine |
CN106382869B (en) * | 2015-10-26 | 2018-01-23 | 北方爆破科技有限公司 | The control method of on-site mixed explosive Work robot |
CN208042896U (en) * | 2018-03-29 | 2018-11-02 | 贵州息烽磷矿有限责任公司 | A kind of explosion auxiliary device easy to use |
CN109827482B (en) * | 2019-03-27 | 2021-08-13 | 辽宁科技大学 | A method for recognizing the position and attitude of a blasthole for deep-hole charge and a blasthole docking device |
CN110434874A (en) * | 2019-08-07 | 2019-11-12 | 北京凌天世纪控股股份有限公司 | A kind of explosion machine intelligent control system |
-
2020
- 2020-09-04 CN CN202010924096.6A patent/CN112157662B/en active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2003311670A (en) * | 2002-04-17 | 2003-11-05 | Denso Wave Inc | Robot arm position control method and robot apparatus |
CN105415380A (en) * | 2015-12-11 | 2016-03-23 | 国网山东省电力公司电力科学研究院 | Transformer substation inspection robot system for detecting equipment in box and method thereof |
CN110147106A (en) * | 2019-05-29 | 2019-08-20 | 福建(泉州)哈工大工程技术研究院 | Intelligent mobile service robot with laser and visual fusion obstacle avoidance system |
Also Published As
Publication number | Publication date |
---|---|
CN112157662A (en) | 2021-01-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10626562B2 (en) | Concrete patching robot | |
CN107584501B (en) | Live cleaning robot for substation equipment and control method thereof | |
CN105298387A (en) | Drill jumbo | |
CN111236945B (en) | Deep sea mining vehicle with auxiliary movement device | |
CN108406726A (en) | A kind of wheel type movable machine explosive-removal robot | |
CN112068543A (en) | Precise positioning method of drilling and anchoring robot in coal mine based on vision calibration | |
CN113931649B (en) | Position and posture regulating and controlling method of tunnel boring machine | |
CN105239992A (en) | Drilling method | |
Garcia-Cerezo et al. | Development of ALACRANE: A mobile robotic assistance for exploration and rescue missions | |
CN112157662B (en) | Blasting robot | |
JP7328659B2 (en) | Shoring erection device and shoring erection method using the same | |
CN116558382A (en) | A Blasting Emulsion Explosive Filling Robot | |
JP3926138B2 (en) | Mine detection robot | |
CN108598990A (en) | A kind of hot line robot aerial earth wire replacement method for repairing and mending based on force feedback master & slave control technology | |
CN111576511A (en) | Control method for self-walking up-down transport vehicle of walking excavator | |
CN107843486A (en) | A kind of detection robot system based on benkelman beams deflectometer | |
CN113513021B (en) | Automatic positioning system and method for pile driver | |
CN114856660B (en) | A method for withdrawing anchor in a mine | |
CN219486175U (en) | A self-driving, precise positioning drilling robot | |
CN117301089A (en) | A multifunctional inspection robot device for mechanized excavation working face and its use method | |
CN112838516B (en) | Overhead conductor robot live working device and method | |
CN115562097A (en) | Intelligent control system of crawler-type hydraulic excavator upper and lower non-ladder plate vehicle | |
KR102042440B1 (en) | Robot for repairing drainpipe and Control method of the robot | |
CN119041928B (en) | Splitting tunneling equipment for tunnel construction and tunneling method thereof | |
CN207798539U (en) | A kind of detection robot system based on benkelman beams deflectometer |
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 |