Industrial robot
Technical field
The present invention relates to a kind of industrial robot.
Background technology
Industrial robot is extensively applied in manufacturing industry, and service behaviour the most all exceedes manually, it has also become commercial production can not
Or the instrument lacked.But present industrial robot still has some problems to limit its wider application, for example with servomotor
Needing 200V high pressure, outdoor safety in operation is poor, and is not suitable for battery and powers;Servo-control system complex and expensive, it is difficult to do
To miniaturization, it is difficult to be embedded in mechanical arm;Study, programming, operating process complexity etc..These are all owing to excessively pursuit is watched
Take the perfect performance of motor, and the added burden produced, thus limit application and the application model of universal type industrial robot
Enclose.Such as can only be the most clumsy in the mechanical arm action to equip in battery powered field movable robot, and action is dexterous
The superb industrial robot of performance is not then resistant to because of high voltage that rainwater is moist, power consumption can not persistently be difficult to install greatly.
Summary of the invention
Present invention design achieves a high-performance 6 rotating shaft industrial robot driven by stepper motors.Motor has structure
Simply, the feature that stable and reliable for performance, precision is high, stepper motor driver is the most reliable and the most stable, and embedding be can be miniaturized
Motor internal.Robot arm 12-24 lies prostrate low-voltage power supply, and repetitive positioning accuracy is high, can reach 0.1 to 0.01 millimeter.
The repetitive positioning accuracy of robot is determined by each rotor axis mechanical element precision.
Robot architecture: be six rotating shaft serial machine mechanical arm, wherein waist joint 1, shoulder joint 2 and elbow joint 3 are all by stepping electricity
Machine 8, accurate retarding machine 9 are constituted;Wrist portion is the 4th 56 joint 4,5,6, by motor 8, accurate retarding machine 9,
Drive mechanism is constituted.Wrist portion front end is equipped with a magnechuck interface 7, in order to connect end effector mechanism.
High speed inserted computer constitute motion controller control manipulator motion, it is possible to achieve pivot, move along a straight line, circle
Arc motion etc., and can output mux amount and 4 road pwm signals.
Teaching programming uses hand-hold programmer to operate, and can control with keyboard 14 and rocking bar 12,13 controls.Use keyboard 14
Or rocking bar 12,13 can position teaching track by pivot or linear motion when carrying out teaching operation.The number of teaching programming
It is stored on SD card with document form according to by message handler.
The rocking bar of manipulation robot is for three-dimensional potentiometer structure and carries a press button 15,16, and the voltage signal of output is through A/D
Conversion obtains controlled quentity controlled variable, and actuator carries out speed governing by this controlled quentity controlled variable.There is self-return function after rocking bar release, control after return
Amount is 0, and now mechanical arm keeps current pose, transfixion.Under pivot state rocking bar 12 control mechanical arm the 1st, 2,
3 axles rotate, and rocking bar 13 controls the 4th, 5,6 axles and rotates;When being transformed into linear motion state by status button, rocking bar 12
Controlling mechanical arm to move along a straight line in 3-dimensional rectangular coordinate system, rocking bar 13 controls the attitude of wrist joint (the 4th, 5,6 axles).Machine
Mechanical arm movement velocity is proportional to the controlled quentity controlled variable of rocking bar.Three-dimensional rocker manipulation simple, intuitive, is not required to study and can operate with machine
People.
Control system is by message handler, motion controller, data/address bus, state display controller, human-machine operation controller structure
Become.Wherein motion controller is embedded into inside mechanical arm, and mechanical arm need not single switch board;Message handler, state are aobvious
Show that controller and human-machine operation controller load hand-hold programmer.Serial data line can be used between hand-hold programmer and mechanical arm
Or wireless serial communication connects.
The invention has the beneficial effects as follows: except having that the action of conventional industrial robot is dexterous rapidly, repetitive positioning accuracy is high, can
Outside the advantages such as teaching programming and off-line programing, by using motor to replace servomotor, it is possible to use 12-24V low-voltage is driven
Dynamic;Control and drive system is completely embedded into inside mechanical arm, it is not necessary to electric control cabinet, mechanical arm can be designed to more exquisite;
Teaching programming is easy to learn, is suitable for layman's operation;Cost is substantially reduced, can more be widely used in assembling, welding,
The traditional industries such as spraying produce, it is also possible to for the frontier in laboratory, face, desk room etc.;Lowered in field environment, underwater environment,
And under the conditions of needing battery powered mobile device, have peculiar advantage with stepper motor driven dexterous mechanical arm, so that work
Range of application and the application industry of industry robot are expanded significantly.
Accompanying drawing explanation
Mechanical construction drawing included in the following drawings broadly falls into illustrative nature, for the operation principle of the present invention is described, and machinery knot
The size of structure, mounting structure, connected mode etc. can flexible design, the present invention not by diagram mechanical transmission structure limited.
Fig. 1: Industrial robots Mechanical's arm configuration figure
Fig. 2: hand-hold programmer structure chart;
Detailed description of the invention
Being embodied as of industrial robot needs to be realized by system controlling software and hand-hold programmer software.Robot interior is adopted
By a kind of real-time Distributed Control System (DCS), each functional part has a special embedded controller, by number
According to the instruction of bus real-time reception, execution action, send data.Concurrent working between each functional part, does not interfere with each other.
The operation of robot message handler Comprehensive Control entirety parts.Message handler receives each functional part from data/address bus and sends out
The data gone out, forward instruction to arrive data/address bus, or display output after analyzing and processing.All operation information, fault message pass through
Video-stream processor connects LCD11 and shows integrated operation state.Message handler is connected to SD card memory, when with hand-hold programmer
When carrying out teaching operation, produced data are stored in the SD card of message handler with file situation.Carrying out repetition fortune
Time dynamic, message handler is sent to manipulator motion controller by reading data and by data/address bus.
Manipulator motion controller receives movement instruction by data/address bus, carries out interpolation calculation, is then output to six tunnel steppings and drives
Dynamic device control signal, drives six rotating shaft linkages of mechanical arm, makes mechanical arm navigate to impact point according to the speed of instruction regulation.
This motion controller algorithm is accurately efficient, ensures that step error do not lost by motor 8 by encoder.Can also unnecessary encode
The feedback data of device 10, and use robust techniques to ensure the repetitive positioning accuracy of mechanical arm.The real-time home position of motion controller is believed
Breath is to data/address bus.Motion controller can export 4 road pwm signals and multi-way switching values signal, by power driving circuit control
End effector processed works.
Robot can directly control three outside axles, it is possible to controls more outside axle by extended instruction system.Outside axle needs
Individually motion controller and driver.By introducing the deflection machine being made up of outside axle, industrial robot can be made to complete extremely
The complicated course of processing.
Human-machine operation controller management keyboard 14 and rocking bar 12,13.The keyboard that formed when manual operation or teaching program and shaking
Bar data, are dealt into message handler by bus, and message handler forms instruction and issues motion controller.
The industrial robot control system structure of the present invention is advanced rationally, stable and reliable for performance, and expanding of system function ability is strong, merit
Energy component models embedded design, is fully immersed into inside mechanical arm.The size of robot can be with flexible design, mechanical arm
Load capacity can be designed to different brackets as required.