CN106382869B - The control method of on-site mixed explosive Work robot - Google Patents

The control method of on-site mixed explosive Work robot Download PDF

Info

Publication number
CN106382869B
CN106382869B CN201610880654.7A CN201610880654A CN106382869B CN 106382869 B CN106382869 B CN 106382869B CN 201610880654 A CN201610880654 A CN 201610880654A CN 106382869 B CN106382869 B CN 106382869B
Authority
CN
China
Prior art keywords
blasthole
powder charge
robot
control method
site mixed
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
CN201610880654.7A
Other languages
Chinese (zh)
Other versions
CN106382869A (en
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.)
NORCIN TECH OF CHINA NORTH INDUSTRIES Group Corp.
Xian University of Science and Technology
Original Assignee
Xian University of Science and Technology
North Blasting Technology 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 Xian University of Science and Technology, North Blasting Technology Co Ltd filed Critical Xian University of Science and Technology
Priority to CN201610880654.7A priority Critical patent/CN106382869B/en
Publication of CN106382869A publication Critical patent/CN106382869A/en
Application granted granted Critical
Publication of CN106382869B publication Critical patent/CN106382869B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F42AMMUNITION; BLASTING
    • F42DBLASTING
    • F42D1/00Blasting methods or apparatus, e.g. loading or tamping
    • F42D1/08Tamping methods; Methods for loading boreholes with explosives; Apparatus therefor
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F42AMMUNITION; BLASTING
    • F42DBLASTING
    • F42D3/00Particular applications of blasting techniques

