CN106799737A - A kind of method that dangerization liquid safe storage based on mobile robot, transport and fixed point are placed - Google Patents
A kind of method that dangerization liquid safe storage based on mobile robot, transport and fixed point are placed Download PDFInfo
- Publication number
- CN106799737A CN106799737A CN201710073654.0A CN201710073654A CN106799737A CN 106799737 A CN106799737 A CN 106799737A CN 201710073654 A CN201710073654 A CN 201710073654A CN 106799737 A CN106799737 A CN 106799737A
- Authority
- CN
- China
- Prior art keywords
- mechanical arm
- dangerization solution
- solution
- dangerization
- moving cart
- 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
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
- B25J11/002—Manipulators for defensive or military tasks
- B25J11/0025—Manipulators for defensive or military tasks handling explosives, bombs or hazardous objects
-
- 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
Abstract
The present invention relates to a kind of dangerization solution based on mobile robot method that storage, transport and fixed point are placed safely, methods described is moved to specified test point by path planning including moving cart system from specified dangerization solution point;Open dangerization solution storage system;Multi-joint mechanical arm system receives tapping instruction, and is moved to dangerization solution storage system top;Multi-joint mechanical arm system controls chucking appliance system, and dangerization solution is put to specified test point.The method is applied to high-risk dangerization solution sampling detection-phase; by introducing a kind of danger solution extraction system based on mobile robot; the fixed danger solution extraction device that will be used in high-risk environment is substituted for the corrosion resistant mobile robot dangerization solution extraction device of radiation proof, so as to realize that dangerization solution is efficient, quantify, Visual Inference is operated.
Description
Technical field
The present invention relates to dangerization solution and extracts and detection field, specifically a kind of danger solution peace based on mobile robot
The method that full storage, transport and fixed point are placed.
Background technology
The manufacturing, health care, nuclear test and many places of industry such as nuclear power, chemical metallurgy can produce a large amount of components to answer
The danger solution that miscellaneous, density unevenness, corrosivity are big, radioactivity is high, easily causes serious injury to people, animal and environment.This
Class dangerization solution typically using isolation method storage within the enclosed space, through collection storage, sampling detection, purified treatment with
And discharge etc. step, with dilution or solidification etc. method process after, be converted into the concentrate of small size and preserved, treat corrosivity
With radioactivity less than after maximum allowable discharge index, arranged and buried in environment or spread.The sampling inspection of dangerization solution
Survey is very important link in processing procedure, and this stage will be detected to the composition and content of dangerization solution, only fully
Effective dangerization solution processing methods can be just found after detection, could only be endangered after strictly processing and be reduced to most
It is low.
Dangerization solution sampling need on a small quantity extract solution when detecting using advanced ways and means, carry out composition and content point
Analysis.From the point of view of published record and data, most of dangerization solution extraction uses the mode based on vacsorb and builds
Fixed dangerization solution extraction device, the device mainly by vavuum pump, suction pipe, controlling switch and shooting is first-class constitutes, with
Dangerization solution processing equipment is fixed on somewhere together, and the extraction of dangerization solution, such device are completed in artificial presence
Consider almost not extract the measure of control using accurate for stability, so being difficult to the quantitative and random of dangerization solution
Sampling observation.Lack flexible extraction means and cannot accurate quantification lifted as restriction dangerization solution treatment effeciency the problems such as extract
Bottleneck, due to using fixed solution extraction device, it is impossible to move freely operation, when device breaks down or dangerization solution
In the case of change of component, fixed solution extraction device cannot be competent at sampling observation work, cause dangerization solution to process when serious temporary
Stop, production line stop, bring huge economic loss.
In addition, many occasions do not have fixed dangerization solution extraction equipment, when the danger solution type for extracting is relatively more, away from
From distant, working environment it is more severe when, it is necessary to people enter different environment even high-risk environment in manual operations, occur
(1)People is in operation in adverse circumstances the long period, is vulnerable to injury;(2)Dangerization solution taken amount is forbidden, and operating efficiency is relatively low;
(3)The problems such as unnecessary dangerization solution is not disposable.These problems had a strong impact on dangerization solution detection treatment effeciency and
The security of people.
The content of the invention
It is the problem above for overcoming prior art to exist, the invention provides a kind of danger solution based on mobile robot
The method that safety storage, transport and fixed point are placed, realizes repeating quantitative danger under different high-risk environments using mobile robot
Change automation, quantification and normalizing operation that solution is extracted, so that contact of the completely isolated people with high-risk environment, reaches dangerization
The requirement that solution is fully detected.
The present invention is realized by following technical scheme:
A kind of dangerization solution based on mobile robot method that storage, transport and fixed point are placed safely, it is characterised in that described
Mobile robot includes moving cart system, multi-joint mechanical arm system, chucking appliance system, vision ultrasonic wave detecting system and dangerization
Solution storage system;The mobile robot is connected with supervisory control desk system communication;Including:
a)Moving cart system is moved to specified test point by path planning from specified dangerization solution point;
b)Open dangerization solution storage system;
c)Moving cart system sends instructions to articulated mechanical arm system, and multi-joint mechanical arm system drives chucking appliance system to be moved to
Dangerization solution storage system top;
d)Multi-joint mechanical arm system operates chucking appliance system under the guiding of vision ultrasonic wave detecting system, by dangerization solution from danger
Change taking-up in solution storage system, put to specified test point.
e)Check in dangerization solution storage system whether also have storage dangerization solution, repeat step c)、d).
Further, moving cart system and multi-joint mechanical arm system are built-in with PLC;Moving cart system
PLC is master-slave control mode with multi-joint mechanical arm system PLC.
Further, the mobile path planning is stored in moving cart system PLC.
Further, the dangerization solution storage system includes storage body, takes liquid measure cup, weight sensor and pneumatic
Device;The liquid measure cup that takes is placed in storage body;The weight sensor is placed in and takes liquid measure cup bottom;The pneumatic means one
End is connected with moving cart system PLC, and the other end is connected with storage body;The weight sensor and moving cart system
System PLC is connected;Moving cart system PLC opens the pneumatic top cover of sealing of storage body by pneumatic means.
Further, moving cart system PLC sends instructions to multi-joint mechanical arm system PLC, and
Multi-joint mechanical arm system is set to drive grip device to be moved to dangerization solution storage system top.
Further, the chucking appliance system includes chuck body, tumbler, quantitative liquid taking device and pneumatic three-jaw card
Disk device;The chuck body of multi-joint mechanical arm system PLC control chucking appliance system is rotated, pneumatic scroll chuck device
Turn to working position;Multi-joint mechanical arm PLC controls pneumatic scroll chuck device that storage dangerization solution is taken into liquid measure
Cup folder from dangerization solution storage system is taken out to certain altitude, finds to specify under the guiding of vision ultrasonic wave detecting system and puts
Liquid point and tapping highly, are finally called the monitor station in multi-joint mechanical arm system PLC to pinpoint tapping program block and will be taken
Liquid measure cup is placed on specified test point.
Compared with prior art, beneficial effects of the present invention are as follows:
Moving cart system PLC in the present invention uses master & slave control mould with multi-joint mechanical arm system PLC
Formula so that control logic is rigorous, data transfer is smooth each other, action cooperates coordinates, it is easy to ensure mobile system stabilization
Reliably work;
Interim storage and safety after dangerization solution is extracted are solved using the dangerization solution storage system of designed, designed in the present invention
The problem of test point is transported, and cooperation is operated with multi-joint mechanical arm under the control of moving cart PLC, efficiently completed
Dangerization solution pinpoints placement task;
The multi-functional clamp system of integrated object crawl function and the quantitative abstraction function of dangerization solution carries out unnecessary danger in the present invention
Change solution treatment, the system provides power using pneumatic means, using pressure sensor and liquid surface position sensor, real-time detection
Clamp working-station, whole chucking appliance system is simple easy, with low cost, and specific steps are placed with reference to dangerization solution fixed point, can
Realize that dangerization solution is quickly placed on monitor station;
The present invention carries out dangerization solution set-point and determines using the vision ultrasonic wave detecting system of machine vision and ultrasonic wave component,
I.e. visual pattern determines the coordinate value of plane X and Y, and ultrasonic wave determines the value of short transverse Z-direction, and both are vector superposed together
Can be placed for the fixed point dangerization solution of mobile robot and position data support is provided.
Brief description of the drawings
Fig. 1 is System Working Principle figure of the invention.
Fig. 2 is the block diagram of system of the invention.
Fig. 3 is mobile robot structure chart of the invention.
Fig. 4 is mobile-robot system control structure figure of the invention.
Fig. 5 is control instruction of the invention and transmittance process network diagramming.
Fig. 6 is wireless telecommunication system network topological diagram of the invention.
Fig. 7 is supervisory control desk system hardware and software frame diagram of the invention.
Fig. 8 is the supervisory control desk software and hardware network architecture of the invention.
Fig. 9 is supervisory control desk shape assumption diagram of the invention.
Figure 10 is moving cart system module block diagram of the invention.
Figure 11 is moving cart body interior structure chart of the invention.
Figure 12 is multi-joint mechanical arm system module block diagram of the invention.
Figure 13 is grip device system construction drawing of the invention.
Figure 14 is vision ultrasound examination composition of the invention and schematic diagram.
Figure 15 is dangerization solution memory system architecture figure of the invention.
Figure 16 is power system modules pie graph of the invention.
Figure 17 is that mobile robot dangerization solution of the invention extracts overall flow figure.
Figure 18 is mobile-robot system state-detection of the invention and initialization flow.
Figure 19 is instruction issuing of the invention and process of data communication figure.
Figure 20 is mobile route process planning figure of the invention.
Figure 21 is automatically positioned and quantifies extraction process for dangerization solution of the invention.
Figure 22 is that dangerization solution of the invention is transported and fixed point tapping flow.
Figure 23 is unnecessary dangerization solution Auto Processing of the invention.
Specific embodiment
The present invention is further illustrated below in conjunction with the drawings and specific embodiments.
According to the characteristics of dangerization solution and the flow extracted of automatic ration, it is considered to processing safety and function it is reliable real
It is existing, design dangerization solution automatic ration extraction system, operation principle such as Fig. 1 institutes under a kind of high-risk environment based on mobile robot
Show.The overall thought for using controlling organization and executing agency separate, mobile-robot system is placed on high-risk as executing agency
Environmental interior, supervisory control desk is placed on outside high-risk environment as controlling organization, and quantitatively extraction will at random to be not only adapted to general solution
Ask, be further adapted for that radioactivity is high, chemical composition uncertain, the danger solution that variety type is more, safety requirements is high is quantitatively extracted at random
It is required that scene, with good flexibility.
As shown in Figure 2:The system includes supervisory control desk system, wireless communication data Transmission system, moving cart system, many
Articulated mechanical arm system, multi-functional clamp system, vision ultrasonic wave detecting system, dangerization solution storage system and power-supply system
Deng.Wherein, moving cart system, multi-joint mechanical arm system, multi-functional clamp system, dangerization solution storage system and vision
Ultrasonic wave detecting system constitutes mobile-robot system.
As shown in Figure 3:The mobile robot includes moving cart system, multi-joint mechanical arm system, chucking appliance system, regards
Feel ultrasonic wave detecting system and dangerization solution storage system, and multi-joint mechanical arm system, chucking appliance system, vision ultrasound examination
System, dangerization solution storage system are arranged in moving cart system;The supervisory control desk system is based on communication network and moves
Dynamic cart system communication connection, and each system status parameters in mobile robot are obtained by moving cart system, while sending
Take liquid information and movement instruction and give moving cart system;The moving cart system is received and forwards what supervisory control desk system sent
Liquid information and movement instruction are taken, realizes that mobile robot gathers and place the movement on circuit in dangerization solution;The movement is small
Car system is connected with multi-joint mechanical arm system and dangerization solution storage system respectively, the multi-joint mechanical arm system and fixture
System is connected, and the video ultrasound ripple detecting system is realized being communicated to connect with supervisory control desk system by communication network.
Fig. 4 for mobile robot system architecture control figure, supervisory control desk system as instruction send and real time data at
Reason center, by communication module in real time with the main system, vision ultrasound examination such as moving cart system, multi-joint mechanical arm system
The accessory systems such as system, multi-functional clamp system and dangerization solution storage system are connected, and are moved under composition high-risk environment
Robot control system.
Specifically, supervisory control desk system is connected with wireless mixing LAN by wired with wireless communication module, wirelessly
Communication module is connected by Ethernet interface with the PLC of moving cart system.Moving cart system and multi-joint machinery
Arm system uses master-slave control mode, the i.e. PLC of moving cart system as main website, multi-joint mechanical arm system
Used as slave station, both are connected PLC by Prifibus DP module interfaces, for performing mobile and operation behavior and many
Articulated mechanical arm pedestal is arranged on moving cart top nose.Dangerization solution storage system is arranged on moving cart top rear,
Its measuring cup weight sensor and pneumostop lid magnetic valve are integrated by O/I modules with moving cart PLC, are used
In storage and the carrying safely of dangerization solution.Multi-functional clamp system is arranged on mechanical arm tail end, its detection sensor, pneumatic system
Magnetic valve etc. is integrated by O/I modules with mechanical arm controller, is quantitatively extracted and is gripped for dangerization solution.It is arranged on
The energy of power-supply system inside moving cart for needed for main system and accessory system provide mobile, operation, detection, by wireless charging
The part of electric installation, Li-ion batteries piles and power management module etc. three constitutes, and wherein power management module is by MCU micro-control lists
Unit, PMIC power management integrated circuits and various sensor groups into power control.
Fig. 5 is control instruction of the invention and transmittance process network diagramming, and system control instruction and transmittance process are described as, work
Supervisory control desk sends dangerization solution extracting parameter signal, action with sending module by instruction input through radio transmitting device when making
, to moving cart system, vision ultrasonic wave detecting system and power-supply system, three digest journals and its accessory system are certainly for command signal
Started working after inspection is errorless.Moving cart is moved according to instruction, and sending action is instructed and gives multi-joint machinery after completion assignment of mission
Arm, makes mechanical arm carry out corresponding dangerization solution and extracts and grasping manipulation, dangerization solution storage system while mechanical arm is acted
Control instruction cooperative mechanical arm according to moving cart works.In addition, vision ultrasonic wave detecting system by collection in worksite to regard
Frequency information and ultrasonic data acquisition information return to master station.Power-supply system is powered to subsystems, and battery status
Feed back to master control platform.
Fig. 6 is wireless telecommunication system network topological diagram, inside and outside high-risk environment, builds and is based on IEEE 802.11b/g/a/h
The WIFI wireless networks of communications protocol, by WIFI wireless networks be data medium, connection supervisory control desk, moving cart system,
Multi-joint mechanical arm system, vision ultrasonic wave detecting system etc., constitute control data, video data, the state under high-risk environment
Effective passage of the transmission such as data.
Communication system is mainly made up of wireless aps, wireless data transceiving device, LAN etc., and wherein LAN is to be based on
The Ethernet that IEEE802.3 communications protocol builds, supervisory control desk is directly connected to LAN by wired mode;Wireless aps and nothing
Line data source and sink is addressable device, and wireless aps are directly connected to LAN, wireless communication apparatus one by wired mode
End is connected with moving cart system, vision ultrasonic wave detecting system, power-supply system etc. by Ethernet interface, and the other end passes through
WIFI network and AP wireless connections, so as to realize the high-speed transfer of control data, video data, status data.
Fig. 7 is supervisory control desk system hardware and software frame diagram of the invention, and supervisory control desk is by display, main control computer, reality
When the hardware such as communication server, data server, video server, network communication module and monitoring application system, back-end data
The software sharings such as storehouse, service software.It is wired with it is wireless mix LAN by way of with moving cart system, multi-joint machinery
The real-time communications such as arm system, dangerization solution storage system, vision ultrasonic wave detecting system, obtain its state parameter, while sending
Liquid information and movement instruction are taken to modules, the Remote of mobile robot is realized.
Monitoring application system is developed based on windows platform, on main control computer, with basic data maintenance mould
Block, take liquid information input and instruction sending module, mobile work robot monitoring module, vision ultrasonic wave monitoring module,
The big module of security protection alarm module and real-time data communication module etc. six.
Fig. 8 is the software and hardware network architecture of supervisory control desk system, main control computer, data server, video server etc.
In the form of bus connection over ethernet, by network communication module, main control computer and each server real-time communication, just
Data query and treatment are carried out in monitoring software.Real-time communication server is installed above Communications service software, in time crawl master
The instruction that control computer is assigned is to subsystems, while the status data and sensing data of subsystems feedback are captured, and
Storage is on data server and video server.Installation relation type database on data server, for monitoring software provides number
Supported according to storage, real-time storage operations data, feedback data, basis safeguard that data, safe operation status data, transmission refer to
Make historical data etc..Video information and ultrasonic height detection that video server real-time storage vision ultrasonic system is collected
Information.
Fig. 9 is a kind of shape assumption diagram of supervisory control desk of the invention, outward appearance is designed using ergonomics thought, by two
Individual display, an operating desk and master control platform housing composition, two of which display one are used for visual control, a use
Sent and received in control instruction;Master control platform housing is made up of stainless steel material, and 1 millimeters thick sheet lead is laid on surface, a radiation proof,
Corrosion-resistant effect.
Figure 10 be moving cart system module block diagram of the invention, moving cart system as whole system mobile dress
Put, five major parts such as including basic machine, control module, drive module, navigation module, communication module.The movement is small
Car system includes basic machine, control module, drive module, navigation module and communication module;The basic machine is used to provide
The physical arrangement of moveable robot movement;The control module is connected by communication module with supervisory control desk system, the control
Module is connected by drive module with basic machine;The navigation module is connected with control module.
Figure 11 be moving cart system ontology cut-away view of the invention, moving cart basic machine, by trolley body,
Steering mechanism and sensing element are constituted, and wherein trolley body is in rectangular shape, and vehicle body frame uses aluminium alloy extrusions, carries out
Totally-enclosed radiation protection treatment, lays the thick sheet leads of 1 ~ 2mm as shielding material outside car body;Car top is main supporting part
Point, there is the multi-joint mechanical arm mounting hole of four screwed holes that are uniformly distributed along the circumference forward position, and being bolted makes moving cart
Base fixing plate with multi-joint mechanical arm connects together;There is dangerization solution storage device mounting seat position to car body top rearward,
It is rigidly connected with the mounting seat in dangerization solution storage device by bolt;Car body the right and left bottom be distributed with two pairs it is symmetrical
Four McCrum wheels, constitute the movable part of dolly;Car body directly to the right is disposed with signal transmitting and receiving antenna, signal transmitting and receiving antenna with
The wireless communication apparatus connection of car interior, constitutes the wireless communication module of dolly.
Car interior, according to the principle of reasonable utilization space, is three layers of mounting structure, and logic connecting relation is referring to " moving machine
Device people's System control structures figure ", ground floor is upper strata, predominantly the control unit of multi-joint mechanical arm, wireless communication apparatus and
Vision ultrasonic treatment unit, the control unit of specific multi-joint mechanical arm includes 1 multi-joint mechanical arm controller, 1 fortune
The servo-driver of dynamic control module, 4 joint of mechanical arm, wireless communication apparatus are 1 set of wireless telecommunications based on wireless WIFI
Device, vision ultrasonic treatment unit is 1 set of position detecting device based on CCD camera and ultrasonic wave;The second layer is intermediate layer,
The predominantly control unit of moving cart, pneumatic system, the control unit of specific moving cart include 1 moving cart control
Device, 1 motion-control module, the servo-driver of 4 moving cart wheels, pneumatic system include that 1 set dangerization solution is stored and fill
Put pneumatic means, 1 set of multi-functional clamp device Tridactyle pneumatic fixture pneumatic means, 1 set of multi-functional clamp device quantitative liquid getting dress
The pneumatic means put;Third layer is bottom, and the supply unit of power is provided for each device, specifically have one group of lithium battery string and
1 electric power controller.The angular direction of dolly bottom four is disposed with 4 McCrum wheel servomotors and motor reducer, centre
Location arrangements have the navigation sensor and landmark sensor of a set of magnetic induction navigation, a wireless charging receiver.
Moving cart steering mechanism carries out moving of car control by the way of the four motorized wheels based on McCrum wheel
System.McCrum wheel is made up of two wheel hubs and a number of pony roll, using two ends supporting construction, small roller axis and wheel
Hub axis angle is ± 45 °, and both materials use corrosion-resistant radiation proof material.Two left-handed spiral configurations in four McCrum wheels
With two right-handed spiral configurations, moving cart car body the right and left is arranged in the way of two left two right four-wheels are arranged symmetrically;Each wheat
Carat nurse wheel is direct-connected with a DC servo motor and motor reducer, by the speed control different to four wheels, realizes
The motion of dolly different directions.
Control module:Including PLC and motion-control module, moving cart adds motion control using PLC
The modes such as module carry out motion control, and wherein PLC is mainly responsible for being communicated with supervisory control desk, is received in time by WIFI communication mode
Control instruction and feedback trolley travelling status data that supervisory control desk sends;Motion-control module is responsible for performing the letter that PLC is received
Number instruction, to moving cart feedback navigation signal, position signalling carry out real-time processing and calculating, output control signal is to direct current
Servo-driver.In addition, the Open Control pattern that moving cart is integrally combined using host computer with slave computer, wherein host computer
It is supervisory control desk system, slave computer is the PLC of moving cart system.
Drive module:Moving cart drives and uses DC servo motor driver and DC servo motor, DC servo electricity
Machine driver one end is connected with the motion-control module in moving cart PLC, and one end is connected with DC servo motor.
The motion-control module of PLC sends digital quantity high-speed pulse signal to servo-driver, and servo-driver uses position
Control model produces the pwm signal of impulse form according to the signal that control signal and servomotor feed back, through power amplification rear-guard
Dynamic servomotor, the pulse and direction signal that servomotor sends according to servo-driver is started, stopped, being inverted and is become
Speed etc. is acted.
Navigation module:The module is made up of Magnetic Sensor with the magnetic stripe for being laid on ground, and wherein Magnetic Sensor is divided into magnetic conductance
Sensor and magnetic landmark sensor, magnetic stripe are divided into guiding magnetic stripe and terrestrial reference magnetic stripe.Magnetic induction is not high to the susceptibility of high-risk environment,
Therefore the navigation module of moving cart is designed by the way of magnetic stripe navigation, the forward position in dolly bottom is provided with magnetic navigation sensor
And landmark sensor, make a reservation for the guiding magnetic stripe and terrestrial reference magnetic stripe of laying on ground for detecting.When moving cart is run, magnetic navigation
Sensor vertical gathers the magnetic field intensity of magnetic stripe in magnetic stripe top certain distance, judges that magnetic stripe is inclined relative to magnetic navigation sensor
Off normal and put, accordingly moving cart adjust automatically, it is ensured that moved ahead along magnetic stripe.Landmark sensor constantly reads terrestrial reference magnetic stripe, and accordingly
Judge run location and change running status.Terrestrial reference magnetic stripe is attached to the ground beside navigation magnetic stripe perpendicular to navigation magnetic stripe direction
On.
Communication module:It is made up of wireless communication apparatus and signal transmitting and receiving antenna, wherein wireless communication apparatus are wireless data
R-T unit, installed in moving cart inside ground floor, signal transmitting and receiving antenna is arranged on moving cart outside right side.Wireless telecommunications
Module one end uses WLAN standard agreement IEEE 802.11b/g/a/h, is connected with supervisory control desk real-time radio, in time
Obtain master control platform send take liquid instruction and movement instruction, while by the state of moving cart and interconnected system notify at once to
Master control platform.The wireless communication module other end is connected with moving cart PLC by Ethernet interface, in time sends master control platform
Take liquid instruction and movement instruction pass to moving cart PLC, while the feedback signal that moving cart PLC is received is passed to always
Console.
Figure 12 is multi-joint mechanical arm system module block diagram of the invention, and the multi-joint mechanical arm system is according to high-risk
Environment dangerization solution quantitatively extracts one of feature design and integrates machinery, control, electric open chain link-type and right angle to be sat
Mark formula mixed type articulated robot, working range farthest reaches 2 meters, and moving cart top is arranged on by bolt, small with movement
Car cooperation completes the work such as dangerization solution lifts, dangerization solution is transported, dangerization solution is placed.Mainly include basic machine, servo
Drive and motion control portion.
Basic machine is made up of execution unit, mechanical arm body, sensing element.Execution unit by servomotor, decelerator,
The part such as bearing and bearing block is constituted.Sensing element is the ginseng such as angle, rotating speed, electric current, voltage for detecting each axle servomotor
Several sensors.Mechanical arm body is made up of pedestal, base, large arm, forearm and end telescopic shaft, has four frees degree,
It is secondary to rotate wherein between pedestal and base, base and large arm, large arm and forearm, it is mobile between forearm and end telescopic shaft
Angle remains 90 ° between pair, and forearm and end telescopic shaft.
Mechanical arm pedestal using square-section hollow aluminum casting, the DC servo drive motor of internal mounting seat,
The parts such as decelerator, bearing and bearing block, base bottom be one with being uniformly distributed along the circumference four fixed plates of screwed hole, this
Fixed plate is rigidly connected with the multi-joint arm mounting hole in moving cart by bolt.Base is using in circular cross-section
Empty aluminum casting, inside is provided with the parts such as DC servo drive motor, decelerator, bearing and the bearing block of large arm.Greatly
Arm uses the hollow and thin-walled aluminum casting of circular cross-section, and inside is provided with DC servo drive motor, decelerator, the bearing of forearm
And the parts such as bearing block.Forearm uses the solid aluminum casting of circular cross-section, and end is provided with the execution of end telescopic shaft
The parts such as part, i.e. servomotor, Timing Belt, nuts ball leading screw.End telescopic shaft is by servomotor, Timing Belt, nut
Ball-screw and end effector are constituted, and inside ball-screw kinematic pair by the way of nut driving, feed screw nut is existed
The synchronized band of DC servo motor drive it is lower produce rotary motion, so as to drive the leading screw to carry out the linear motion of vertical direction.
Sheet lead is laid on each axle of basic machine and servomotor surface, is placed on outside moving cart;Control section and
Servo-drive is partially disposed in inside moving cart, mitigates the influence of radiation.
Figure 13 be multi-functional clamp structure chart of the invention, the multi-functional clamp device, be one collection quantitative liquid getting and
Gripping carries function in electricity, the gas control device of one, and multi-joint mechanical arm end is rigidly attached at by bolt, outward appearance and interior
Portion's structure is as shown below.
Multi-functional clamp device include a chuck body, a tumbler, a pneumatic scroll chuck device and
One quantitative liquid taking device.
Multi-functional clamp device is controlled by mechanical arm PLC, and action process is described as multi-joint mechanical arm PLC controls
What device received the transmission of moving cart PLC takes liquid instruction or crawl instruction, if taking liquid instruction, then multi-joint mechanical arm
Controller controls tumbler that quantitative liquid taking device is gone to position straight down, then the pneumatic electricity for controlling quantitative liquid taking device
Magnet valve is opened, then dangerization solution progresses into quantitative liquid taking device.At the same time, the gas flow letter in quantitative liquid taking device
Breath, pressure information, dangerization solution height information, to multi-joint mechanical arm controller, are reached and set by respective sensor rapid feedback
Stopping action after quantitative.If crawl instruction, then multi-joint mechanical arm controller control tumbler turns scroll chuck device
To position straight down, then control scroll chuck air-operated solenoid valve to open, realize opening and tightening up for scroll chuck, reach and grab
The purpose for taking, at the same time, the clip pressure force information in scroll chuck device is by respective sensor rapid feedback to many passes
The mechanical arm controller of section, coordinates with air-operated solenoid valve, realizes the precise control of grasp force.
The chuck body front is in octagon, is divided into symmetrical two halves, and the plane of symmetry is with the horizontal 45 ° of angles.Fixture
Body upper part is connected to the shaft end of multi-joint mechanical arm the 4th by flange, and a self-centering three is installed in bottom in the horizontal direction
Dog chuck device, installs a quantitative liquid taking device in vertical direction.
The tumbler is made up of rotary cylinder, cylinder piston, cylinder fixture, silencer, position sensor etc., rotation
Rotaring cylinder is arranged in the chuck body first half by cylinder fixture, and cylinder piston is fixedly linked with chuck body lower half,
Power is provided by rotary cylinder during work, realizes being relatively rotated between chuck body two halves by 180 ° of rotations of cylinder, so that real
Existing scroll chuck device is changed with the instrument of quantitative liquid taking device.Position sensor is used for detecting whether cylinder piston have rotated
180 ° of positions, and information transmission will give multi-joint mechanical arm PLC in place.
The pneumatic scroll chuck device, is the cylindrical jaw arrangement of pneumatic self-centering three, by body, 3 claws, 3 pressures
Force snesor, a set of pneumatic means composition.
In cylinder, there are gas circuit, pneumatic connector and claw gathering sill in inside to scroll chuck device body;3 claws are equal
Cloth, using stainless steel material, above studs with anti-skidding acid and alkali-resistance flexible material on cylindrical body claw gathering sill, is easy to liquid taking cup
Gripping operation.Pressure sensor is arranged on claw inner side, is protected by anti-skidding acid and alkali-resistance flexible material, is held for monitoring crawl
The grasp force during measuring cup of dangerization solution, and pressure information is passed to the PLC of multi-joint mechanical arm.
Scroll chuck pneumatic means includes one 35 logical digital electric magnet valves, two bidirectional speed control valves, a pressures
Force control valve and pipeline.Gas circuit annexation is that one first gas circuit is connected by pipeline with pressure-control valve, then with electromagnetism
Valve is connected, and is divided into two gas circuits, and then two gas circuit pipelines are connected with two bidirectional speeds control valves, last two pipelines and
Pneumatic connector on body is connected.Wherein digital electric magnet valve is connected with the PLC of multi-joint mechanical arm, by multi-joint
The PLC control digital electric magnet valve of mechanical arm, and then the break-make of whole piece gas circuit is controlled, claw is realized while tightening up and opening
The function of opening.Pneumatic means is arranged on moving cart inner second layer.
Scroll chuck is threaded on octagon chuck body one side by I-shaped flange, three-jaw during off working state
Chuck axis is parallel to the ground, and scroll chuck axis is perpendicular to the ground during working condition.
The quantitative liquid taking device, including one take liquid container body, a set of detection sensing device, a set of pneumatic means.
It is a cylindric Corrosion Resistant Frp container to take liquid container body, and body left upper portion has a pneumatic system to connect
Sensing device is detected in interface, body right side for liquid level position, and body interior is moved piston and is divided into upper and lower vessel.Upper container
Room is gas compartment, and two spring fixed end and a compression spring are installed in the inside, it is ensured that the effectively work of gas compartment stabilization.Under
Vessel is liquid chamber, the danger solution for holding extraction.It is mobile piston in the middle of body, sealing ring is placed at piston two,
Sealing ring can effectively ensure that the cut-off of gas compartment and liquid chamber.
Detection sensing device is a set of liquid level position detection sensor, in strip, is pasted onto and takes liquid container body right side,
For detecting the elevation information of liquid level during Liquid extracting, multi-joint mechanical arm is passed to after data processing and conversion
PLC.The liquid level that liquid level position detection sensor is made up of bonding agent, solid capacitor component, data converting circuit etc.
Detection means, solid capacitor component, through necessarily combining, can be sent out by N group solid-states alminium electrolytic condenser according to the height change of liquid level
Raw capacitance size change, then capacitance size change is converted into digital quantity through data converting circuit, so as to realize the real-time of liquid level
Monitoring.Solid capacitor component is pasted onto by bonding agent and takes liquid container body right side, and one layer of corrosion-resistant radiation proof is laid in outside
Sheet lead material.
Pneumatic means includes one 33 logical digital electric magnet valve, vacuum generator component, a bidirectional speed controls
Valve processed, flow sensor, a baroceptor and a pipeline, wherein 33 logical digital electric magnet valves have two outlets
Mouthful, vacuum generator component has an air inlet, a gas outlet.For magnetic valve, one of them goes out the connected mode of pneumatic means
Gas port is connected with the air inlet of vacuum generator component, and another gas outlet is connected with the gas outlet of vacuum generator component, together
When vacuum generator component gas outlet be connected with speed control valve, centre connection one monitoring gas circuit in gas flow rate flow
Sensor, speed control valve takes liquid container body and is connected, one baroceptor of monitoring airline pressure of centre connection.Pneumatic dress
It is equipped with a gas source air inlet and a gas outlet, gas source air inlet connection external air source, in gas outlet and quantitative liquid taking device
The liquid container body that takes be connected, the control end of the digital electric magnet valve in pneumatic means and the PLC of multi-joint mechanical arm
It is connected, realizes that the PLC of multi-joint mechanical arm controls the break-make of pneumatic means gas circuit.The working method of pneumatic means is source of the gas through electricity
Magnet valve produces malleation or negative pressure when flowing through vacuum generator component, is more than or less than the pressure taken in liquid container bulk gas room
Pressure in liquid chamber, piston is moved downward or upward under pressure differential effect, realizes the accurate extraction and discharge of liquid.It is pneumatic
Device is arranged on moving cart inner second layer.
Quantitative liquid taking device by I-shaped flange be threaded in octagon chuck body on one side on, during working condition its
Central axis is vertical with ground holding.
Figure 14 is vision ultrasound examination fundamental diagram of the invention, and vision ultrasonic wave detecting system is a set of wireless
Long distance control system is mobile-robot system " eyes " to be used obstacle on monitoring mobile route, calculates mobile robot
Locus.The system is mainly made up of supervisory control desk, wireless communication module and digital sampling and processing, wherein data
Acquisition processing module is made up of processing unit, vision module and ultrasonic wave module.
Vision ultrasonic wave detecting system merges vision and ultrasonic technology, vision module is coordinated work with ultrasonic wave module
Make, calculate locus coordinate.Its principle is that the two-dimensional image information under high-risk environment is obtained with industrial CCD camera, through image
Treatment is converted into plane XY coordinate informations, then obtains the information in short transverse, i.e. Z coordinate information, two by ultrasonic sensor
Person can obtain locus coordinate after logic cell processes, and it is accurately fixed that moving cart system is carried out according to spatial coordinated information
Position.
Supervisory control desk monitoring application system has vision ultrasonic wave monitoring module, by wireless WIFI and wireless communication module with
Data acquisition module is connected, and the processing unit in data acquisition module uses embedded ARM processor, and industrial CCD is obtained in real time
The elevation information that the video information and ultrasonic displacement sensor that camera is collected are collected, and by Ethernet interface and wirelessly
Communication module, by data feedback to supervisory control desk, data are placed on video server by supervisory control desk, are easy to monitoring module to carry out ring
Border visual control and image space coordinate are calculated.
Data acquisition processing device includes two pieces of right angle installing plates, image pick-up card, 2 industrial CCD sensors, one
Individual ultrasonic displacement sensor, ultrasonic wave analog-digital commutator, an embedded ARM processor and a wireless telecommunications
Device, wherein ccd sensor are connected by image pick-up card with embedded ARM processor, and ultrasonic sensor is turned by modulus
Changing device is connected with embedded ARM processor, is then inserted into formula arm processor and is connected with wireless communication apparatus.Right angle installing plate
It is one of between mechanical arm tail end and grip device, its front install an industrial CCD sensor and a ultrasound
Ripple displacement transducer, both coordinate the data acquisition of the height and position for carrying out plan-position and dangerization liquid level of solution.Another piece straight
Angle installing plate is arranged on grip device right side, and an industrial CCD sensor is installed thereon, is quantified for monitoring dangerization solution in real time
Liquid level in extraction process and device.
Image pick-up card, ultrasonic wave analog-digital commutator, embedded ARM processor, wireless communication apparatus are arranged on movement
Car interior, wherein wireless communication apparatus are by wireless WIFI using 802.11b/g/a/h standard agreements and supervisory control desk video
Ultrasound examination module real-time radio is connected, and image information and ultrasonic digital information are passed in time.
Figure 15 is dangerization solution memory system architecture figure of the invention.The dangerization solution storage device, is mainly used to pacify
The danger solution that full storage and reliable transhipment mobile robot are quantitatively extracted, specifically include a square storage body, 3 take
Liquid measure cup, 3 weight sensors, a set of pneumatic means.
Storage body be corrosion-resistant radiation-resistant stainless steel, mainly by cavity volume body, moving cylinder, linkage,
Top pressure closure, sealed bolster composition.Cavity volume body is in cuboid, and there are three cavitys centre, can accommodate 3 safety glass materials
Take liquid measure cup.Location interval certain distance arranges that two small one and large one cuboids are convex to cavity volume body upper surface symmetrical centre rearward
Rise, small cuboid is raised for connecting, big cuboid is raised for limiting top pressure closure spatial dimension, make its with cavity volume body on
End face keeping parallelism.Cavity volume body top is square pneumostop lid, and pneumostop base portion places 3 ratios and takes liquid measure rim of a cup
The bigger sealed bolster in footpath, can prevent from splashing down out in dangerization solution transportation after normal sealing.Pneumostop lid afterbody is consolidated
Determine linkage, connecting rod centre position projects through hinge 1 and forms rotation pair, connecting rod afterbody and a movable gas with small cuboid
The piston of cylinder is formed by hinge 2 and rotates secondary connection.The side bottom of cavity volume body two has depositing in four mounting seats, with moving cart
Storage device mounting seat is rigidly connected with bolt.
Moving cylinder is made up of air rammer and cylinder block, and air rammer is cylindrical, passes through with linkage end
Hinge 2 is formed and rotates secondary;Cylinder block is cylindrical, and there are two pneumatic connectors on right side, for connecting pneumatic means;Cylinder cylinder
Body bottom is formed by hinge 3 with cavity volume body rear end face and rotates secondary, moving cylinder is freely rotated with around hinge 3.
Take liquid measure cup and use transparent safety glass material, it is supporting with the cavity volume stored on body, it is not of the same race for storing
The liquid of class.Weight sensor use rondelle resistance-strain type weight sensor, be connected through a screw thread be fixed on take liquid measure cup
Cavity volume bottom, with enter cavity volume take that liquid measure is cup-shaped to be contacted into face.Its measured value is connected to after being changed through A/D by data wire
Moving cart PLC, the dynamic weight of dangerization solution in liquid measure cup is taken to monitor constantly.
Pneumatic means in storage device includes one 35 logical digital electric magnet valves, two bidirectional speed control valves, one
Individual pressure-control valve and pipeline.Gas circuit annexation is that one first gas circuit is connected by pipeline with pressure-control valve, then with
Magnetic valve is connected, and is divided into two gas circuits, and then two gas circuit pipelines are connected with two bidirectional speed control valves, last two pipelines
It is connected with the pneumatic connector of cylinder.Wherein digital electric magnet valve is controlled by moving cart PLC, in multi-joint mechanical arm
When system take the relevant actions such as liquid, tapping, moving cart PLC sends corresponding control signal and gives pneumatic means electromagnetism
Valve control end, drives top pressure closure cooperative mechanical arm to perform and opens and closes operation.The pneumatic means is arranged in moving cart
Portion's second layer.
Storage device is as shown below with the connection diagram of moving cart controller, and moving cart controller is filled with storage
Magnetic valve connection in putting, controls gas path on-off, realizes the opening and closing of top pressure closure;Weight sensor passes through converter
It is connected with moving cart PLC, the weight information of dangerization solution during liquid is taken in real time, dangerization is realized by feeding back
Solution precise quantification is controlled.
Figure 16 is power system modules pie graph of the invention.The power-supply system, for being carried for mobile-robot system
For electric power energy that is mobile and operating, it is made up of battery, wireless charging device and power-supply management system, wherein battery is
The offer dc source such as high density lithium battery strings are directly moving cart, multi-joint mechanical arm;Wireless charging device uses magnetic coupling
The energy transmission means of resonance is closed, the supplying cell to mobile robot carries out noncontact wireless charging, by transmitter module, received
The two parts such as module are constituted;Power-supply management system is a battery strings management system, by data acquisition module, control protection mould
Block, memory module, balance module etc. are constituted, for carrying out cell-state monitoring, battery cell equilibrium, battery charging management
And cell safety protection etc..
Moving cart wireless charging system is made up of power supply transmitter module and power supply receiver module, and power supply transmitter module is by nothing
Line dispensing device and send power management module composition, wherein wireless base station apparatus by high frequency pumping source, resonance transmission circuit with
And repeat circuit is constituted, whole device is installed on the ground of safety zone, constitutes power supply transmitting terminal;Power supply receiver module is by wireless
Reception device and receive power management module composition, wherein radio receiver by regulator rectifier circuit, resonance receiving circuit and
Power management module is constituted, and is installed on moving cart bottom, constitutes power supply receiving terminal.
Battery dump energy entrained by mobile robot power-supply management system real-time monitoring, and by wireless WIFI it is real-time on
Report supervisory control desk, if dump energy is less than certain threshold value in off working state, can point out to move during master control platform distribution task
Mobile robot system charge deficiency is, it is necessary to charge;If perform work in electricity be less than certain threshold value, mechanically moving people to
Master control platform sends low battery alarm, interrupt it is current take liquid or moving operation, preserve current task state, wait master control platform to assign
Charging instruction.When mobile robot charges, charging emitter installation site first is automatically moved to along navigation tape, now power supply
Electric main is converted into 24V direct currents by input through wireless charging device, and is stored in lithium battery group.After completing to charge,
Task status before mobile robot recovery, proceeds corresponding operating.
Composition based on said system, it is proposed that a kind of quantitative extracting method of dangerization solution, the method is applied to high-risk
Dangerization solution sampling detection-phase, by introducing a kind of danger solution extraction system based on mobile robot, by high-risk environment
The middle fixed danger solution extraction device for using is substituted for the corrosion resistant mobile robot dangerization solution extraction device of radiation proof,
So as to realize dangerization solution efficiently, quantitative, Visual Inference operation.
Danger solution extraction system involved by the method include a supervisory control desk, a set of wireless network communication system,
One movement of integrated moving cart, multi-joint mechanical arm, multi-functional clamp, storage device and vision ultrasonic wave detecting system
Robot system.The thought for using controlling organization and executing agency separate, mobile-robot system is placed on as executing agency
Inside high-risk environment, supervisory control desk is placed on outside high-risk environment as controlling organization, and supervisory control desk passes through wireless network communication system
Mobile-robot system in system real-time control high-risk environment.
The bodies such as moving cart in dangerization solution extraction system and multi-joint mechanical arm involved by the method use matter
Light resistant material, radiation-resistant sheet lead is laid in each body surface;Control system is using the good strong antijamming capability of shielding
PLC, and being sealed in inside moving cart, isolates with high-risk environment completely, only allows the electrically enforcement division such as servomotor, stepper motor
Part is in high-risk environment.
Figure 17 is that mobile robot dangerization solution of the invention extracts overall flow figure.A kind of danger based on mobile robot
Change the method that solution processing methods include mobile-robot system state-detection and initial work;Supervisory control desk system dangerization is molten
The method that liquid extraction instruction is assigned;The method that mobile route is planned automatically;The side that dangerization solution is automatically positioned and quantitatively extracts
Method;The dangerization solution method that storage, transport and fixed point are placed safely;The method that unnecessary dangerization solution is automatically processed;Mobile machine
People first gives instruction and moves to different Wei Hua solution areas to carry out dangerization solution automatically fixed according to high-risk environment outside supervisory control desk
Amount is extracted, and is deposited with the danger solution storage device in moving cart;It is again that the transport of dangerization solution is complete to detection specified location
Task is placed into fixed point dangerization solution, waits artificial dangerization solution of taking away to carry out follow-up every detection work;Last moving machine
Dangerization solution transport treat or unnecessary is arrived dangerization solution treatment trough and process in order by device people.
Figure 18 is mobile-robot system state-detection of the invention and initialization flow.High-risk environment is considered in the method
Smaller is influenceed on the tape for being layered on ground, therefore moving cart carries out navigation movement by the way of tape sensing.In advance on ground
On lay out dolly course according to systematic schematic diagram navigation tape, cook up starting point, test point, intermediate point, dangerization
The key position point such as solution pool point and unnecessary danger solution process points, and calibrate key position point with terrestrial reference tape.
The method is related to moving cart from starting point through intermediate point and the moving operation of dangerization solution point to test point, therefore needs
To be worked out in advance inside Mobile trolley control system and store path mobile process block.Also relate to be carried out using mechanical arm
Dangerization solution is quantitatively extracted, dangerization solution puts back to storage device, the tapping of monitor station fixed point, unnecessary danger solution automatic clamping, many
The typical operations such as remaining dangerization solution treatment, therefore need to work out and store corresponding operating program in mechanical arm control system in advance
Block.
Before carrying out the extraction of dangerization solution, navigation tape laying need to be carried out, i.e., first be used according to systematic schematic diagram on the ground
Navigation tape lays out dolly movement route, cooks up starting point A, intermediate point B, dangerization solution pool point C, test point D and danger
The key position points such as change solution treatment trough point E, wherein starting point only one of which, labeled as A;Intermediate point has two, labeled as B1,
B2;Dangerization solution pool point has three, labeled as C1, C2, C3;Test point has three, labeled as D1, D2, D3;The treatment of dangerization solution
Groove point has one, labeled as E.Then key position point is calibrated on the ground with terrestrial reference tape corresponding with key point.
After tape laying, multi-joint mechanical arm coordinate system demarcation is carried out, specifically include multi-joint mechanical arm establishment of coordinate system
Set with dead-center position, wherein multi-joint mechanical arm coordinate system includes that fundamental coordinate system Base, reference frame Ref, instrument are sat
Mark system Tool, fundamental coordinate system Base are arranged on multi-joint mechanical arm base bottom center, examine coordinate system Ref and are arranged on multi-joint
Mechanical arm tail end telescopic shaft bottom centre, tool coordinates system Tool1 is arranged on quantitative liquid taking device bottom centre, tool coordinates system
Tool2 is arranged on pneumatic scroll chuck device chuck upper surface center.Multi-joint mechanical arm zero point is carried out after establishment of coordinate system
Position is set, with the forearm side of multi-joint mechanical arm and top surface respectively with moving cart side and top surface keeping parallelism, many work(
It is criterion that energy fixture keeps certain safe distance with moving cart and ground.
After tape laying, multi-joint mechanical arm coordinate system demarcation is carried out, specifically include multi-joint mechanical arm establishment of coordinate system
Set with dead-center position, wherein multi-joint mechanical arm coordinate system includes that fundamental coordinate system Base, reference frame Ref, instrument are sat
Mark system Tool, fundamental coordinate system Base are arranged on multi-joint mechanical arm base bottom center, examine coordinate system Ref and are arranged on multi-joint
Mechanical arm tail end telescopic shaft bottom centre, tool coordinates system Tool1 is arranged on quantitative liquid taking device bottom centre, tool coordinates system
Tool2 is arranged on pneumatic scroll chuck device chuck upper surface center.Multi-joint mechanical arm zero point is carried out after establishment of coordinate system
Position is set, with the forearm side of multi-joint mechanical arm and top surface respectively with moving cart side and top surface keeping parallelism, many work(
It is criterion that energy fixture keeps certain safe distance with moving cart and ground.
Multi-joint mechanical arm coordinate demarcate after, carry out high-risk environment state-detection, mobile-robot system state-detection,
It is artificial to take the contents such as liquid instrument preparation, it is ensured that the ambient parameter that dangerization solution is extracted extracts dress in zone of reasonableness and dangerization solution
Put good for use.Dangerization solution environmental state-detection includes, timely by the environmental monitoring sensor under high-risk environment
Ambient condition parameter is obtained, and is stored in historical data base, be easy to history environment data query.Mobile-robot system state
Detection includes, supervisory control desk sends self-checking command to mobile-robot system, then mobile-robot system carries out battery electric quantity and looks into
Inquiry, moving cart status inquiry, each joint states inquiry of robotic arm, multi-functional clamp status inquiry, video ultrasound ripple detection system
The functional module self-inspections such as system inquiry, after all module checks, supervisory control desk are fed back by state parameter.Need to be detected in advance simultaneously
Platform manually takes liquid preparation, prepares the corrosion resistant rubber gloves of radiation proof, for taking out what mobile robot was taken out by command request
Dangerization solution;Check and specify tapping point whether occupied, it is no then liquid measure glass will be taken and be placed on monitor station specified location.
In addition, mobile-robot system self-inspection starts initial work, i.e. moving cart after all going well return to path shifting
Dynamic starting point, each joint of mechanical arm returns to dead-center position, and multi-functional clamp dangerization solution extraction device is perpendicular to ground, dangerization
Solution storage device closure is closed, and dangerization solution storage system closure is closed, and video ultrasound ripple detecting system begins preparing for
Work etc..
After initial work, moving cart enters idle condition, waits supervisory control desk to assign further instruction.
Figure 19 is instruction issuing of the invention and process of data communication figure.Mobile-robot system items preparation is completed
After, then to be specified according to detection demand setting detection consumption scheme, including detection liquid numbering, detection amount of liquid, detection liquid
Three parameters such as tapping point, then in supervisory control desk application monitoring system take liquid information input and instruction sending module in be input into
Three detection consumption parameters, what dangerization solution storage device of the supervisory control desk in mobile-robot system was allowed takes liquid measure cup
Quantity and the information inspection such as the occupied situation of volume, monitor station and Wei Hua solution area dangerization solution storage class and amount of storage are used
The reasonability of amount scheme.
Scheme reasonableness check condition and detailed step:
(1)The quantity for taking liquid measure cup in current memory device is N number of, each volume M liters, then the number of detection liquid numbering
<=N, every kind of detection amount of liquid<=M liters;
(2)For there is P test point in the monitor station of placement detection liquid, and there is Q individual occupied, then it is individual that detection liquid is numbered
Number<=P-Q;
(3)The danger solution of Wei Hua solution area storage has R types, every kind of to have T to rise amount of storage, and every kind of amount of storage can not be less than
S liters, then be allowed to the detection liquid numbering number extracted<=R, and every kind of detection amount of liquid<=T-S liters.
After scheme reasonableness check, supervisory control desk goes out from starting point A to dangerization solution according to detection consumption parameter determination
The key position points such as treatment trough point E.Planning process is that detection consumption parameter includes detection liquid numbering, detection liquid in detail
Amount, detection liquid specify tapping point, then determine dangerization solution pool point according to detection liquid numbering, tapping point is specified according to detection liquid
Determine test point, taken in supervisory control desk monitoring application system true according to these conditions inside liquid information input and instruction sending module
Dangerization solution pool point C and test point D are made, is connected with fixed starting point A, intermediate point B and dangerization solution treatment trough point E
Get up, it may be determined that go out from A to E, return key position point as A.
After key position point determines, key position point and consumption parameter are sent.Supervisory control desk passes through wireless telecommunication system
Key position point and detection consumption parameter are sent to the moving cart in mobile-robot system, moving cart receives correlation
After information, feed back to supervisory control desk information and receive situation, wait supervisory control desk to send and the next step action order such as start or stop.
Figure 20 is mobile route process planning figure of the invention.Supervisory control desk sends enabled instruction by wireless telecommunication system
To moving cart, that is, send the programmed instruction that a triggering moving cart is started working;Moving cart receives root after enabled instruction
The key position point information being previously sent according to supervisory control desk moves path planning, after the completion of by planning information storage in movement
Dolly PLC;The information such as work order that then moving cart PLC will be cooked up and liquid extraction parameter sends
Give multi-joint mechanical arm system PLC;After mechanical arm PLC receives information, multi-joint mechanical arm operation is carried out
Path planning, after the completion of by planning information storage in multi-joint mechanical arm PLC.Mobile-robot system planning is completed
Afterwards, supervisory control desk planning situation is fed back to, waits supervisory control desk to send next step action order.
The mobile route of moving cart is planned:
1)Path planning program block is worked out inside moving cart PLC, the program block receives supervisory control desk transmission first
Enabled instruction after key position point processing movement loop, the direction of motion and translational speed for being sent according to supervisory control desk etc.
Kinematic parameter;
2)Using path planning program block according to the space coordinates computing moving cart key position point set under high-risk environment
Design attitude information, the comparison reference point of the actual position information detected as navigation sensor and landmark sensor;
3)Using path planning program block, 1 aided location point, union are planned in guidance path both sides between key position point
Go out kinematic parameters such as the mobile loop of local auxiliary, the direction of motion and translational speed etc., it is mobile when guidance path is obstructed
The optional subsidiary loop of dolly gets around obstacle and continues to move to;
4)Moving cart navigation data treatment blockette is added inside path planning program block, the blockette is used for place
The data that reason magnetic navigation sensor and magnetic landmark sensor are detected, it is ensured that moving cart is moved back to along navigation magnetic stripe or auxiliary
Move on road;
5)Mapped using path planning program block planning out position and signal, i.e., moving cart move to different key position points to
Work order and dangerization solution extracting parameter that multi-joint mechanical arm PLC sends, to the actual bit of supervisory control desk feedback
Confidence is ceased and equipment operation condition, and wherein work order is quantitatively extracted including dangerization solution, dangerization solution puts back to storage device, inspection
The tapping of scaffold tower fixed point, unnecessary danger solution automatic clamping, unnecessary danger solution 5 typical multi-joint mechanical arms such as are toppled over and are operated
Work order, can be identified with M01 ~ M05 respectively, and dangerization solution extracting parameter mainly includes the extracted amount of every kind of dangerization solution, can
Identified with P01 ~ P03 respectively.
The operation planning of multi-joint mechanical arm refers to:
1)Operation planning program block is worked out inside multi-joint mechanical arm PLC, the program block is received from moving cart hair first
The information such as the work order sent and dangerization solution extracting parameter;
2)Mechanical arm During typical operation is planned using operation planning program block, is extracted according to actual dangerization solution and treatment operation
Feature, extract dangerization solution is quantitatively extracted, dangerization solution puts back to storage device, monitor station pinpoint tapping, unnecessary danger solution oneself
5 During typical operations such as dynamic gripping, the treatment of unnecessary dangerization solution, then work out mechanical arm allusion quotation inside operation planning program block
Type function subprogram block;
3)The movement rule of each process, computing mobile route, moving direction and movement are set using operation planning program block
Speed, the danger solution extracting parameter sent then in conjunction with supervisory control desk together changes robotic arm manipulation program block, is allowed to applicable
Different danger solution is extracted and required;
4)Work order is parsed, using operation planning program block according to certain rule by different work orders with it is right
Answer amended operation sequence block to bind, constitute the mapping one by one of work order and operation sequence block.
In addition, moving cart movement loop is described as, moving cart starts from starting point A, and tape navigates through centre
To useless point C is specified, after completion dangerization solution is quantitatively extracted and danger solution is stored, moving cart navigation moves to monitor station to point B
D, after manually carrying out the detection of dangerization solution, transports unnecessary dangerization solution to dangerization solution treatment trough point E, and last moving cart is returned to
Starting point A.
Figure 21 is automatically positioned and quantifies extraction process for dangerization solution of the invention.Moving cart step rule as described in Figure 20
The path drawn moves to from starting point A and specifies dangerization solution point C, control signal is sent afterwards and gives multi-joint mechanical arm system, orders
It is made to begin preparing for work.Quantitative liquid taking device first in the multi-functional clamp device of multi-joint mechanical arm system end is rotated
To working position;Then multi-joint mechanical arm is raised to safe altitude, the vision module guiding in vision ultrasonic wave detecting system
Under move to and specify inside dangerization solution pool, plan-position is determined, while the ultrasonic wave mould in vision ultrasonic wave detecting system
BOB(beginning of block) works, and detects the distance between dangerization liquid level of solution and taken amount device, determines height and position;Then multi-joint machine
Tool arm PLC determines quantitative liquid taking device locus coordinate according to the plan-position and height and position that detect, and
Control quantitative liquid taking device is carried out first time dangerization solution and is quantitatively inhaled by the deep following certain distance in danger solution face of certain speed
Take, after uptake reaches setting value, by dangerization solution be transferred to storage device take liquid measure cup in;Then according to previous receipt
To take liquid instruction and path planning, moving cart is transferred to next dangerization solution point, carries out second danger solution quantitative
Draw, analogize with this, the quantitative liquid getting operation until completing all specified dangerization solution points.
Specifically, the I/O port of multi-joint mechanical arm PLC can directly send control signal, in driving pneumatic system
Vacuum generator component, controls accurate air-breathing and the deflation of pneumatic system, then quantitative liquid taking device utilizes this when taking liquid every time
Plant principle and realize that liquid is accurately drawn and discharge.
The liquid container body that takes in quantitative liquid taking device is divided into upper and lower vessel, and upper container room is gas compartment, lower vessel
It is liquid chamber.Pneumatic system starts air-breathing first, makes gas compartment full of working gas, while by the movement in quantitative liquid taking device
Piston is slowly pushed into bottommost, evacuation of liquid room.Multi-joint mechanical arm PLC control machinery arm is slowly moved downward, and is made
The deep following certain distance in danger solution face of quantitative liquid taking device, pneumatic system starts exhaust, makes the work in quantitative liquid taking device
Plug is slowly moved up, and the sensor on simultaneous quantitative liquid taking device constantly detects the danger amount of solution of extraction, danger to be detected
When change amount of solution is equal with setting value, pneumatic system stops exhaust, and dangerization solution extracts operation completion.Then multi-joint mechanical arm
PLC transmission takes liquid completion signal and detects dangerization solution in time to dangerization solution storage device, dangerization solution storage device
Storage condition, control pneumatic system opens top pressure closure, carries out storage dangerization solution and prepares.Multi-joint mechanical arm PLC
According to dangerization solution storage information select it is new take liquid measure cup, then by the injection selection of dangerization solution in the presence of pneumatic system
Take liquid measure cup.Dangerization solution storage device top pressure closure is finally closed, prevents from being scattered in dangerization solution transport process, it is so far complete
Stored into dangerization solution and operated.At the same time, each joint of multi-joint mechanical arm returns to dead-center position, and preparation receives instruction to be carried out
Act next time.
Figure 22 is that dangerization solution of the invention is transported and fixed point tapping flow.Moving cart step planning as described in Figure 20
Path moves to specified test point from dangerization solution point.In transportation, dangerization solution storage device keeps closing, until reaching
Specified location.Then fixed point tapping operation is carried out, moving cart PLC control dangerization solution storage device is pneumatic first
Top pressure closure is opened, and is retransmited tapping and is instructed multi-joint mechanical arm system of giving, after multi-joint mechanical arm system receives tapping instruction
Dangerization solution storage device top is moved to, the chuck body of its PLC control multi-functional clamp device rotates 180 degree,
Change pneumatic scroll chuck device into, then the liquid measure glass that takes of dangerization solution will be stored and pressed from both sides from dangerization solution storage device and be taken out to one
Fixed height, finds specified tapping point under the guiding of vision ultrasonic system and tapping highly, finally calls what is woven in advance
Monitor station fixed point tapping program block will take liquid measure cup and be placed on specified monitor station.So repeat, until the danger solution for extracting is complete
Portion is placed on monitor station specified location.After fixed point tapping operation is completed, mechanically moving people's system stopping action waiting next step
Action command.
Figure 23 is unnecessary dangerization solution Auto Processing of the invention.After manually carrying out the detection of dangerization solution, unnecessary danger
Change solution and put back to former monitor station tapping point together with liquid measure cup is taken, press the detection being connected with supervisory control desk beside tapping point and complete
Button, then supervisory control desk sends unnecessary dangerization solution process instruction to mobile-robot system, orders it that unnecessary dangerization is molten
Liquid is transferred to dangerization solution treatment trough point and is processed.Detection completing button on supervisory control desk is by OI expansion cards and master control meter
Calculation machine is connected, the monitoring application system on its signal message input main control computer, by monitoring application system after treatment
Take liquid information input and instruction sending module and unnecessary dangerization solution process instruction is sent to moving cart system.
Mobile-robot system receives unnecessary dangerization solution process instruction, with the pneumatic three-jaw in multi-joint mechanical arm system
Chuck assembly will take liquid measure cup and press from both sides back dangerization solution storage device and seal, and it is molten that the path planned according still further to Figure 20 moves to dangerization
Liquid treatment trough point, finds dangerization solution treatment trough tapping position under the guiding of vision ultrasonic system, calls and weaves in advance
Unnecessary danger solution processing routine block perform unnecessary dangerization solution treatment work.After completing unnecessary dangerization solution treatment work,
The path planned according to Figure 20 moves to starting point, waits master control to send next step action command.So far first round danger is completed
Change solution to extract and process task.
After completing the extraction of first round dangerization solution and process task, whether mobile-robot system inquiry has new task,
No then stopping release work, and feed back to the signal of supervisory control desk task completion;Have, begin preparing for the second wheel and take liquid
Task, is so repeated, and liquid task is taken until completion is all.
It is only for help understands the present invention, rather than for limiting this hair for the description of the understanding of specific embodiment
Bright.Those skilled in the art can carry out some and change and change using thought of the invention, as long as its technological means does not have
There are disengaging thought of the invention and main points, still within protection scope of the present invention.
Claims (6)
1. a kind of method that dangerization solution based on mobile robot is stored safely, transport and fixed point are placed, it is characterised in that institute
Stating mobile robot includes moving cart system, multi-joint mechanical arm system, chucking appliance system, vision ultrasonic wave detecting system and danger
Change solution storage system;The mobile robot is connected with supervisory control desk system communication;It is characterized in that:
a)Moving cart system is moved to specified test point by path planning from specified dangerization solution point;
b)Open dangerization solution storage system;
c)Moving cart system sends instructions to articulated mechanical arm system, and multi-joint mechanical arm system drives chucking appliance system to be moved to
Dangerization solution storage system top;
d)Multi-joint mechanical arm system operates chucking appliance system under the guiding of vision ultrasonic wave detecting system, by dangerization solution from danger
Change taking-up in solution storage system, put to specified test point;
e)Check in dangerization solution storage system whether also have storage dangerization solution, repeat step c)、d).
2. a kind of danger solution based on mobile robot according to claim 1 safely place by storage, transport and fixed point
Method, it is characterised in that:Moving cart system and multi-joint mechanical arm system are built-in with PLC;Moving cart system
System PLC is master-slave control mode with multi-joint mechanical arm system PLC.
3. a kind of danger solution based on mobile robot according to claim 2 safely place by storage, transport and fixed point
Method, it is characterised in that:The mobile path planning is stored in moving cart system PLC.
4. a kind of danger solution based on mobile robot according to claim 2 safely place by storage, transport and fixed point
Method, it is characterised in that:The dangerization solution storage system includes storage body, takes liquid measure cup, weight sensor and gas
Dynamic device;The liquid measure cup that takes is placed in storage body;The weight sensor is placed in and takes liquid measure cup bottom;The pneumatic means
One end is connected with moving cart system PLC, and the other end is connected with storage body;The weight sensor and moving cart
System PLC is connected;Moving cart system PLC opens the pneumatic top of sealing of storage body by pneumatic means
Lid.
5. a kind of danger solution based on mobile robot according to claim 2 safely place by storage, transport and fixed point
Method, it is characterised in that:Moving cart system PLC sends instructions to multi-joint mechanical arm system PLC, and
Multi-joint mechanical arm system is set to drive grip device to be moved to dangerization solution storage system top.
6. a kind of danger solution based on mobile robot according to claim 2 safely place by storage, transport and fixed point
Method, it is characterised in that:The chucking appliance system includes chuck body, tumbler, quantitative liquid taking device and pneumatic three-jaw
Chuck assembly;The chuck body of multi-joint mechanical arm system PLC control chucking appliance system is rotated, pneumatic scroll chuck dress
Put and turn to working position;Multi-joint mechanical arm PLC controls pneumatic scroll chuck device that storage dangerization solution is taken into liquid
Measuring cup is pressed from both sides from dangerization solution storage system and is taken out to certain altitude, is found under the guiding of vision ultrasonic wave detecting system specified
Tapping point and tapping highly, finally call the monitor station in multi-joint mechanical arm system PLC to pinpoint tapping program block will
Take liquid measure cup and be placed on specified test point.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710073654.0A CN106799737B (en) | 2017-02-10 | 2017-02-10 | Safe storage, transportation and fixed-point placement method for hazardous chemical liquid based on mobile robot |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710073654.0A CN106799737B (en) | 2017-02-10 | 2017-02-10 | Safe storage, transportation and fixed-point placement method for hazardous chemical liquid based on mobile robot |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106799737A true CN106799737A (en) | 2017-06-06 |
CN106799737B CN106799737B (en) | 2020-04-10 |
Family
ID=58987449
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710073654.0A Active CN106799737B (en) | 2017-02-10 | 2017-02-10 | Safe storage, transportation and fixed-point placement method for hazardous chemical liquid based on mobile robot |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106799737B (en) |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107263506A (en) * | 2017-07-28 | 2017-10-20 | 柳州福能机器人开发有限公司 | Food and drink transportation robot |
CN107433596A (en) * | 2017-08-17 | 2017-12-05 | 柳州福能机器人开发有限公司 | Liquid charging stock transportation robot with sterilizing function |
CN107471222A (en) * | 2017-08-17 | 2017-12-15 | 柳州福能机器人开发有限公司 | Liquid charging stock transportation robot |
CN110039554A (en) * | 2019-04-10 | 2019-07-23 | 四川虫洞科技有限公司 | A kind of house Pneumatic logistic transportation robot control system |
CN110125036A (en) * | 2019-04-25 | 2019-08-16 | 广东工业大学 | A kind of self-identifying sorting system and method based on template matching |
CN110316555A (en) * | 2018-03-31 | 2019-10-11 | 世博生态环保技术股份有限公司 | A kind of robotic arm recovery processing method for waste water and the robotic arm using this method |
CN111688526A (en) * | 2020-06-18 | 2020-09-22 | 福建百城新能源科技有限公司 | User side new energy automobile energy storage charging station |
CN112229683A (en) * | 2020-12-14 | 2021-01-15 | 中国电力科学研究院有限公司 | Transformer oil appearance collection robot |
CN113189321A (en) * | 2021-04-12 | 2021-07-30 | 攸太科技(台州)有限公司 | Urine detection method |
CN113188848A (en) * | 2021-04-12 | 2021-07-30 | 攸太科技(台州)有限公司 | Urine tracking method |
CN114986469A (en) * | 2022-07-12 | 2022-09-02 | 江苏西顿科技有限公司 | Radiation-proof operation robot |
US11911913B2 (en) | 2018-11-28 | 2024-02-27 | Bayer Aktiengesellschaft | Method for transferring a pourable medium |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5443354A (en) * | 1992-07-20 | 1995-08-22 | The United States Of America As Represented By The Administrator Of The National Aeronautics And Space Administration | Hazardous materials emergency response mobile robot |
US6113343A (en) * | 1996-12-16 | 2000-09-05 | Goldenberg; Andrew | Explosives disposal robot |
CN101293349A (en) * | 2008-06-05 | 2008-10-29 | 广州大学 | Robot based on Wi-Fi |
CN101739015A (en) * | 2009-12-16 | 2010-06-16 | 中国人民解放军防化指挥工程学院 | System and method for commanding and controlling operation for destroying dangerous chemicals by burning |
CN104354157A (en) * | 2014-10-29 | 2015-02-18 | 南京航空航天大学 | Tire transfer robot and control method thereof |
JP2015080816A (en) * | 2013-10-21 | 2015-04-27 | 株式会社近藤製作所 | Workpiece transport device |
-
2017
- 2017-02-10 CN CN201710073654.0A patent/CN106799737B/en active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5443354A (en) * | 1992-07-20 | 1995-08-22 | The United States Of America As Represented By The Administrator Of The National Aeronautics And Space Administration | Hazardous materials emergency response mobile robot |
US6113343A (en) * | 1996-12-16 | 2000-09-05 | Goldenberg; Andrew | Explosives disposal robot |
CN101293349A (en) * | 2008-06-05 | 2008-10-29 | 广州大学 | Robot based on Wi-Fi |
CN101739015A (en) * | 2009-12-16 | 2010-06-16 | 中国人民解放军防化指挥工程学院 | System and method for commanding and controlling operation for destroying dangerous chemicals by burning |
JP2015080816A (en) * | 2013-10-21 | 2015-04-27 | 株式会社近藤製作所 | Workpiece transport device |
CN104354157A (en) * | 2014-10-29 | 2015-02-18 | 南京航空航天大学 | Tire transfer robot and control method thereof |
Cited By (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107263506A (en) * | 2017-07-28 | 2017-10-20 | 柳州福能机器人开发有限公司 | Food and drink transportation robot |
CN107433596A (en) * | 2017-08-17 | 2017-12-05 | 柳州福能机器人开发有限公司 | Liquid charging stock transportation robot with sterilizing function |
CN107471222A (en) * | 2017-08-17 | 2017-12-15 | 柳州福能机器人开发有限公司 | Liquid charging stock transportation robot |
CN110316555A (en) * | 2018-03-31 | 2019-10-11 | 世博生态环保技术股份有限公司 | A kind of robotic arm recovery processing method for waste water and the robotic arm using this method |
US11911913B2 (en) | 2018-11-28 | 2024-02-27 | Bayer Aktiengesellschaft | Method for transferring a pourable medium |
CN110039554A (en) * | 2019-04-10 | 2019-07-23 | 四川虫洞科技有限公司 | A kind of house Pneumatic logistic transportation robot control system |
CN110125036A (en) * | 2019-04-25 | 2019-08-16 | 广东工业大学 | A kind of self-identifying sorting system and method based on template matching |
CN111688526A (en) * | 2020-06-18 | 2020-09-22 | 福建百城新能源科技有限公司 | User side new energy automobile energy storage charging station |
CN112229683B (en) * | 2020-12-14 | 2021-03-16 | 中国电力科学研究院有限公司 | Transformer oil appearance collection robot |
CN112229683A (en) * | 2020-12-14 | 2021-01-15 | 中国电力科学研究院有限公司 | Transformer oil appearance collection robot |
CN113189321A (en) * | 2021-04-12 | 2021-07-30 | 攸太科技(台州)有限公司 | Urine detection method |
CN113188848A (en) * | 2021-04-12 | 2021-07-30 | 攸太科技(台州)有限公司 | Urine tracking method |
CN114986469A (en) * | 2022-07-12 | 2022-09-02 | 江苏西顿科技有限公司 | Radiation-proof operation robot |
CN114986469B (en) * | 2022-07-12 | 2023-11-07 | 江苏西顿科技有限公司 | Radiation-proof operation robot |
Also Published As
Publication number | Publication date |
---|---|
CN106799737B (en) | 2020-04-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106799737A (en) | A kind of method that dangerization liquid safe storage based on mobile robot, transport and fixed point are placed | |
CN106843213A (en) | The method that a kind of movement and courses of action based on mobile robot are planned automatically | |
CN106695741A (en) | Method for system state detection and initial work of mobile robot | |
CN106813943A (en) | A kind of method that dangerization solution based on mobile robot is automatically positioned and quantitatively extracts | |
CN106625567A (en) | Mobile robot for dangerous chemical solution extraction | |
CN206493309U (en) | A kind of pneumatic multi-jaw chuck device | |
CN103978474B (en) | A kind of job that requires special skills robot towards extreme environment | |
CN106584421A (en) | Mobile trolley system based on mobile robot | |
CN206899222U (en) | A kind of multi-joint mechanical arm system based on mobile robot | |
WO2019233222A1 (en) | Automatic wall-climbing radar photoelectric robot system for use in non-destructive detection and diagnosis of bridge-tunnel structure damage | |
CN104476550B (en) | The method of operating of all-hydraulic autonomous mechanical arm | |
CN106695742A (en) | Multi-joint mechanical arm system based on mobile robot | |
WO2017185914A1 (en) | Electric automobile energy monitoring and swapping network in remote monitoring of cloud computing network architecture | |
CN104284151B (en) | A kind of transformer station ground method for inspecting and cruising inspection system | |
CN107329483A (en) | The detecting robot of pipe system and method for work of a kind of view-based access control model technology | |
CN106737556A (en) | A kind of danger solution extraction system based on mobile robot | |
CN102990640B (en) | Intelligent transportation robot of electric power storehouse | |
CN106799734A (en) | A kind of method that unnecessary danger solution based on mobile robot is automatically processed | |
CN102009046A (en) | Intelligent mobile cleaning robot | |
CN107947723A (en) | A kind of cleaning method of photovoltaic cleaning robot | |
CN106644588A (en) | Quantitative liquid taking device for dangerous chemical solution extraction | |
CN105751200A (en) | Action method of fully hydraulic autonomous moving mechanical arm | |
CN109283930A (en) | A kind of spherical intelligent inspection robot | |
CN106873588A (en) | A kind of danger solution extracting method based on mobile robot | |
CN206493308U (en) | A kind of mobile robot extracted for dangerization solution |
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 |