CN105751199B - The method of operating of all-hydraulic autonomous mechanical arm - Google Patents

The method of operating of all-hydraulic autonomous mechanical arm Download PDF

Info

Publication number
CN105751199B
CN105751199B CN201610236245.3A CN201610236245A CN105751199B CN 105751199 B CN105751199 B CN 105751199B CN 201610236245 A CN201610236245 A CN 201610236245A CN 105751199 B CN105751199 B CN 105751199B
Authority
CN
China
Prior art keywords
omni
camera
moving platform
mechanical arm
mechanical arms
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.)
Expired - Fee Related
Application number
CN201610236245.3A
Other languages
Chinese (zh)
Other versions
CN105751199A (en
Inventor
鲁守银
王涛
杨志强
高真
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
JINAN LUZHI ELECTRONIC TECHNOLOGY Co Ltd
Original Assignee
JINAN LUZHI ELECTRONIC TECHNOLOGY Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by JINAN LUZHI ELECTRONIC TECHNOLOGY Co Ltd filed Critical JINAN LUZHI ELECTRONIC TECHNOLOGY Co Ltd
Priority to CN201610236245.3A priority Critical patent/CN105751199B/en
Priority claimed from CN201410739963.3A external-priority patent/CN104476550B/en
Publication of CN105751199A publication Critical patent/CN105751199A/en
Application granted granted Critical
Publication of CN105751199B publication Critical patent/CN105751199B/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J5/00Manipulators mounted on wheels or on carriages
    • B25J5/007Manipulators mounted on wheels or on carriages mounted on wheels
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/02Sensing devices
    • B25J19/04Viewing devices
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/0009Constructional details, e.g. manipulator supports, bases
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/10Programme-controlled manipulators characterised by positioning means for manipulator elements
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1602Programme controls characterised by the control system, structure, architecture

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Manipulator (AREA)

Abstract

The invention discloses a kind of method of operating of all-hydraulic autonomous mechanical arm, belong to mechanical arm technical field.All-hydraulic autonomous mechanical arm includes omni-directional moving platform, and double mechanical arms, dynamical system, vision system and perception and control system are provided on omni-directional moving platform, wherein:Revolution waist device is provided on omni-directional moving platform, double mechanical arms are arranged on by turning round waist device on omni-directional moving platform, and double mechanical arms are with multivariant apery arm structure;Dynamical system uses engine hydraulic drive pattern;Vision system includes navigation camera, big visual field servo camera and trick camera;Perceive includes joint force snesor, joint position sensor and six-dimension force sensor with control system, and the present invention disclosure satisfy that large-mass workpiece moves the demand of operation on a large scale.

Description

The method of operating of all-hydraulic autonomous mechanical arm
Technical field
The present invention relates to mechanical arm technical fields, particularly relate to a kind of method of operating of all-hydraulic autonomous mechanical arm.
Background technology
Past 30 Years, China's manufacturing industry obtain fast-developing and rapid progress under inexpensive labor advantage, become Manufacture big country of the world.But into since 10 years 21 centuries second, labor cost steeply rises, and is with after 80s, after 90s The interest that main workforce population works to the industry for being engaged in dull repetition, working environment difference is decreased obviously, and manufacturing industry is with machine People substitutes artificial demand and is continuously available excitation.
Mobile mechanical arm has huge market potential, and by taking Tire production industry as an example, China's tire yield accounts for the whole world 50%, but vulcanize the work such as the transport of tire base in production technology, storage storage and finished tire selection on the conveyor line also It needing to be accomplished manually, the flexible installing on tire base to vulcanizer is also largely by manually, and not only labor intensity is big, but also in workshop Sulfide staining is serious, and very big harm is caused to the occupational health of worker, and tire enterprise is caused recruitment famine, enterprise pair largely occur The demand of mobile mechanical arm is at 3000 or so, and market capacity is at 5,000,000,000 yuan or so;Mechanical processing (clamping of forging forges, The clamping welding of weldment, assembling, selection, transport of big quality parts etc.), large size dangerous material and ammunition operation, engineering and city Also there is hydraulic-driven mobile mechanical arm in political affairs construction and other industries enterprise wilderness demand, and the overall market capacity is at 20,000,000,000 yuan or more.
The characteristics of heavy load autonomous mechanical arm of hydraulic-driven combines mobile robot platform and mechanical arm, simultaneously With autonomous and operating function, mechanical arm is made to have the motion redundancy of height and the working space of bigger, it can be more Task in the short time with the completion of more preferably pose in larger scope, the form that can move operation are widely used in the dress of workpiece Match somebody with somebody, choose, carry, press forging forges clamping and carrying, and automating, being high for production process is realized in the clamping welding of weldment Effectization, the work big instead of being accomplished manually bad environments, labor intensity are provided with for horizontal the significantly improving of worker's occupational health It tries hard to keep barrier.
Therefore, the assembling for relatively large workpiece, press forging forge clamping and carrying, the clamping of weldment welding, have Necessity develops a kind of method of operating for the all-hydraulic autonomous mechanical arm that disclosure satisfy that the demand.
The content of the invention
The present invention provides a kind of all-hydraulic autonomous machine that disclosure satisfy that large-mass workpiece and move job requirements on a large scale The method of operating of tool arm.
In order to solve the above technical problems, present invention offer technical solution is as follows:
A kind of all-hydraulic autonomous mechanical arm, including omni-directional moving platform, is set on the omni-directional moving platform There are double mechanical arms, dynamical system, vision system and perception and control system, wherein:
Revolution waist device is provided on the omni-directional moving platform, the double mechanical arms are filled by the revolution waist It puts and is arranged on the omni-directional moving platform, the double mechanical arms are with multivariant apery arm structure;
The dynamical system uses engine-hydraulic-driven pattern;
The vision system includes navigation camera, big visual field servo camera and trick camera;
The perception includes joint force snesor, joint position sensor and six-dimension force sensor with control system, described Joint force snesor and joint position sensor are arranged on each joint of the double mechanical arms, and the six-dimension force sensor is set In the end of every mechanical arm of the double mechanical arms.
Further, every mechanical arm of the double mechanical arms has 6 rotary joints, and each rotary joint is oily by swinging Cylinder or fluid motor-driven, the revolution waist device is by fluid motor-driven;All hydraulic motor uses electrohydraulic servo valve Control.
Further, the navigation camera is 2 colored monoculars navigation cameras, is separately positioned on the all-around mobile and puts down The rear and front end of platform, the big visual field servo camera are arranged on the top of the revolution waist device, and the trick camera is 2 Color solid trick camera is separately positioned on the end of every mechanical arm of the double mechanical arms.
Further, the dynamical system uses the airborne engine using combustion gas as the energy to provide power, described comprehensive Mobile platform is equipped with to detect using the hydraulic pressure driving wheel built in suspension-driving, the surrounding of the omni-directional moving platform The ultrasonic sensor and wide angle camera of barrier.
Further, the perception further includes to detect posture, the angle of the omni-directional moving platform with control system It the vertical gyroscope component of speed and acceleration and is passed for detecting the wheel speed of the vehicle wheel rotational speed of the omni-directional moving platform Sensor.
Further, the band of the controller of the double mechanical arms is wider than the band of the controller of the omni-directional moving platform It is wide.
A kind of method of operating of all-hydraulic autonomous mechanical arm, the all-hydraulic autonomous mechanical arm have first to move Operation mode, the omni-directional moving platform movement, the double mechanical arms are static under first pattern, and described first is dynamic The corresponding method of operating of operation mode includes:
Step (1):The path tracked is planned using nonholonomic constraint condition;
Step (2):According to the path that the step (1) is planned, the motor pattern of the omni-directional moving platform, institute are set Stating motor pattern includes Ackerman steerings, double Ackerman steerings or wheel motor pattern in the same direction;
Step (3):Measure the course, position and velocity deviation of the omni-directional moving platform;
Step (4):Based on incomplete omni-directional moving platform kinematics model, calculated using Auto-disturbance-rejection Control described in Corner and spin rate control quantity needed for omni-directional moving platform;
Step (5):The bottom control of the corner and rotating speed of the omni-directional moving platform is realized using Auto-disturbance-rejection Control System.
A kind of method of operating of all-hydraulic autonomous mechanical arm, the all-hydraulic autonomous mechanical arm also have second Pattern, the omni-directional moving platform is static under second pattern, double mechanical arms movement, and described second The corresponding method of operating of pattern includes:
Step (1):The navigation camera guides the omni-directional moving platform so that pose to be specified to enter operation station, and makes Dynamic, locking;
Step (2):The big visual field servo camera search workpiece, guides the double mechanical arms convergence workpiece;
Step (3):When the end of the double mechanical arms reaches near workpieces certain distance, workpiece enters the trick camera Field range in when, perform step (4), otherwise perform the step (2);
Step (4):The double mechanical arms are under the monitoring of the big visual field servo camera, and drawing in the trick camera It leads and performs job task under the control of Visual servoing control device, if workpiece departs from the field range of the trick camera, The step (2) is performed, the double mechanical arms are led back near workpieces again.
Further, coordinate of the origin at the barycenter of the omni-directional moving platform, parallel with world coordinate system is selected Be to freeze world coordinate system as the double mechanical arms and the big visual field servo camera, this freeze world coordinate system with it is described Omni-directional moving platform moves together.
A kind of method of operating of all-hydraulic autonomous mechanical arm, the all-hydraulic autonomous mechanical arm also have the 3rd Pattern, the omni-directional moving platform movement, double mechanical arms movement under the 3rd pattern, the described 3rd The corresponding method of operating of pattern includes:
Step (1):The navigation camera guides the omni-directional moving platform to be moved near Path of Moving Object;
Step (2):The big visual field servo camera search, the appearance of monitoring moving target, moving target once occur, institute It states big visual field servo camera moving target is identified, if moving target is target to be captured, estimates moving target phase To the distance of the omni-directional moving platform, otherwise continue search for;
Step (3):The position of moving target to be captured is supplied to the control system of the double-movement mechanical arm, is utilized The big visual field servo camera guides the omni-directional moving platform to be moved to moving target to be captured, while controls described double Mobile mechanical arm is moved towards moving target to be captured, until moving target to be captured is completely in the double mechanical arms When in task space and having certain allowance, control the omni-directional moving platform synchronous with moving target to be captured;
Step (4):The big visual field servo camera guides the end convergence of double mechanical arms moving target to be captured, Until moving target to be captured is in the visual field of the trick camera;
Step (5):Under the monitoring of the big visual field servo camera, the double mechanical arms are guided using the trick camera Workpiece is captured.
The invention has the advantages that:
Compared with prior art, all-hydraulic autonomous mechanical arm of the invention, since double mechanical arms are by turning round waist Device is arranged on omni-directional moving platform, and double mechanical arms have multivariant apery arm structure, can complete " to return Turn ", " pitching ", " roll ", the actions such as " crawl ", can preferably adapt to move the needs of operation;Vision system is distinctive to lead Navigate camera, big visual field servo camera and trick camera, is the accurate navigation of omni-directional moving platform and accurate installation, the essence of target Standard judges and crawl provides guarantee;Dynamical system uses the pattern of engine-hydraulic-driven, meets double mechanical arms and carries out greatly The requirement of mass workpiece assembling, moving-target crawl job task to high power density energy and high dynamic response ability;Perceive with Control system includes joint force snesor, joint position sensor and six-dimension force sensor so that double mechanical arms possess power control Ability realizes flexible assembly function.To sum up, the present invention disclosure satisfy that large-mass workpiece moves the demand of operation on a large scale, fill out The blank of the automation of production process in Tire production industry has been mended, has been provided for horizontal the significantly improving of worker's occupational health strong It ensures, brings huge market value.
Description of the drawings
Fig. 1 is the overall structure diagram of the all-hydraulic autonomous mechanical arm of the present invention;
Fig. 2 is the structure diagram of the double mechanical arms of the all-hydraulic autonomous mechanical arm of the present invention;
Fig. 3 is that the double mechanical arms of the all-hydraulic autonomous mechanical arm of the present invention move the signal of closed-loop control handoff procedure Figure.
Specific embodiment
To make the technical problem to be solved in the present invention, technical solution and advantage clearer, below in conjunction with attached drawing and tool Body embodiment is described in detail.
On the one hand, the present invention provides a kind of all-hydraulic autonomous mechanical arm, as shown in Figure 1 to Figure 2, including comprehensive shifting Moving platform 1 is provided with double mechanical arms 2, dynamical system, vision system on omni-directional moving platform 1 and perceives and be with control System, wherein:
Revolution waist device 11 is provided on omni-directional moving platform 1, double mechanical arms 2 set 11 by turning round waist device On omni-directional moving platform 1, double mechanical arms 2 are with multivariant apery arm structure;
Dynamical system uses engine-hydraulic-driven pattern;
Vision system includes navigation camera 31, big visual field servo camera 32 and trick camera 33;
Perceive includes joint force snesor, joint position sensor and six-dimension force sensor 41, joint power with control system Sensor and joint position sensor are arranged on each joint of double mechanical arms 2, and six-dimension force sensor 41 is arranged on double mechanical arms 2 Every mechanical arm end.
During specific design, double mechanical arms configuration is designed with its load capacity, working space, control accuracy and operating rate etc. Performance indicator, using big rigidity, lightweight as Main Design Principles;Use quality is light in material selection, the high hard aluminium processed of rigidity Material;It in structure design, is connected using thin board type structure, long cylinder uses the flanged type mechanism of light wall pipe, while is ensureing double mechanical arms On the premise of rigidity, increase lightening hole at connector, in addition encoder is connected to the outer end of babinet, this connection mode is significantly Reduce the length and radius needed for babinet, so as to alleviate joint weight, reduce the moment of inertia in entire joint;Optimization design On, on the basis of CAD modelings using ANSYS analysis softwares the rigidity of double mechanical arms and lightweight are done it is further check with it is excellent Change, so that it is determined that each joint meets the minimum thickness of connecting plate on the premise of rigidity requirement, and using Topology Optimization Method Lightweight topological structure is obtained, processing technology is considered, chooses optimal designing scheme.
The present invention all-hydraulic autonomous mechanical arm, due to double mechanical arms by turn round waist device be arranged on it is comprehensive On mobile platform, and double mechanical arms have multivariant apery arm structure, can complete " turn round ", " pitching ", " horizontal stroke The actions such as rolling ", " crawl " can preferably adapt to the needs of mobile operation;The distinctive navigation camera of vision system, big visual field are watched Camera and trick camera are taken, is that the accurate of omni-directional moving platform is navigated and accurate installation, the accurate judgement and crawl of target carry It has supplied to ensure;Dynamical system uses the pattern of engine-hydraulic-driven, meet double mechanical arms carry out large-mass workpiece assembling, Moving-target captures requirement of the job task to high power density energy and high dynamic response ability;Perceive includes closing with control system Save force snesor, joint position sensor and six-dimension force sensor so that double mechanical arms possess power control ability, utilize six-dimensional force The reaction force of workpiece when sensor detects flexible assembly operation realizes mechanical arm Shared control and provides support.To sum up, this hair The bright demand that disclosure satisfy that large-mass workpiece and move operation on a large scale, has filled up the automation of production process in Tire production industry Blank provides powerful guarantee for horizontal the significantly improving of worker's occupational health, brings huge market value.
As a modification of the present invention, as shown in Figure 1 to Figure 2, every mechanical arm of double mechanical arms 2 can have 6 Rotary joint, each rotary joint can be driven by oscillating oil cylinder or fluid motor-driven, revolution waist device 11 by hydraulic motor It is dynamic;All hydraulic motor is preferably controlled using electrohydraulic servo valve.This structure meets hydraulic power system to cruising time With the requirement of big driving power.Large-mass workpiece assembling is carried out to meet double mechanical arms, moving-target captures job task to Gao Gong The requirement of rate density energy and high dynamic response ability, dynamical system use engine-hydraulic-driven pattern, and system shares 27 Hydraulic actuator, 1 Active suspension hydraulic cylinder and 1 steering oscillating oil cylinder, 6 rotary joints of each mechanical arm are equal There are oscillating oil cylinder or fluid motor-driven, the rotary motion of two mechanical arms is by 1 fluid motor-driven.To ensure the height of system Dynamic, whole hydraulic actuators are controlled using electrohydraulic servo valve.To meet hydraulic power system to cruising time and big drive The requirement of dynamic power, hydraulic system provide power by 1 airborne engine;Low emission is wanted to meet indoor work long hours It asks, engine forms gas engine-hydraulic power system using combustion gas as the energy.
In order to ensure to navigate, camera 31 realizes accurate navigation during navigation, is provided substantially for Visual servoing control Information, the functions such as the quick positioning of realization double mechanical arms 2, the quick identification of workpiece, the autonomous positioning of moving-target and crawl, preferably , navigation camera 31 is 2 colored monoculars navigation cameras, is separately positioned on the rear and front end of omni-directional moving platform 1, big visual field Servo camera 32 is arranged on the top of revolution waist device 11, and trick camera 33 is 2 color solid trick cameras, is set respectively In the end of every mechanical arm of double mechanical arms 2.Specifically, the versatility from platform and the high adaptability to environment consider, For priming platform navigation based on vision guided navigation, platform front and rear respectively installs 1 colored monocular navigation camera;Double mechanical arms are made Industry uses Visual servoing control scheme, and 1 big visual field servo stereoscopic camera is configured above double mechanical arms waist, which passes through Pitching and orientation two-dimensional pan-tilt and revolution axis connection, can be synchronized with the movement with waist, also can asynchronous movement, for static workpiece, The coarse positioning of moving-target and the guiding to double mechanical arms movement;The colour of 1 narrow visual field is respectively arranged in the end of two mechanical arms Three-dimensional trick camera, for workpiece and moving target identification, be accurately positioned and the accurate control of double-manipulator.2 navigation The trick camera of camera, 1 big visual field servo camera and 2 narrow scene provides essential information for Visual servoing control jointly, real The functions such as the now quick positioning of double mechanical arms, the quick identification of workpiece, the autonomous positioning of moving-target and crawl;In mobile platform Left and right side respectively installs the big visual field camera of 1 low cost additional, and forms security protection vision system with forward and backward navigation camera.
Another as the present invention improves, and it is dynamic that dynamical system preferably uses the airborne engine using combustion gas as the energy to provide Power can so meet the indoor requirement to work long hours to low emission, and engine forms combustion gas and start using combustion gas as the energy Machine-hydraulic power system;In order to ensure the present invention can all-around mobile and with high load capability, omni-directional moving platform is adopted With rubber belt track chassis, built-in differential steering gear, crawler bearing area is big, has damping effect.For comprehensive detection Barrier around omni-directional moving platform, the surrounding of omni-directional moving platform can be equipped with to detect the ultrasound of barrier Wave sensor and wide angle camera, wide angle camera can monitor the barrier that ultrasonic sensor can not perceive.Specifically, meeting Reducing distortion as far as possible while moving damping, by the uncontrollability of platform stance and height change control to minimum.Continuous work Engine, hydraulic pump can form high temperature heat source, be arranged in the piggyback pod of platform one end, and pass through thermal insulation board and platform Other parts isolation, influence of the control heat radiation to other devices;Wheelspan, wheelbase, Mass Distribution and wheel system characteristic (are driven Dynamic, suspension, turn to and tire characteristics) etc. key parameters optimization and mobile mechanical arm global optimization carry out together.Continuous work Engine, hydraulic pump can form high temperature heat source, be arranged in the piggyback pod of platform one end, and pass through thermal insulation board and platform Other parts isolation, influence of the control heat radiation to other devices;Wheelspan, wheelbase, Mass Distribution and wheel system characteristic (are driven Dynamic, suspension, turn to and tire characteristics) etc. the optimization of key parameters move global optimization with double mechanical arms and carry out together.
In the present invention, perception can also include the posture, the angular speed that detect omni-directional moving platform 1 with control system It is passed with the vertical gyroscope component (not shown) of acceleration and for detecting the wheel speed of the vehicle wheel rotational speed of omni-directional moving platform Sensor (not shown).It so may insure the all-around mobile and high load capability of omni-directional moving platform so that comprehensive shifting Moving platform being capable of safe operation.To realize flexible assembly function, double mechanical arms should possess power control ability.For this purpose, except in two-shipper It is respectively mounted on each joint of tool arm outside 1 joint position sensor, also in the respectively installation 1 general six of the end of 2 mechanical arms Dimensional force sensor is respectively mounted 1 joint force snesor on each joint of mechanical arm.Meanwhile pacify on omni-directional moving platform Attitude transducer is filled, simplifies the complexity of double mechanical arms system control.Mechanical arm-movement of servo is felt using view-based access control model and power Platform total tune method realizes that the coordination of mobile mechanical arm and Shared control, control system architecture are used with hierarchical For the hybrid architecture of core, hardware architecture uses bus type distributed architecture, and the architecture is by organizational planning, association The servo tertiary structure that reconciles forms, and is a kind of multilevel distributed structure on the whole.Wherein, " mobile mechanical arm posture and state " by Sensor is obtained with sensory perceptual system;" stability monitoring " carries out static system, dynamic stability according to specific stability criterion Judge, when unstable trend occurs in the system of discovery, stop job task in progress by " task scheduling ", start " steady Determine emergency controller " carry out stability contorting;" security protection monitoring " is to other safety in addition to mobile double mechanical arms stability Problem is monitored, abnormal including collision, foreign matter intrusion, engine temperature rise, hydraulic oil output pressure/loine pressure extremely Reduce or raise etc..
Due to when moving double mechanical arms, there is very strong nonlinear Dynamic Coupling between double mechanical arms and mobile platform Effect, so the bandwidth of the controller of double mechanical arms is preferably greater than the bandwidth of the controller of omni-directional moving platform.It is so mobile Influence of the platform to double mechanical arms is serious more than influence of the double mechanical arms to mobile platform, can be by mobile platform to double mechanical arms Influence be minimized, the decoupling control between mobile platform and double mechanical arms is realized with this.
The present invention builds distributed computer control system, using built-in industrial control machine as master using CAN bus structure Controller realizes the functions such as task scheduling, control targe planning and the stability monitoring of organizational planning's grade, using DSP or list Piece machine is realized as distributed director and coordinates mass motion coordination control strategy in grade, whole Shared control strategy, stablizes and answer The generation of anxious control strategy etc., and realize the tasks such as generation of each SERVO CONTROL reference locus and control strategy in servo grade.
It exemplified by the specific course of work, introduces the present invention in Tire production industry by all-hydraulic autonomous mechanical arm and implements Control method under several movements and work pattern of example.
A. mobile platform moves, and mechanical arm static (PM-MS, Platform Move-Manipulator Stop) is mainly used In workpiece transport, sometimes also using the pattern when mechanical arm just positions, carrying out motion control to mobile platform in this mode is It can.
B. mobile platform is static, and manipulator motion (PS-MM, Platform Stop-Manipulator Move) is mainly used In the positioning and crawl of target, the submissive assembling of workpiece, which needs to implement Single Mechanical arm, double mechanical arms and mobile platform Motion control and Shared control.
C. mobile platform moves, and manipulator motion (PM-MM, Platform Move-Manipulator Move) is mainly used In the positioning and crawl of moving-target, which needs to carry out mass motion control and Shared control to mobile platform and mechanical arm.
1. the motion control method of mobile platform under PM-MS patterns
The omni-directional moving platform highest movement speed 3m/s that the present invention develops belongs to low-speed motion, therefore need not consider to take turns The motion control that kinematics model carries out omni-directional moving platform can be used directly in the dynamics of tire.
The path following control problem participated in for no mechanical arm:
A. the path tracked is planned using nonholonomic constraint condition;
B. the path planned according to step (1), sets the motor pattern of omni-directional moving platform, and motor pattern includes Ackerman is turned to, double Ackerman are turned to or wheel motor pattern in the same direction;
C. the course, position and velocity deviation of the omni-directional moving platform are measured;
D. based on incomplete omni-directional moving platform kinematics model, calculated using Auto-disturbance-rejection Control described comprehensive Corner and spin rate control quantity needed for mobile platform;
E. the corner of the omni-directional moving platform and the bottom control of rotating speed are realized using Auto-disturbance-rejection Control.
When limited working space, use pattern dispatching method carries out motor pattern switching control, makes mobile platform from one Kind pattern, such as keeps straight on, is switched to another pattern, such as traversing, diagonal, pivot stud, wherein, traversing, pivot stud pattern Mutual conversion between other motor patterns needs mobile platform to be carried out again after stopping, i.e., " stop-go ".
2. mechanical arm controls under PS-MM patterns
A. visual servo scheme
The all-hydraulic autonomous mechanical arm that the present invention develops need not configure overall Vision camera, in the case, installation Big visual field servo camera above waist is used as half global SERVO CONTROL of mechanical arm, be the preliminary identification of workpiece, positioning and The quick guiding of mechanical arm provides visual feedback information, forms location-based Visual servoing control system;Mounted on manipulator The trick camera of end forms the vision based on image and watches for accurate identification, positioning and the accurate guiding of mechanical arm of workpiece Take control system.
B. the manipulator motion control (PS-MM patterns) of view-based access control model closed loop
B.1 the manipulator motion control of view-based access control model closed loop is removed using mechanical other-mobile platform whole control scheme Outside 8 (single armeds) of mechanical arm or 15 (both arms) joint actuators, 4 independent suspension actuators of 4 wheels also remaining machine The motion control of tool arm;
B.2 in servo camera coordinates system, characteristics of image can implicitly include target speed information, therefore the control program Both mechanical arm convergence can control to fix target, and also can control mechanical arm convergence moving-target;
B.3 coordinate system of the origin at mobile platform barycenter, parallel with world coordinate system is selected to regard as mechanical arm and greatly " freezing " world coordinate system of field servo camera, the coordinate system are moved together with platform;
B.4 big visual field servo camera, trick camera vision system calibration and usage " vision guided navigation, target identification with it is autonomous The method provided in alignment system ", image jacobian matrix are estimated using the on-line identification method based on Kalman filter;
B.5 image-Visual servoing control device and image-Position Servo use sliding moding structure or Active Disturbance Rejection Control Method designs, and so can effectively overcome image jacobian matrix evaluated error, tire micro-strain, joint-friction power, unknown The uncertainty and the influence of Unmarried pregnancy that load etc. is brought, and gravity, coriolis force etc. are compensated, position-vision is watched Controller is taken also to design using sliding moding structure or Auto-disturbance-rejection Control.
B.6 manipulator motion closed-loop control handoff procedure
As shown in figure 3, (1) navigation camera guiding omni-directional moving platform enters operation station with specified pose, and brake, Locking;
(2) big visual field servo camera search workpiece, guides double mechanical arms convergence workpiece;
(3) when the end of double mechanical arms reaches near workpieces certain distance, workpiece enters in the field range of trick camera When, step (4) is performed, otherwise performs the step (2);
(4) double mechanical arms are under the monitoring of the big visual field servo camera, and the guiding in trick camera and visual servo Job task is performed under the control of controller, if workpiece departs from the field range of the trick camera, performs step (2), Double mechanical arms are led back near workpieces again.
C. single armed Shared control
Single armed Shared control is sextuple using big visual field servo camera or the location information of trick camera feedback, arm end The operation force information of force snesor feedback feels mixing servo control scheme using vision/power, and controlled quentity controlled variable elects joint velocity or pass as Power/torque is saved, control method selects Auto-disturbance-rejection Control.
D. both arms Shared control
Intend using following strategy for redundancy, which includes two parts:Position co-ordination controls and power coordinates control.Position Control method for coordinating is put by introducing the position co-ordination factor, realizes control, the Joint motion impedance of operation object movement locus error Control and both arms between relative error control;The characteristics of power is coordinated mainly in combination with coordinated manipulation introduces power coordinating factor, builds The dynamically distributes mechanism of vertical both arms clamp load realizes the coordination control of the size of operation object internal stress.
Redundancy dual robot coordination controls the specific implementation process to be:Operation object crawl is established using object kinetics equation is operated Model obtains the preliminary distribution of both arms clamp load and desired movement locus according to crawl model and coordination constraint relation; Then according to the characteristics of coordinated manipulation, the position co-ordination control based on space spring damping parallel model is established;It is finally introducing change Weighting matrix carries out dynamically distributes to load, makes operation object internal stress and the gross energy of driving minimum, final redundancy double-mechanical Arm control method for coordinating.
3. mobile platform-mechanical arm integrally controls under PM-MM patterns
The technology path also describes the Visual servoing control solution party of " moving-target autonomous positioning and crawl " key technology Case.
A. moving-target autonomous positioning and crawl Visual servoing control scheme
A.1 mobile platform servo is navigated.Guidance path as being provided with artificial target in working environment uses navigation camera Mobile platform navigation is calculated as with mileage, if without the guidance path of artificial target, uses the big visual field for tracking moving-target Servo camera or trick camera are mobile platform navigation, realize that mobile platform moves the synchronized tracking of moving-target.
A.2 moving-target search, identification.Moving-target is searched for using big visual field servo camera and is tentatively identified, uses hand Eye camera accurately identifies moving-target;Using big visual field servo camera mechanical arm is guided to use trick to moving-target attachment Camera accurately guides mechanical arm, and visual servo is provided for the crawl of moving-target.
B. the mobile mechanical arm motion control (PS-MM patterns) of view-based access control model closed loop
B.1 control program requirement trick camera is operated under location-based servo pattern, is realized to moving-target pose Identification, the accurate guiding to gripping tool, and moving-target in " freezing " reference frame is positioned, calculated mobile flat The distance between platform and moving-target, guiding mobile platform tracking moving-target are synchronized with the movement.
B.2 except 8 (single armeds) of mechanical arm or 15 (both arms) joint actuators, 4 independent suspensions of 4 wheels perform Outside device, the 8 driving actuators and steering actuator of 4 wheels also assist in control;
B.3 vision Close loop servo control process
(1) according to information such as environmental map, handmarkings, guided by mobile platform navigation camera and guide mobile mechanical arm To near moving-target motion path (such as conveyer belt);
(2) big visual field servo camera search, the appearance of monitoring moving target, moving target once occur, big visual field servo Moving target is identified in camera, if moving target is target to be captured, estimates moving target with respect to all-around mobile The distance of platform, otherwise continues search for;
(3) position of moving target to be captured is supplied to the control system of double-movement mechanical arm, is watched using big visual field It takes camera guiding omni-directional moving platform to move to moving target to be captured, while double-movement mechanical arm direction is controlled to wait to capture Moving target movement, until moving target to be captured is completely in the task spaces of double mechanical arms and has certain allowance When, control omni-directional moving platform is synchronous with moving target to be captured;
(4) the end convergence of big visual field servo camera guiding double mechanical arms moving target to be captured, until to be captured Moving target is in the visual field of trick camera;
(5) under the monitoring of big visual field servo camera, workpiece is captured using trick camera guiding double mechanical arms.
C. mechanical arm-mobile platform Dynamic Coupling effect decoupling control
There is very strong nonlinear Dynamic Coupling when mobile mechanical arm moves, between mechanical arm and mobile platform to make With, but since the bandwidth of double mechanical arms is than the bandwidth bigger of mobile platform, influence of the mobile platform to mechanical arm is more than mechanical arm Influence to mobile platform is serious.For this purpose, the present invention one " fast " (high bandwidth) controller of design controls manipulator motion System, one " slow " (low bandwidth) controller of design control mobile platform, and influence of the mobile platform to double mechanical arms is dropped To minimum, decoupling control between the two is realized with this.
To sum up, the invention has the advantages that:
1st, the double mechanical arms of all-hydraulic autonomous mechanical arm have the apery arm structure of 15 degree of freedom, can complete The actions such as " revolution ", " pitching ", " roll ", " crawl " preferably adapt to the needs of operation.
2nd, the distinctive trick camera of all-hydraulic autonomous mechanical arm, navigation camera and big visual field servo camera are platform Accurate navigation and accurate installation provide guarantee.
3rd, series of processes in the completion Tire production production process that all-hydraulic autonomous mechanical arm can be entirely autonomous, Operational safety, installation is accurate, efficient work.
4th, the control of all-hydraulic autonomous mechanical arm is realized, has filled up the automation of production process in Tire production industry In blank, provided a strong guarantee for horizontal the significantly improving of worker's occupational health, bring huge market value.
The above is the preferred embodiment of the present invention, it is noted that for those skilled in the art For, without departing from the principles of the present invention, several improvements and modifications can also be made, these improvements and modifications It should be regarded as protection scope of the present invention.

Claims (9)

1. a kind of method of operating of all-hydraulic autonomous mechanical arm, the all-hydraulic autonomous mechanical arm includes comprehensive shifting Moving platform is provided with double mechanical arms, dynamical system, vision system on the omni-directional moving platform and perceives and be with control System, wherein:
Revolution waist device is provided on the omni-directional moving platform, the double mechanical arms are set by the revolution waist device It puts on the omni-directional moving platform, the double mechanical arms are with multivariant apery arm structure;
The dynamical system uses engine-hydraulic-driven pattern;
The vision system includes navigation camera, big visual field servo camera and trick camera;
The perception includes joint force snesor, joint position sensor and six-dimension force sensor, the joint with control system Force snesor and joint position sensor are arranged on each joint of the double mechanical arms, and the six-dimension force sensor is arranged on institute State the end of every mechanical arm of double mechanical arms;It is characterized in that:
The all-hydraulic autonomous mechanical arm has the 3rd pattern, the comprehensive shifting under the 3rd pattern Moving platform movement, double mechanical arms movement, the corresponding method of operating of the 3rd pattern include:
Step (1):The navigation camera guides the omni-directional moving platform to be moved near Path of Moving Object;
Step (2):Once the big visual field servo camera search, the appearance of monitoring moving target, moving target are described big appearance Moving target is identified in visual field servo camera, if moving target is target to be captured, estimates moving target with respect to institute The distance of omni-directional moving platform is stated, is otherwise continued search for;
Step (3):The position of moving target to be captured is supplied to the control system of the double mechanical arms, is regarded greatly using described Field servo camera guides the omni-directional moving platform to be moved to moving target to be captured, while controls the double mechanical arms court It is moved to moving target to be captured, until moving target to be captured is completely in the task space of the double mechanical arms simultaneously When having certain allowance, control the omni-directional moving platform synchronous with moving target to be captured;
Step (4):The big visual field servo camera guides the end convergence of double mechanical arms moving target to be captured, until Moving target to be captured is in the visual field of the trick camera;
Step (5):Under the monitoring of the big visual field servo camera, the double mechanical arms are guided to work using the trick camera Part is captured.
2. the method for operating of all-hydraulic autonomous mechanical arm according to claim 1, which is characterized in that the double-mechanical Every mechanical arm of arm has 6 rotary joints, and each rotary joint is by oscillating oil cylinder or fluid motor-driven, the revolution waist Body device is by fluid motor-driven;All hydraulic motor is controlled using electrohydraulic servo valve.
3. the method for operating of all-hydraulic autonomous mechanical arm according to claim 2, which is characterized in that the navigation phase Machine is 2 colored monoculars navigation cameras, is separately positioned on the rear and front end of the omni-directional moving platform, the big visual field servo Camera is arranged on the top of the revolution waist device, and the trick camera is 2 color solid trick cameras, is separately positioned on The end of every mechanical arm of the double mechanical arms.
4. the method for operating of all-hydraulic autonomous mechanical arm according to claim 2, which is characterized in that the dynamical system is adopted Power is provided for the airborne engine of the energy to combustion gas, the surrounding of the omni-directional moving platform is equipped with to detect obstacle The ultrasonic sensor and wide angle camera of object.
5. the method for operating of all-hydraulic autonomous mechanical arm according to claim 2, which is characterized in that it is described perception with Control system further includes to detect the vertical gyroscope group of the posture of the omni-directional moving platform, angular speed and acceleration Part and the wheel speed sensors for detecting the vehicle wheel rotational speed of the omni-directional moving platform.
6. according to the method for operating of any all-hydraulic autonomous mechanical arm in claim 1 to 5, which is characterized in that The band of the controller of the double mechanical arms is wider than the bandwidth of the controller of the omni-directional moving platform.
7. the method for operating of all-hydraulic autonomous mechanical arm described in claim 1, which is characterized in that described all-hydraulic autonomous Mobile mechanical arm also has the second pattern, and the omni-directional moving platform is static, described under second pattern Double mechanical arms move, and the corresponding method of operating of second pattern includes:
Step (1):The navigation camera guides the omni-directional moving platform so that pose to be specified to enter operation station, and brake, Locking;
Step (2):The big visual field servo camera search workpiece, guides the double mechanical arms convergence workpiece;
Step (3):When the end of the double mechanical arms reaches near workpieces certain distance, workpiece is regarded into the trick camera When in the range of, step (4) is performed, otherwise performs the step (2);
Step (4):The double mechanical arms under the monitoring of the big visual field servo camera, and the trick camera guiding and Job task is performed under the control of Visual servoing control device, if workpiece departs from the field range of the trick camera, is performed The double mechanical arms are led back near workpieces by the step (2) again.
8. the method for operating of all-hydraulic autonomous mechanical arm according to claim 7, which is characterized in that selected origin exists Coordinate system at the barycenter of the omni-directional moving platform, parallel with world coordinate system is as the double mechanical arms and described regards greatly Field servo camera freezes world coordinate system, this freezes world coordinate system and is moved together with the omni-directional moving platform.
9. the method for operating of the all-hydraulic autonomous mechanical arm described in claim 2, which is characterized in that described all-hydraulic autonomous Mobile mechanical arm also has the first pattern, and the omni-directional moving platform moves, is described under first pattern Double mechanical arms are static, and the corresponding method of operating of first pattern includes:
Step (1):The path tracked is planned using nonholonomic constraint condition;
Step (2):According to the path that the step (1) is planned, the motor pattern of the omni-directional moving platform, the fortune are set Dynamic model formula includes Ackerman steerings, double Ackerman are turned to or wheel motor pattern in the same direction;
Step (3):Measure the course, position and velocity deviation of the omni-directional moving platform;
Step (4):Based on incomplete omni-directional moving platform kinematics model, institute is calculated using Active Disturbance Rejection Control (ADRC) method State the corner and spin rate control quantity needed for omni-directional moving platform;
Step (5):The corner of the omni-directional moving platform and the bottom control of rotating speed are realized using Auto-disturbance-rejection Control.
CN201610236245.3A 2014-12-05 2014-12-05 The method of operating of all-hydraulic autonomous mechanical arm Expired - Fee Related CN105751199B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610236245.3A CN105751199B (en) 2014-12-05 2014-12-05 The method of operating of all-hydraulic autonomous mechanical arm

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN201610236245.3A CN105751199B (en) 2014-12-05 2014-12-05 The method of operating of all-hydraulic autonomous mechanical arm
CN201410739963.3A CN104476550B (en) 2014-12-05 2014-12-05 The method of operating of all-hydraulic autonomous mechanical arm

Related Parent Applications (1)

Application Number Title Priority Date Filing Date
CN201410739963.3A Division CN104476550B (en) 2014-12-05 2014-12-05 The method of operating of all-hydraulic autonomous mechanical arm

Publications (2)

Publication Number Publication Date
CN105751199A CN105751199A (en) 2016-07-13
CN105751199B true CN105751199B (en) 2018-05-22

Family

ID=56335157

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610236245.3A Expired - Fee Related CN105751199B (en) 2014-12-05 2014-12-05 The method of operating of all-hydraulic autonomous mechanical arm

Country Status (1)

Country Link
CN (1) CN105751199B (en)

Families Citing this family (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105751200B (en) * 2014-12-05 2017-10-20 济南鲁智电子科技有限公司 The method of operating of all-hydraulic autonomous mechanical arm
JP6789728B2 (en) * 2016-08-31 2020-11-25 川崎重工業株式会社 Robot and its driving method
CN106272329A (en) * 2016-08-31 2017-01-04 无锡信欧光电科技有限公司 A kind of Intelligent light electromechanics Robot
CN109202888A (en) * 2017-06-30 2019-01-15 沈阳新松机器人自动化股份有限公司 A kind of both arms medical treatment auxiliary robot Design of Software Platform method and system
CN108399639B (en) * 2018-02-12 2021-01-26 杭州蓝芯科技有限公司 Rapid automatic grabbing and placing method based on deep learning
CN109591014B (en) * 2018-12-18 2020-06-23 武汉科技大学 Double-arm coordinated carrying method of double-arm coordinated robot
CN110451150A (en) * 2019-08-28 2019-11-15 成都侠客颂科技有限公司 It a kind of automated storage and retrieval system and its gets in stocks and picking working method
CN111688526B (en) * 2020-06-18 2021-07-20 福建百城新能源科技有限公司 User side new energy automobile energy storage charging station
CN113910234B (en) * 2021-10-27 2022-10-14 因格(苏州)智能技术有限公司 Double-manipulator control method and storage medium
CN114872050B (en) * 2022-06-01 2024-05-07 清华大学深圳国际研究生院 Control method and control system for double-arm crawler-type mobile operation robot

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0218139A1 (en) * 1985-09-20 1987-04-15 Kabushiki Kaisha Meidensha Manipulator shoulder mechanism
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
CN102124866A (en) * 2011-01-19 2011-07-20 南京农业大学 Wheel type mobile fruit picking robot and fruit picking method
CN102233575A (en) * 2010-04-23 2011-11-09 北京航空航天大学 Small-sized emergency rescue and detection robot for nuclear radiation environment
CN103085084A (en) * 2013-01-29 2013-05-08 山东电力集团公司电力科学研究院 Visual system and working method for high-voltage hot-line operating robot
CN103753528A (en) * 2014-02-18 2014-04-30 中国人民解放军军事医学科学院卫生装备研究所 Foldable six degrees of freedom light type operating arm with joint axis orthogonal relation
CN104476550A (en) * 2014-12-05 2015-04-01 济南鲁智电子科技有限公司 All-hydraulic autonomous moving manipulator and moving method thereof
CN105751200A (en) * 2014-12-05 2016-07-13 济南鲁智电子科技有限公司 Action method of fully hydraulic autonomous moving mechanical arm

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103056866B (en) * 2013-01-29 2015-08-12 山东电力集团公司电力科学研究院 Transformer station's hot line robot

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0218139A1 (en) * 1985-09-20 1987-04-15 Kabushiki Kaisha Meidensha Manipulator shoulder mechanism
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
CN102233575A (en) * 2010-04-23 2011-11-09 北京航空航天大学 Small-sized emergency rescue and detection robot for nuclear radiation environment
CN102124866A (en) * 2011-01-19 2011-07-20 南京农业大学 Wheel type mobile fruit picking robot and fruit picking method
CN103085084A (en) * 2013-01-29 2013-05-08 山东电力集团公司电力科学研究院 Visual system and working method for high-voltage hot-line operating robot
CN103753528A (en) * 2014-02-18 2014-04-30 中国人民解放军军事医学科学院卫生装备研究所 Foldable six degrees of freedom light type operating arm with joint axis orthogonal relation
CN104476550A (en) * 2014-12-05 2015-04-01 济南鲁智电子科技有限公司 All-hydraulic autonomous moving manipulator and moving method thereof
CN105751200A (en) * 2014-12-05 2016-07-13 济南鲁智电子科技有限公司 Action method of fully hydraulic autonomous moving mechanical arm

Also Published As

Publication number Publication date
CN105751199A (en) 2016-07-13

Similar Documents

Publication Publication Date Title
CN105751200B (en) The method of operating of all-hydraulic autonomous mechanical arm
CN105751199B (en) The method of operating of all-hydraulic autonomous mechanical arm
CN104476550B (en) The method of operating of all-hydraulic autonomous mechanical arm
Chen et al. Homography-based visual servo tracking control of a wheeled mobile robot
CN104400279B (en) Pipeline space weld seam based on CCD identifies the method with trajectory planning automatically
Sun et al. A review of robot control with visual servoing
Guo et al. Vision based navigation for Omni-directional mobile industrial robot
CN109366503A (en) The processing technology towards large-scale component based on mobile series-parallel robot
Liu et al. A novel six-legged walking machine tool for in-situ operations
CN114378827B (en) Dynamic target tracking and grabbing method based on overall control of mobile mechanical arm
Aref et al. Position-based visual servoing for pallet picking by an articulated-frame-steering hydraulic mobile machine
Liu et al. An omnidirectional mobile operating robot based on mecanum wheel
Ranjan et al. Identification and control of NAO humanoid robot to grasp an object using monocular vision
Backes et al. Automated rover positioning and instrument placement
CN204819543U (en) Centralized control formula multirobot motion control system
Gui et al. Design and experimental verification of an intelligent wall-climbing welding robot system
Sánchez et al. Machine vision guidance system for a modular climbing robot used in shipbuilding
Zhao et al. Obstacle avoidance and terrain identification for a hexapod robot
Zhou et al. Visual servo control of underwater vehicles based on image moments
Guangyao et al. Visual servo control of omnidirectional mobile manipulator
Bae et al. A dynamic visual servoing of robot manipulator with eye-in-hand camera
Chang et al. Mobile robot navigation and control with monocular surveillance cameras
CN116175035B (en) Intelligent welding method for steel structure high-altitude welding robot based on deep learning
Yong et al. A movement planning and control method of special robot over obstacle based on centroid monitoring
Wang et al. Visual servo control and parameter calibration for mobile multi-robot cooperative assembly tasks

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20180522

Termination date: 20181205