CN209335630U - It is a kind of based on industrial robot without sensing elastic collision device - Google Patents
It is a kind of based on industrial robot without sensing elastic collision device Download PDFInfo
- Publication number
- CN209335630U CN209335630U CN201821626424.9U CN201821626424U CN209335630U CN 209335630 U CN209335630 U CN 209335630U CN 201821626424 U CN201821626424 U CN 201821626424U CN 209335630 U CN209335630 U CN 209335630U
- Authority
- CN
- China
- Prior art keywords
- speed
- control device
- current
- industrial robot
- control
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Abstract
The utility model discloses a kind of based on industrial robot without sensing elastic collision device, including system control device, motor servo driving device and industrial machine human body.Motor servo driving device is equipped with control device switching switch and collision detecting device, and collision detecting device connects control device switching switch.Collision detecting device is by the carry out collision judgment compared with speed that off-line learning arrives, current curve.When colliding, the controller of motor servo appartus is switched to composite control apparatus by position and speed electric current three close-loop control device, it drives joint servo motor to stop by given Reverse Turning Control electric current and controls its rebound distance using position feed back signal, avoid rigid shock to industrial robot and the damage for being hit object and due to industrial robot end and with object is hit be close to the case where causing robot to re-power rear servo drive generation overload-alarm generation.
Description
Technical field
The utility model relates to a kind of collision detection and safety control technology based on industrial robot servo-system essence,
It is specifically a kind of based on industrial robot without sensing elastic collision device.
Background technique
Industrial robot is in use, since many reasons lead at work that its end and other workpiece occur rigidity and touch
It hits, and impact force suffered by end can be coupled on each joint shaft, and an impact force is loaded on each joint drive motor shaft
Square.Alarm signal can be generated after servo-driver detects that servo motor overloads and is stopped, but robot end at this time
It is close together with object is hit, or leads to end since other axis for not generating overload-alarm continue to execute the instruction given and
End impact is hit object damage mechanical arm and is hit object.When powering on again can rebound due to rammer or dieback cause to collide
Alarm or overload-alarm, lead to that the practicability is poor.
The above problem has related generally to the collision detection and safety control technology of industrial robot.It is common in industrial robot
Collision Detection have the vision-based detection based on camera, the detection based on kinetic model, based on external torque sensor
Detection and the methods of the detection of servo-drive level.Side based on camera vision-based detection and external torque sensor detection
Method requires additionally to increase component, and the latter also needs to change the structure of industrial robot, this all considerably increases industrial machine
The cost of people.Meanwhile the detection method based on kinetic model not only needs to carry out the identification of parameter for different operating conditions, but also
Huge calculation amount is also needed to be difficult to realize complete on-line checking.Safety control technology refers to after detecting collision or danger
How to make corresponding security control and guarantees that it works normally and avoid industrial robot and is hit a kind of technology of object damage.
Industry is by given position instruction or speed command industrial robot to be stopped for common practice after detecting collision
Only run.But be contemplated that in actual motion when powering on again can rebound due to rammer or dieback cause collision warning
Or situations such as overload-alarm.
Utility model content
The technical problem to be solved by the utility model is to overcome defect of the existing technology, proposes one kind and be based on
Industrial robot without sensing elastic collision device.
The utility model is achieved through the following technical solutions: based on industrial robot without sensing elastic collision device, packet
System control device, motor servo driving device and industrial machine human body are included, system control device sends joint position instruction
Motor servo driving device is given, motor servo driving device output power signal drives industrial machine human body movement.
Further, the motor servo driving device includes collision detecting device, and collision detecting device compares equipped with electric current
Device and speed comparison unit come from servo motor electric current and speed signal to receive, when current differential is more than allowable deviation valve
Electric current comparison unit exports high level signal when value；When speed difference is more than allowable deviation threshold values, the output of speed comparison unit is high
Level signal then judges industrial robot end when speed comparison unit and electric current comparison unit export high level signal simultaneously
It collides.
Further, motor servo driving device further includes position and speed electric current three close-loop control device, composite control apparatus, control
Equipment switcher processed.The collision detecting device connects the control device switching switch, when collisionless, the collision inspection
It surveys device sending control signal drive dynamic control device switching and switchs the control signal so that position and speed electric current three close-loop control device
It exports and gives motor servo driving device；When colliding, the collision detecting device issues control signal drive dynamic control device
Switching switch is so that the control signal of composite control apparatus inputs to motor servo driving device；The motor servo driving device
It further comprise a power amplifier, the power amplifier connects the control device switching switch and the servo motor.
Further, the industrial machine human body include industrial robot structure system and each joint servo motor,
Absolute type encoder, the servo motor receive the control signal by control device switching switch to which output torque is driven
The shaft of dynamic each joint motions of industrial robot structure system, absolute type encoder and servo motor is coaxially to generate joint position
Feedback signal.
Further, the position and speed electric current three close-loop control device includes positioner, speed control, the first electric current
Controller and differentiator, the joint position instruction that the positioner receives system control device are compiled with from the absolute type
The deviation of the joint position feedback signal of code device simultaneously exports joint velocity and instructs to speed control, and differentiator receives joint position
Feedback signal and output speed feedback signal, speed control receive the deviation of input joint velocity instruction and feedback speed signal
And joint servo motor current command is exported to first current controller, the current controller receives joint servo motor
The deviation of current-order and the current feedback signal detected and output voltage control signal switch to the control device to be switched.
Further, composite control apparatus is equipped with rebound distance detection device and the second current controller, the rebound distance
Detection device receives the joint position feedback signal detected for judging whether rebound distance reaches setting value and export electric current
Control instruction, second current controller receive the deviation and output voltage of the current control instruction and current feedback signal
It controls signal to the control device and switches switch.
The beneficial effects of the utility model are:
(1) pass through off-line operation to current of electric, speed without sensing elastic collision method the present invention is based on industrial robot
Line of writing music carries out self study, obtains speed, current center's curve and the allowable deviation threshold values in corresponding stage of different operation phase,
When then passing through on-line operation the electric current of servo motor and feedback speed signal and off-line learning to value be compared
Complete to be not necessarily to torque sensor to the end collision detection of industrial robot, have calculate simplicity, high sensitivity, real-time it is good,
Feature at low cost.
(2) being filled by the way that control is arranged in motor servo driving device without sensing elastic collision device based on industrial robot
Switching switch and collision detecting device are set, collision detecting device connects control device switching switch, when collisionless, collision detection
Device issues control signal drive dynamic control device switching switch so that the control signal of position and speed electric current three close-loop control device is defeated
Motor servo driving device is given out；When colliding, the controller of motor servo appartus is by position and speed electric current three close-loop control
Device is switched to composite control apparatus, drives joint servo motor to stop by given Reverse Turning Control electric current and utilizes position feedback
Signal controls its rebound distance, so as to avoid rigid shock to industrial robot and the damage for being hit object, also avoid due to
With object is hit it is close to that robot is caused to re-power the case where rear servo drive generates overload-alarm in industrial robot end
Occur, the end collision inspection to industrial robot can be completed in the structure without additionally increasing component or change industrial robot
It surveys, reduces the cost of industrial robot, and have good practicability.
Detailed description of the invention
When Fig. 1 is servo motor operating status in the utility model, the change curve of speed and electric current；
Fig. 2 be in the utility model based on industrial robot without sensing elastic collision device schematic diagram；
Fig. 3 is to act on front and back motor operation shape without sensing elastic collision method based on industrial robot in the utility model
State figure；
Fig. 4 be in the utility model based on industrial robot without sensing elastic collision method flow diagram.
Specific embodiment
Combined with specific embodiments below and attached drawing does further detailed description to the utility model, but the utility model
Embodiment is without being limited thereto.
Please refer to such as Fig. 2, the utility model provide it is a kind of based on industrial robot without sensing elastic collision device,
Including system control device 1, motor servo driving device 2 and industrial machine human body 17.System control device 1 sends joint position
Instruction is set to motor servo driving device 2,2 output power signal of motor servo driving device drives industrial machine human body 17 to transport
It is dynamic.
It please refers to such as Fig. 2, the motor servo driving device 2 is by position and speed electric current three close-loop control device 3, complex controll
Device 14, collision detecting device 7, control device switching switch 15 and power amplifier 16 form.
The position and speed electric current three close-loop control device 3 receives the position command signal and work that system control device is sent
The joint position feedback signal that industry robot body 17 is sent, output power current signal to industrial machine human body 17 is to drive
Joint servo motor 18 moves.The position and speed electric current three close-loop control device 3 is by positioner 4, speed control 5,
One current controller 6 and differentiator 10 form.
It holds, the positioner 4 receives the pass of the joint position instruction and robot body 17 of system control device 1
It saves the deviation of position feed back signal and exports joint velocity and instruct to speed control 5.Joint position feedback signal passes through differential
10 output speed feedback signal of device, speed control 5 input the deviation of joint velocity instruction and feedback speed signal and export pass
Servo motor current-order is saved to the first current controller 6.First current controller 6 receive joint servo motor current command with
The deviation and output voltage control signal to control device of the current feedback signal detected switch switch 15.
What the current feedback signal and industrial machine human body 17 that the reception of composite control apparatus 14 detects were sent
Joint position feedback signal, output driving current signal drive joint servo motor 18 to move to industrial machine human body 17.
Composite control apparatus 14 is made of rebound distance detection device 12 and the second current controller 13.Rebound distance detection device 12 is used
11 are instructed in judging whether rebound distance reaches the rebound distance of setting and export current control.Second current controller 13 receives
Simultaneously output voltage control signal to control device switches switch 15 to the deviation of current control instruction 11 and current feedback signal.
The signal of the reception position and speed electric current three close-loop control device 3 of power amplifier 16 or composite control apparatus 14 is simultaneously
Power signal is generated after amplifying to be output on the servo motor 18 of industrial machine human body 17.
The collision detecting device 7, which receives to come from 18 electric current of servo motor and speed signal and input to electric current respectively, to be compared
Device 8 and speed comparison unit 9.When current differential is more than allowable deviation threshold values, electric current comparison unit 8 exports high level signal；
When speed difference is more than allowable deviation threshold values, speed comparison unit 9 exports high level signal.When speed comparison unit 8 and electric current
Comparison unit 9 then judges that industrial robot end collides when exporting high level signal simultaneously, and collision detecting device produces at this time
Raw control signal, which is exported, switches switch 15 to control device.When collisionless, the collision detecting device 7 issues control signal and drives
Dynamic control device switching switch 15 makes the control signal of position and speed electric current three close-loop control device 3 input to power amplifier
16；When colliding, issues control signal drive dynamic control device switching switch 15 and the control of composite control apparatus 14 is believed
Number input to power amplifier 16.
Referring to Fig. 2, the industrial machine human body 17 is by industrial robot structure system 20 and the servo in each joint
Motor 18, absolute type encoder 19 form.Servo motor 18 is received from the power amplifier 16 and output torque drives work
Each joint motions of industry robot architecture system 20, absolute type encoder 19 are coaxially anti-to generate joint position with 18 axis of servo motor
Feedback signal, and feedback arrives the position and speed electric current three close-loop control device 3 and the composite control apparatus 14 respectively.
Please refer to Fig. 1, Fig. 3 and Fig. 4, it is provided by the utility model based on industrial robot without sensing elastic collision side
Method principle is as follows:
When industrial robot carries out more single repeating motion under determining station operating condition, each servo motor operation
State is fixed in a certain range.Industrial robot runs several work paces under normal workload first,
Servo drive draws curve as shown in Figure 1, rate curve is respectively fn by collected electric current and speed during thisk
(z) (k=1,2...), current curve are respectively fik(z) (k=1,2...).Rate curve can be divided into speed ascent stage,
Speed decline stage, speed are most worth stabilization sub stage three phases, and current curve can also be divided into depression of order under electric current ascent stage, electric current
Section, current best value stabilization sub stage, current zero stabilization sub stage four-stage.
Centre of velocity curve fn (z) is obtained by calculating speed curve and current curve average value to its different operation phase
With current center curve fi (z), as shown in Figure 1.
Different phase speed, the center curve in current value and the stage are made the difference and acquires maximum value and obtains allowable deviation
Threshold values:
Δ n=max | fnk(z)-fn(z)| (1)
Δ i=max | fik(z)-fi(z)| (2)
The allowable deviation threshold values of rate curve different phase: Δ n can be calculated by above formulaU(speed ascent stage),
ΔnD(speed decline stage), Δ nM(speed is most worth the stabilization sub stage).Obtain the allowable deviation threshold values of current curve different phase:
ΔiU(electric current ascent stage), Δ iD(electric current decline stage), Δ iM(current best value stabilization sub stage), Δ iZ(current zero is stablized
Stage).
In actual moving process, by acquiring speed, the current value of current servo motor, carried out according to formula (3), (4)
It calculates.Then sentence when formula (3), (4) have been above corresponding allowable deviation threshold values at velocity deviation immediately and current deviation simultaneously
Break collision.
| n (z)-fn (z) | > Δ n (3)
| i (z)-fi (z) | > Δ i (4)
Collision detecting device generates control signal drive dynamic control device switching switch so that servo drive is by original at this time
Some position and speed electric current three close-loop control pattern switchings are compound control mode (current control and position feedback), by given anti-
The second current controller is made to control servo motor counter motion to current-order, when rebound distance detection device detects absolutely
When the joint position feedback value of formula encoder is equal with the rebound distance of setting, then gives current-order and make the second current control
Device controls servo motor parking.
It please refers to Fig. 3 and Fig. 4, based on industrial robot includes following without sensing elastic collision method in the utility model
Step:
1, several work paces of industrial robot off-line operation carry out electric current, the feedback speed signal of servo motor 18
Acquisition, and current center curve fi (z) is obtained by calculating speed curve and current curve average value to its different operation phase
With centre of velocity curve fn (z).
2, different phase speed, current value are utilized respectively formula Δ n=max | fnk(z)-fn (z) |, Δ i=max | fik
(z)-fi (z) | speed allowable deviation threshold values (the Δ n of different phase is calculatedU、ΔnD、ΔnM) and electric current allowable deviation threshold values
(ΔiU、ΔiD、ΔiM、ΔiZ)。
3, in actual work, servo drive 2 receives the position command of system control device 1 and exports fast to position
Electric current three close-loop control device (the switch S of control device switching switch 13 is in state 1) is spent to drive industrial machine human body 15
Movement, while speed, electric current sample and according to formula in any t moment | n (z)-fn (z) | > Δ n, | i (z)-fi
(z) | > Δ i is judged.When two formulas are not set up simultaneously, then industrial robot end collisionless occurs, and return continues
Trajectory motion control；
4, as shown in Figure 3, in t1It collides when the moment, 18 revolving speed bust of servo motor, armature supply increased dramatically, watch
Driving device 2 is taken in t2When the moment, according to formula | n (z)-fn (z) | > Δ n, | i (z)-fi (z) | > Δ i calculates judgement simultaneously
It sets up, judges that industrial robot end collides at this time.
5, in t2Moment detects collide after, the control device of Servocontrol device 2 switching switch 15 by switch S by
State 1 is switched to state 2, i.e. control device is switched to composite control apparatus by position and speed electric current three close-loop control device.At this point,
Servo drive 2 gives reverse current control instruction 11, exports plugging electric current by composite control apparatus 14 and drives servo
Motor 18 slows down, finally in t318 revolving speed of moment servo motor is kept to 0.
6, as shown in Figure 3, in t3Moment, servo motor 18 stop.At this point, servo drive 2, which receives, comes from absolute type
The joint position feedback signal θ of encoder 19 and rebound distance θ with settingrbkCompare.
As θ < θrbkWhen, servo drive 2 continues given reverse current control instruction 9 and is driven by composite control apparatus 14
18 counter motion of movable joint servo motor；
As θ > θrbkWhen, servo drive 2 brakes joint servo motor 18 and makes industrial robot out of service.Pass through
After avoiding restarting 18 overload-alarm of servo motor occurs for rebound and the control of rebound distance so that release residual stress
Situations such as, reduce the damage for being hit object.
Above-described embodiment is the preferable embodiment of the utility model, but the embodiments of the present invention is not by above-mentioned
The limitation of embodiment, it is made under other any spiritual essence and principles without departing from the utility model to change, modify, replacing
In generation, simplifies combination, should be equivalent substitute mode, is included within the protection scope of the utility model.
Claims (6)
1. based on industrial robot without sensing elastic collision device, which is characterized in that including system control device, motor servo
Driving device and industrial machine human body, system control device transmission joint position, which instructs, gives motor servo driving device, motor
Servo drive output power signal drives industrial machine human body movement.
2. according to claim 1 based on industrial robot without sensing elastic collision device, it is characterised in that: the motor
Servo drive includes collision detecting device, and collision detecting device is equipped with electric current comparison unit and speed comparison unit, to connect
It receives and comes from servo motor electric current and speed signal, the high electricity of electric current comparison unit output when current differential is more than allowable deviation threshold values
Ordinary mail number；When speed difference is more than allowable deviation threshold values, speed comparison unit exports high level signal, when speed comparison unit
Then judge that industrial robot end collides when exporting high level signal simultaneously with electric current comparison unit.
3. according to claim 2 based on industrial robot without sensing elastic collision device, it is characterised in that: motor servo
Driving device further includes position and speed electric current three close-loop control device, composite control apparatus, control device switching switch, the collision
Detection device connects the control device switching switch, and when collisionless, the collision detecting device issues control signal driving
Control device switching switch is so that the control signal of position and speed electric current three close-loop control device exports and gives motor servo driving device；
When colliding, the collision detecting device issues control signal drive dynamic control device switching switch so that composite control apparatus
Control signal input to motor servo driving device；The motor servo driving device further comprises a power amplifier,
The power amplifier connects the control device switching switch and the servo motor.
4. according to claim 3 based on industrial robot without sensing elastic collision device, it is characterised in that: the industry
Robot body includes the servo motor of industrial robot structure system and each joint, absolute type encoder, the servo electricity
Machine is received by the control signal of control device switching switch to which output torque driving industrial robot structure system is each
The shaft of joint motions, absolute type encoder and servo motor is coaxially to generate joint position feedback signal.
5. according to claim 4 based on industrial robot without sensing elastic collision device, it is characterised in that: the position
Speed electric current three close-loop control device includes positioner, speed control, the first current controller and differentiator, the position
The joint position instruction and the joint position feedback signal from the absolute type encoder that controller receives system control device
Deviation and export joint velocity and instruct to speed control, differentiator receives joint position feedback signal and output speed feedback
Signal, speed control receive the deviation of the instruction of input joint velocity and feedback speed signal and export joint servo current of electric
Instruct the electric current for receiving joint servo motor current command to first current controller, the current controller and detecting
The deviation and output voltage control signal of feedback signal switch to the control device to be switched.
6. according to claim 4 based on industrial robot without sensing elastic collision device, it is characterised in that: complex controll
Device is equipped with rebound distance detection device and the second current controller, and the rebound distance detection device receives the joint detected
Position feed back signal is used to judge whether rebound distance to reach setting value and export current control instruction, second current control
Device receives the current control instruction and the deviation and output voltage control signal to the control device of current feedback signal are cut
Change switch.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201821626424.9U CN209335630U (en) | 2018-10-08 | 2018-10-08 | It is a kind of based on industrial robot without sensing elastic collision device |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201821626424.9U CN209335630U (en) | 2018-10-08 | 2018-10-08 | It is a kind of based on industrial robot without sensing elastic collision device |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN209335630U true CN209335630U (en) | 2019-09-03 |
Family
ID=67745484
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201821626424.9U Active CN209335630U (en) | 2018-10-08 | 2018-10-08 | It is a kind of based on industrial robot without sensing elastic collision device |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN209335630U (en) |
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN109202907A (en) * | 2018-10-08 | 2019-01-15 | 广州数控设备有限公司 | It is a kind of based on industrial robot without sensing elastic collision device and method |
| CN111645070A (en) * | 2020-05-19 | 2020-09-11 | 华为技术有限公司 | Robot safety protection method and device and robot |
| WO2021056447A1 (en) * | 2019-09-27 | 2021-04-01 | 西门子（中国）有限公司 | Encoding driving device and method, and robot joint |
| CN113681567A (en) * | 2021-09-14 | 2021-11-23 | 北京清飞科技有限公司 | Novel sensorless robot collision detection method and system thereof |
-
2018
- 2018-10-08 CN CN201821626424.9U patent/CN209335630U/en active Active
Cited By (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN109202907A (en) * | 2018-10-08 | 2019-01-15 | 广州数控设备有限公司 | It is a kind of based on industrial robot without sensing elastic collision device and method |
| CN109202907B (en) * | 2018-10-08 | 2024-02-27 | 广州数控设备有限公司 | Sensorless elastic collision device and method based on industrial robot |
| WO2021056447A1 (en) * | 2019-09-27 | 2021-04-01 | 西门子（中国）有限公司 | Encoding driving device and method, and robot joint |
| CN114222649A (en) * | 2019-09-27 | 2022-03-22 | 西门子（中国）有限公司 | Encoding driving device and method and robot joint |
| EP4019201A4 (en) * | 2019-09-27 | 2023-06-07 | Siemens Ltd., China | Encoding driving device and method, and robot joint |
| CN111645070A (en) * | 2020-05-19 | 2020-09-11 | 华为技术有限公司 | Robot safety protection method and device and robot |
| CN113681567A (en) * | 2021-09-14 | 2021-11-23 | 北京清飞科技有限公司 | Novel sensorless robot collision detection method and system thereof |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN109202907A (en) | It is a kind of based on industrial robot without sensing elastic collision device and method | |
| CN209335630U (en) | It is a kind of based on industrial robot without sensing elastic collision device | |
| CN110977972B (en) | Multi-joint robot collision detection method, computer-readable storage medium and robot | |
| US7102311B2 (en) | Drive control method and drive controller | |
| CN107614212B (en) | Industrial robot and fault judgment method thereof | |
| US9102058B2 (en) | Method and apparatus for implementing a manipulator process | |
| WO2003086718A1 (en) | Robot | |
| US10953546B2 (en) | Method and system for operating and/or monitoring a multi-axis machine | |
| CN109605344B (en) | Multi-degree-of-freedom open-loop stepping series mechanical arm and control method thereof | |
| CN111113377B (en) | Humanoid robot with attitude calibration system and control method thereof | |
| CN102554939A (en) | Method and device for collision protection of industrial robot | |
| CN110355786A (en) | A kind of robot hits detection method and robot | |
| CN108762315B (en) | Monitoring device and method of closed-loop control system and closed-loop control system | |
| CN103722428A (en) | Control method and system for tool magazine of CNC machine tool | |
| CN115057245B (en) | Destacking system based on bus controller and servo system | |
| CN110125312A (en) | A kind of automatic punching riveting control system and control method | |
| CN111823235A (en) | Collision detection method for picking mechanical arm | |
| CN105302163A (en) | Large and medium monitoring rotary-table rotating system and operation control method thereof | |
| CN201881387U (en) | Industrial robot collision protection device | |
| CN201711968U (en) | Industrial robot | |
| CN103008518A (en) | Electric screw press control system and electric screw press control method | |
| KR20110016315A (en) | Emergency stop system in articulated robot | |
| CN112123333A (en) | Multi-joint robot collision detection method and device | |
| CN106273639A (en) | Put in place arresting stop and the method for shutting down that puts in place for mold changing systems | |
| CN106547246A (en) | The quick loading control method of electric cylinder pressure high accuracy |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| GR01 | Patent grant | ||
| GR01 | Patent grant |