Landscapes

  • Engineering & Computer Science (AREA)
  • General Engineering & Computer Science (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • General Life Sciences & Earth Sciences (AREA)
  • Manipulator (AREA)

Abstract

The present invention relates to the control method of on-site mixed explosive Work robot, and it comprises the following steps:(1) powder charge instruction, is received;(2), autonomous navigation system planning travel route, after the completion of travel route planning, powder charge robot leaves for explosion place, after reaching explosion place, into step (3);(3), position;(4), measure;(5), powder charge;(6), judge whether to complete whole powder charges, if completing to enter step (7), otherwise enter step (3);(7), detergent line;(8), equipment playbacks;(9), powder charge is terminated after return to origin.The control method of on-site mixed explosive Work robot disclosed by the invention has the advantages that:Underground site mixed explosive filling is carried out using powder charge robot, powder charge scene can reduce the people of charging personnel 10~20, reduce production cost, improve the security of bursting work.

Description

The control method of on-site mixed explosive Work robot
Technical field
The invention belongs to mechanized equipment field, and in particular to the control method of on-site mixed explosive Work robot.
Background technology
At present, during domestic and international project explosion, mainly use and finished explosive products are manually packed into blasthole, or use powder charge Device, the in bulk or on-site mixed explosive of explosive loading truck filling load the mode that the explosive such as blasthole, detonator will be manually and are placed into big gun Hole, then blasthole is clogged through manual type, finally carry out blasting network connection by explosion personnel, check, then detonate, complete whole Bursting work.Using such operating type, during dynamite charge, explosive filling and filling is carried out, demolition site Not only personnel amount is numerous, and labor strength is big, and security is poor.Now, both at home and abroad also no method can realize it is fried The unmanned filling operation of medicine.
The content of the invention
Goal of the invention:In order to solve the above problems, the invention discloses the controlling party of on-site mixed explosive Work robot Method.This powder charge robot can be by the walking chassis with independent navigation, autokinetic movement to the powder charge place specified, by certainly It is dynamic to seek hole system and measuring system blasthole is positioned and measured, by charge system and send guard system that dynamite charge is entered into big gun Hole.The Unmanned operation of dynamite charge operation can be so realized, reduces demolition site operating personnel, improves explosion production safety Property.
Technical scheme:The control method of on-site mixed explosive Work robot, comprises the following steps:
(1) powder charge instruction, is received;
(2), autonomous navigation system planning travel route, after the completion of travel route planning, powder charge robot leaves for quick-fried Broken place, after reaching explosion place, into step (3);
(3), position;
(4), measure;
(41) setting blast hole parameter, is read in;
(42) blast hole depth, is measured;
(43), judge whether blast hole depth is consistent with design size, if inconsistent, upload metrical information, control centre Return to step (41) after amendment design information;Conversely, into step (44);
(44) blasthole form, is measured;
(45), judge whether blasthole form and design size are consistent, if inconsistent, upload metrical information, control centre Return to step (41) after amendment design information;Conversely, measurement terminates;
(5), powder charge;
(6), judge whether to complete whole powder charges, if completing to enter step (7), otherwise enter step (3);
(7), detergent line;
(8), equipment playbacks;
(9), powder charge is terminated after return to origin.
Further, autonomous navigation system is made up of location aware system and vehicle-mounted self-control system, controlled loading of explosive machine Device people independently arrives at according to the situation on periphery, wherein:
Location aware system includes ultrasonic sensor, laser sensor, radar sensor, video sensor, image and known Not Ka and data transmission radio station,
Ultrasonic sensor, laser sensor, radar sensor are connected by data wire with data transfer radio station, and video passes Sensor is connected by data wire with image recognition card, and image recognition card is connected by data wire with data transfer radio station;
Vehicle-mounted self-control system is automated driving system, the information passed back according to location aware system, adjusts robot It is constantly close to demolition site.
Further, step (3) comprises the following steps:
(31) powder charge robot coordinate position, is measured by line laser measuring instrument or GPS;
(32), the powder charge robot coordinate position of measurement and borehole coordinate position are converted, judge loading machinery arm Whether blasthole can be covered, if can not, step (31) close to blasthole and is entered according to coordinate information controlled loading of explosive robot;If Can, into step (33);
(33), when blasthole is appeared in shooting head region, led to close to blasthole according to drill hole information controlled loading of explosive mechanical arm Camera vision is crossed to be accurately positioned;
(34), carry out coordinate modification, correct borehole coordinate and robot coordinate, controlled loading of explosive mechanical arm by pipe-conveying device with Blasthole is coaxial, when pipe-conveying device and blasthole coaxially after enter step (35);
(35), by grug transportation tube close to blasthole;
(36), judge whether the distance between grug transportation tube and blasthole reach setting value, if being not reaching to, return to step (35), if reaching, positioning terminates.
Further, step (5) comprises the following steps:
(51), starting send guard system that grug transportation tube is sent into blasthole;
(52), after grug transportation tube reaches bottom hole, first time powder charge is judged whether, if so, then starting powder charge after start-up study System;Conversely, then start charge system at once;
(53) guard system, is sent to be exited from blasthole grug transportation tube according to powder charge speed, after exiting, powder charge terminates.
Further, charge system includes dynamical system, control system, pumping system, metering system, purging system and fried Medicine raw material storage bin.
Further, guard system is sent to be made up of mechanical arm and pipe conveyor, mechanical arm is arranged in walking chassis, pipe conveyor peace Mounted in the end of mechanical arm.
Beneficial effect:The control method of on-site mixed explosive Work robot disclosed by the invention has below beneficial to effect Fruit:
Underground site mixed explosive filling is carried out using powder charge robot, powder charge scene can reduce charging personnel 10 ~20 people, reduce production cost, improve the security of bursting work.
Brief description of the drawings
Fig. 1 is the flow chart of the control method of on-site mixed explosive Work robot disclosed by the invention;
Fig. 2 is positioning flow figure;
Fig. 3 is measurement procedure figure;
Fig. 4 is powder charge flow chart.
Embodiment:
The embodiment of the present invention is described in detail below.
As shown in figures 1-4, the control method of on-site mixed explosive Work robot, comprises the following steps:
(1) powder charge instruction, is received;
(2), autonomous navigation system planning travel route, after the completion of travel route planning, powder charge robot leaves for quick-fried Broken place, after reaching explosion place, into step (3);
(3), position;
(4), measure;
(41) setting blast hole parameter, is read in;
(42) blast hole depth, is measured;
(43), judge whether blast hole depth is consistent with design size, if inconsistent, upload metrical information, control centre Return to step (41) after amendment design information;Conversely, into step (44);
(44) blasthole form, is measured;
(45), judge whether blasthole form and design size are consistent, if inconsistent, upload metrical information, control centre Return to step (41) after amendment design information;Conversely, measurement terminates;
(5), powder charge;
(6), judge whether to complete whole powder charges, if completing to enter step (7), otherwise enter step (3);
(7), detergent line;
(8), equipment playbacks;
(9), powder charge is terminated after return to origin.
Further, autonomous navigation system is made up of location aware system and vehicle-mounted self-control system, controlled loading of explosive machine Device people independently arrives at according to the situation on periphery, wherein:
Location aware system includes ultrasonic sensor, laser sensor, radar sensor, video sensor, image and known Not Ka and data transmission radio station,
Ultrasonic sensor, laser sensor, radar sensor are connected by data wire with data transfer radio station, and video passes Sensor is connected by data wire with image recognition card, and image recognition card is connected by data wire with data transfer radio station;
Vehicle-mounted self-control system is automated driving system, the information passed back according to location aware system, adjusts robot It is constantly close to demolition site.
Further, step (3) comprises the following steps:
(31) powder charge robot coordinate position, is measured by line laser measuring instrument or GPS;
(32), the powder charge robot coordinate position of measurement and borehole coordinate position are converted, judge loading machinery arm Whether blasthole can be covered, if can not, step (31) close to blasthole and is entered according to coordinate information controlled loading of explosive robot;If Can, into step (33);
(33), when blasthole is appeared in shooting head region, led to close to blasthole according to drill hole information controlled loading of explosive mechanical arm Camera vision is crossed to be accurately positioned;
(34), carry out coordinate modification, correct borehole coordinate and robot coordinate, controlled loading of explosive mechanical arm by pipe-conveying device with Blasthole is coaxial, when pipe-conveying device and blasthole coaxially after enter step (35);
(35), by grug transportation tube close to blasthole;
(36), judge whether the distance between grug transportation tube and blasthole reach setting value, if being not reaching to, return to step (35), if reaching, positioning terminates.
Further, step (5) comprises the following steps:
(51), starting send guard system that grug transportation tube is sent into blasthole;
(52), after grug transportation tube reaches bottom hole, first time powder charge is judged whether, if so, then starting powder charge after start-up study System;Conversely, then start charge system at once;
(53) guard system, is sent to be exited from blasthole grug transportation tube according to powder charge speed, after exiting, powder charge terminates.
Further, charge system includes dynamical system, control system, pumping system, metering system, purging system and fried Medicine raw material storage bin.
Further, guard system is sent to be made up of mechanical arm and pipe conveyor, mechanical arm is arranged in walking chassis, pipe conveyor peace Mounted in the end of mechanical arm.
In addition, for ease of understanding, powder charge robot is briefly described, it is specific as follows:
Powder charge robot, including walking chassis, autonomous navigation system, charge system, send guard system, automatic seeking hole system and Measuring system,
The effect that walking chassis is adopted is carrying and moves powder charge robot;
Autonomous navigation system is made up of location aware system and vehicle-mounted self-control system, and controlled loading of explosive robot is according to week The situation on side independently arrives at, and wherein location aware system is by ultrasound, laser radar, visual pattern identification, data transfer Radio station composition;
Charge system is stored by dynamical system, control system, pumping system, metering system, purging system and explosive raw material Case forms, and after powder charge robot reaches powder charge place, charge system starts, and mixed explosive is prepared in situ, the explosive prepared Blasthole is transported to by grug transportation tube;
Guard system is sent to be made up of mechanical arm and pipe conveyor, mechanical arm is arranged in walking chassis, and pipe conveyor is arranged on machinery The end of arm, grug transportation tube are connected to pipe conveyor by charge system by mechanical arm, realize that grug transportation tube is sent into and moved back by pipe conveyor Go out blasthole;
Automatic seeking hole system is made up of vision positioning sensory perceptual system and analysis and Control system, and vision positioning sensory perceptual system is by height Clear camera, visual information feedback control system composition, vision positioning sensory perceptual system catch environmental information by high-definition camera, By visual information feedback control system automatic searching to the position to be loaded blasthole, and send coordinate to analysis and Control system System, analysis and Control system send coordinates of targets to pipe-conveying device by computing, and pipe-conveying device is according to coordinate information control machinery Arm makes grug transportation tube coaxial with blasthole;
Measuring system measures the depth and blasthole deformation of blasthole by laser measuring apparatus, when pipe-conveying device is by grug transportation tube After being directed at blasthole, the laser measuring apparatus on pipe-conveying device, which is moved in front of grug transportation tube, carries out blast hole depth and deformation Measurement, and send metrical information to charge system.
Embodiments of the present invention are elaborated above.But the present invention is not limited to above-mentioned embodiment, In art those of ordinary skill's possessed knowledge, it can also be done on the premise of present inventive concept is not departed from Go out various change.

Claims (4)

1. the control method of on-site mixed explosive Work robot, it is characterised in that comprise the following steps:
(1) powder charge instruction, is received;
(2), autonomous navigation system planning travel route, after the completion of travel route planning, powder charge robot is with leaving for explosion Point, after reaching explosion place, into step (3);
(3), position;
(4), measure;
(41) setting blast hole parameter, is read in;
(42) blast hole depth, is measured;
(43), judge whether blast hole depth is consistent with design size, if inconsistent, upload metrical information, control centre's amendment Return to step (41) after design information;Conversely, into step (44);
(44) blasthole form, is measured;
(45), judge whether blasthole form and design size are consistent, if inconsistent, upload metrical information, control centre's amendment Return to step (41) after design information;Conversely, measurement terminates;
(5), powder charge;
(6), judge whether to complete whole powder charges, if completing to enter step (7), otherwise enter step (3);
(7), detergent line;
(8), equipment playbacks;
(9), powder charge is terminated after return to origin.
2. the control method of on-site mixed explosive Work robot according to claim 1, it is characterised in that step (3) Comprise the following steps:
(31) powder charge robot coordinate position, is measured by line laser measuring instrument or GPS;
(32), the powder charge robot coordinate position of measurement and borehole coordinate position are converted, whether judge loading machinery arm Blasthole can be covered, if can not, step (31) close to blasthole and is entered according to coordinate information controlled loading of explosive robot;If can, enter Enter step (33);
(33), according to drill hole information controlled loading of explosive mechanical arm close to blasthole, when blasthole is appeared in shooting head region, by taking the photograph As head vision is accurately positioned;
(34) coordinate modification, is carried out, corrects borehole coordinate and robot coordinate, controlled loading of explosive mechanical arm is by pipe-conveying device and blasthole Coaxially, when pipe-conveying device and blasthole coaxially after enter step (35);
(35), by grug transportation tube close to blasthole;
(36), judge whether the distance between grug transportation tube and blasthole reach setting value, if being not reaching to, return to step (35), if Reach, positioning terminates.
3. the control method of on-site mixed explosive Work robot according to claim 1, it is characterised in that step (5) Comprise the following steps:
(51), starting send guard system that grug transportation tube is sent into blasthole;
(52), after grug transportation tube reaches bottom hole, first time powder charge is judged whether, if so, then starting charge system after start-up study; Conversely, then start charge system at once;
(53) guard system, is sent to be exited from blasthole grug transportation tube according to powder charge speed, after exiting, powder charge terminates.
4. the control method of on-site mixed explosive Work robot according to claim 3, it is characterised in that send guard system It is made up of mechanical arm and pipe conveyor, mechanical arm is arranged in walking chassis, and pipe conveyor is arranged on the end of mechanical arm.
CN201610880654.7A 2015-10-26 2015-10-26 The control method of on-site mixed explosive Work robot Active CN106382869B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610880654.7A CN106382869B (en) 2015-10-26 2015-10-26 The control method of on-site mixed explosive Work robot

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN201510702768.8A CN105300206B (en) 2015-10-26 2015-10-26 A kind of control method of on-site mixed explosive Work robot
CN201610880654.7A CN106382869B (en) 2015-10-26 2015-10-26 The control method of on-site mixed explosive Work robot

Related Parent Applications (1)

Application Number Title Priority Date Filing Date
CN201510702768.8A Division CN105300206B (en) 2015-10-26 2015-10-26 A kind of control method of on-site mixed explosive Work robot

Publications (2)

Publication Number Publication Date
CN106382869A CN106382869A (en) 2017-02-08
CN106382869B true CN106382869B (en) 2018-01-23

Family

ID=55197752

Family Applications (2)

Application Number Title Priority Date Filing Date
CN201610880654.7A Active CN106382869B (en) 2015-10-26 2015-10-26 The control method of on-site mixed explosive Work robot
CN201510702768.8A Active CN105300206B (en) 2015-10-26 2015-10-26 A kind of control method of on-site mixed explosive Work robot

Family Applications After (1)

Application Number Title Priority Date Filing Date
CN201510702768.8A Active CN105300206B (en) 2015-10-26 2015-10-26 A kind of control method of on-site mixed explosive Work robot

Country Status (1)

Country Link
CN (2) CN106382869B (en)

Families Citing this family (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
BR102016024215B1 (en) * 2016-10-17 2019-10-08 Vale S.A. VEHICLE FOR DEPOSITING EXPLOSIVES IN DISASSEMBLING HOLES AND METHOD OF USE
CN110057259B (en) * 2019-05-15 2022-02-11 福建省新华都工程有限责任公司 Intelligent working system of medicine loading vehicle
CN110849225A (en) * 2019-11-27 2020-02-28 神华准格尔能源有限责任公司 Intelligent explosive filling method, device, storage medium and system
EP3885694B1 (en) * 2020-03-24 2022-11-09 Indurad GmbH Method and device for controlled filling and inspection of blast holes
CN112157662B (en) * 2020-09-04 2023-07-07 江汉大学 Blasting robot
AU2021377194A1 (en) 2020-11-10 2023-07-06 Dyno Nobel Asia Pacific Pty Limited Systems and methods for determining water depth and explosive depth in blastholes
CN113674208B (en) * 2021-07-22 2024-02-09 中南大学 Automatic hole searching method, device and medium for underground blasting holes

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102180752A (en) * 2011-03-29 2011-09-14 大连海事大学 Control system of field explosive mixed loading truck
CN103606171A (en) * 2013-12-05 2014-02-26 西安科技大学 Method for carrying out automatic powder charging by rapidly positioning blast hole under shaft
CN103983149A (en) * 2014-05-16 2014-08-13 中国能源建设集团有限公司工程研究院 Method, device and system for automatically finding blasthole during charging of blasthole
CN204630495U (en) * 2015-03-30 2015-09-09 深圳市金奥博科技有限公司 Underground on-site mixed explosives truck

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH01121700A (en) * 1987-11-06 1989-05-15 Mitsui Constr Co Ltd Automatic loader for molded explosives cylinder
FI113803B (en) * 2001-11-12 2004-06-15 Sandvik Tamrock Oy Arrangement for inserting charges into the drill hole
CN204555854U (en) * 2015-03-30 2015-08-12 深圳市金奥博科技有限公司 Underground charging vehicle looks for holes mechanism automatically

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102180752A (en) * 2011-03-29 2011-09-14 大连海事大学 Control system of field explosive mixed loading truck
CN103606171A (en) * 2013-12-05 2014-02-26 西安科技大学 Method for carrying out automatic powder charging by rapidly positioning blast hole under shaft
CN103983149A (en) * 2014-05-16 2014-08-13 中国能源建设集团有限公司工程研究院 Method, device and system for automatically finding blasthole during charging of blasthole
CN204630495U (en) * 2015-03-30 2015-09-09 深圳市金奥博科技有限公司 Underground on-site mixed explosives truck

Also Published As

Publication number Publication date
CN106382869A (en) 2017-02-08
CN105300206A (en) 2016-02-03
CN105300206B (en) 2017-03-29

Similar Documents

Publication Publication Date Title
CN106382869B (en) The control method of on-site mixed explosive Work robot
AU2017228716B2 (en) Vehicle for deposition of explosives in blast holes and method of use
CN108104834B (en) Shield duct piece automatic assembling method and system
CN105178967B (en) Development machine autonomous positioning orientation system and method
CN108983807A (en) A kind of unmanned plane pinpoint landing method and system
CN104267043B (en) A kind of motion detection device of concrete-bridge crackle
CN107992098B (en) Method and device for controlling tail end powder conveying pipe of working arm to align blast hole
CN103606171B (en) The method of automatic powder charge is carried out in quick position big gun hole, a kind of down-hole
CN104710253A (en) Automatic detonator assembly process and special related apparatus
CN205262311U (en) Intelligent explosive mixed loading vehicle in pit
CN111664762B (en) Automatic explosive charging control system and method for mixed explosive charging vehicle based on drilling positioning parameters
CN107357306A (en) A kind of bootstrap technique, equipment, computer equipment and readable storage medium storing program for executing
WO2014063188A1 (en) A system for, and a method of, controlling charging of a blast hole with explosives
CN106091850B (en) Control method and control system for underground mine field mixed explosive loading vehicle
CN107160162A (en) A kind of sensor chip assembles equipment
CN105676847A (en) Electric energy meter automatic boxing system
CN107892236B (en) Container loading and unloading operation auxiliary equipment
CN102173965A (en) Mechanical explosive loading truck of finished explosive products
WO2010144952A1 (en) Method and apparatus for charging explosives
EP3844453B1 (en) Method of and apparatus for establishing a blasting system
CN103983149B (en) Method, device and system for automatically finding blasthole during charging of blasthole
US20180120073A1 (en) Detonator control system
CN204707141U (en) Production information monitoring system of underground mine on-site mixed explosive loading truck based on wireless technology
Chi et al. Development and application of underground intelligent explosive vehicles
CN113741501A (en) Concrete auxiliary detection system based on unmanned aerial vehicle

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20210125

Address after: 100089 3rd floor, building 67, West courtyard, No.10 Landao Gou, Haidian District, Beijing

Patentee after: NORCIN TECH OF CHINA NORTH INDUSTRIES Group Corp.

Patentee after: XI'AN University OF SCIENCE AND TECHNOLOGY

Address before: 100048 20th floor, China Weapons building, 69 Zizhuyuan Road, Haidian District, Beijing

Patentee before: NORTH BLASTING TECHNOLOGY Co.,Ltd.

Patentee before: XI'AN University OF SCIENCE AND TECHNOLOGY