EP3386686A1 - Method for detecting a collision of a robotic arm having an object, and robot having a robotic arm - Google Patents
Method for detecting a collision of a robotic arm having an object, and robot having a robotic armInfo
- Publication number
- EP3386686A1 EP3386686A1 EP16805122.5A EP16805122A EP3386686A1 EP 3386686 A1 EP3386686 A1 EP 3386686A1 EP 16805122 A EP16805122 A EP 16805122A EP 3386686 A1 EP3386686 A1 EP 3386686A1
- Authority
- EP
- European Patent Office
- Prior art keywords
- actual
- robot arm
- movement
- tool center
- tcp
- 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.)
- Withdrawn
Links
- 238000000034 method Methods 0.000 title claims abstract description 34
- 230000033001 locomotion Effects 0.000 claims description 104
- 230000001133 acceleration Effects 0.000 claims description 32
- 230000002123 temporal effect Effects 0.000 claims description 9
- 238000011156 evaluation Methods 0.000 claims description 6
- 230000000977 initiatory effect Effects 0.000 claims description 4
- 230000036461 convulsion Effects 0.000 description 4
- 238000009795 derivation Methods 0.000 description 4
- 238000013213 extrapolation Methods 0.000 description 4
- 230000005540 biological transmission Effects 0.000 description 3
- 238000004590 computer program Methods 0.000 description 3
- 238000001514 detection method Methods 0.000 description 3
- 239000012636 effector Substances 0.000 description 3
- 238000012544 monitoring process Methods 0.000 description 2
- 230000001105 regulatory effect Effects 0.000 description 2
- 230000015572 biosynthetic process Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000001276 controlling effect Effects 0.000 description 1
- 238000005755 formation reaction Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 230000001360 synchronised effect Effects 0.000 description 1
- 230000036962 time dependent Effects 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
- B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
- B25J13/088—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices with position, velocity or acceleration sensors
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1674—Programme controls characterised by safety, monitoring, diagnostic
- B25J9/1676—Avoiding collision or forbidden zones
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/02—Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type
- B25J9/04—Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type by rotating at least one arm, excluding the head movement itself, e.g. cylindrical coordinate type or polar coordinate type
- B25J9/046—Revolute coordinate type
- B25J9/047—Revolute coordinate type the pivoting axis of the first arm being offset to the vertical axis
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1651—Programme controls characterised by the control loop acceleration, rate control
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/37—Measurements
- G05B2219/37624—Detect collision, blocking by measuring change of velocity or torque
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/37—Measurements
- G05B2219/37629—Detect sudden change of direction due to collision
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/49—Nc machine tool, till multiple
- G05B2219/49141—Detect near collision and slow, stop, inhibit movement tool
Definitions
- the invention relates to a method for detecting a collision of a robot arm with an object and a correspondingly formed robot comprising a robot arm and an electronic control device.
- Robots in general are handling machines equipped for the automatic handling of objects with suitable tools, so-called end effectors, and in several axes of motion, in particular with regard to
- Robots comprise a robotic arm with a plurality of links arranged one behind the other and programmable controllers (control devices) which, during an automatic operation of the robot, control drives of the robot for the movements of the robot arm.
- controllers control devices
- corresponding computer programs so-called user programs, run on the control devices.
- Trajectory section is monitored in a reference run through to determine continuous movement characteristic measurements, which are stored as reference values.
- EP 0 365 681 A1 discloses a method for detecting a collision of a robot arm with an object Evaluating electric currents of the electric motors provided for moving the robot arm.
- the object of the present invention is to specify a further method for detecting a collision of a robot arm with an object.
- a further object of the invention is to specify a correspondingly configured robot.
- the object of the invention is achieved by a method for detecting a collision of a robot arm with an object, wherein the robot arm is part of a robot and a plurality of successively arranged with respect to axes rotatably mounted members and the individual axes associated to determine the positions of two adjacent each Having members relative to each other provided position sensors, in particular the robot arm is associated with a Tool Center Point, and the robot has an electronic control device connected to the positioning devices and driven by the electronic control device for automatically moving the members of the robot arm relative to each other, comprising the following method steps:
- a robot comprising a robot arm, which in particular is assigned a tool center point and which has a plurality of members arranged one behind the other, mounted with respect to axes and assigned to the individual axes, for determining the positions of two adjacent members relative to one another provided position sensors, an electronic control device connected to the positioning devices and actuated by the electronic control device for automatically moving the members of the robot arm relative to each other, wherein the electronic control device is arranged such that the robot performs the inventive method.
- the robot includes the electronic control device and the robot arm.
- the electronic control device is set up to control the drives of the robot in such a way that the robot arm thus makes a corresponding movement to the members of the robot arm.
- the tool center point of the robot arm moves along a corresponding desired path.
- a corresponding computer program runs on the electronic control device.
- the Tool Center Point may automatically move along an actual path.
- the drives are preferably electric drives, in particular regulated electric drives. In particular, at least the electric motors of these electric drives are mounted in or on the robot arm.
- the robotic arm comprises the plurality of consecutively arranged members which are mounted with respect to the axes and the position sensors.
- the links are preferably rotatable with respect to the axles.
- the position sensors are preferably resolvers.
- the position sensors are preferably implemented in so-called safe technology and are connected to the electronic control device, so that the electronic control device is able to evaluate the signals originating from the position sensors.
- the electronic control device determines the current positions, i. To determine the actual positions of the individual members during the actual movement relative to each other. Due to the actual positions, it is also possible for the electronic control device to determine the current position, i. determine the actual position or the actual position of the Tool Center Point during automatic movement.
- the location of the Tool Center Point is its position and its orientation in space.
- the links are rotatably mounted relative to the axes, then the positions of the links relative to one another are corresponding angular positions.
- Derived variables of the actual position of the Tool Center Point are, in particular, temporal changes or derivations of the actual position according to time, such as, for example, the speed, the acceleration or also higher derivatives of the actual position after the time.
- Derived quantities of the actual positions are e.g. temporal changes or discharges after the time of the actual angular positions or higher derivatives of the actual angular positions after the time.
- the electronic control device during the automatic actual movement by means of the electronic control device and based on the signals originating from the position sensors, it is checked whether on the basis of the actual positions and / or the derived variables of the actual positions and / or due to the actual position and / or the at least one derived size of the actual position of the tool center point, the at least one for the desired movement of the robot arm for the current movement, ie the actual movement of the robot arm is fulfilled.
- an invariant as it is known from computer science, is a statement that applies beyond the execution of certain program instructions. It is therefore true before, during and after the program commands. It is thus unchangeable, that is invariant.
- the invariant associated with the desired movement of the robot arm ie that of the corresponding true statement about the target movement of the robot arm, is checked to see whether it is also fulfilled by the current movement associated with the actual movement of the robot arm. If the invariant is not fulfilled by the actual movement, which is done by checking the actual positions and / or the derived variables of the actual positions and / or on the basis of the actual position and / or the at least one derived variable of the actual position of the Tool Center Point is detected, a collision with the object can be inferred.
- the electronic control device then initiates a safety function of the robot.
- An example of a safety function is an immediate stopping of the movement of the robot arm, for example as part of a so-called "emergency stop".
- position sensors e.g. on the drive side and / or driven side with respect to the corresponding drives are attached to the robot arm, use.
- the position sensors are preferably implemented in safe technology.
- quantities derived from the signals of the Positioanssensoren are in particular speed, acceleration, and jerk, that is, the time derivative of the acceleration.
- the assumption can be used as an invariant that movements are planned smoothly, for example, by the electronic control device. This means that there should be no jumps in the speed signal during normal motion execution. A jump would mean a sudden change in acceleration, so a jerk. Now occurs during a smoothly scheduled If there is a jolt, a collision can be concluded. If position sensors used in safe technology are used, then all the information derived therefrom (speed, acceleration, jerk) is also safely available.
- the invariant refers to the fact that the desired movement is jerk-free. Then, a collision of the robot arm with the object can be inferred if the third derivation of the actual position of the tool center point after the time or a temporal change of the actual acceleration of the tool center point exceeds a predetermined value. Alternatively, it is also possible that a collision of the robot arm with the object is concluded when the third derivatives of the actual positions of the members relative to each other after the time or a temporal change of the actual accelerations of the actual positions of the members relative to each other exceed predetermined value.
- quantities taken from the measured quantities may be subtracted (e.g., target speeds, desired physical model accelerations).
- the result of the subtraction may be against a threshold, i. be checked the predetermined value.
- the course of the variables measured by means of the position sensors can also be recorded.
- the current profile ie in particular the course of the actual movement
- recorded variables ie in particular the course of the desired movement
- current controller parameters of a controller of the robot can be used to detect the collision.
- the deviation in particular the recognizable jerk, will change with the rigidity of a controller used.
- the robot arm is operated by means of admitance or force control and the invariant refers to the fact that the movement associated with the desired path is jerk-free.
- provision may be made for a collision of the robot arm with the object to be inferred if the third derivation of the actual position of the tool center point according to time or a temporal change in the actual acceleration of the tool center point has a predetermined value exceeds, or when the third derivatives of the actual positions of the members relative to each other over time or a change over time of the actual accelerations of the actual positions of the members relative to each other exceeds a predetermined value, wherein the predetermined value of the stiffness of Admitanz- or Force control depends.
- the electronic control device may be configured to include a first control functionality and a second control functionality.
- the first control function takes over the task of a safety controller and the second control functionality of the remaining controls Ro ⁇ boters.
- the first control functionality or the safety controller is suitable for realizing safety-related functionalities. such as stop reactions.
- the safety controller requires data or signals generated using safe technology. This can be realized by the use of sensors in safe technology.
- the target path may be assigned a linear movement of the tool center point.
- the distance between an actual position and the straight line assigned to the target path is greater than one Threshold or predetermined value, then it can be concluded on a colli ⁇ sion.
- the at least one invariant is assigned to the desired position of the tool center point during the desired movement. Then it can be provided that during the actual movement of the tool center point the actual positions of the tool center point are checked, and the invariant is then not fulfilled as soon as at least one of the actual positions of the corresponding desired position of the tool Center Points by a predetermined value.
- the desired positions are preferably calculated within the safe control on the basis of the invariant.
- the at least one invariant is assigned to the desired positions of the members relative to one another during the desired movement.
- the desired movement can be determined, for example, by means of a path planning carried out by the electronic control device.
- This path planning is carried out in particular by means of the second control functionality.
- the second control functionality of the first control functionality ie the safety controller, transmits information that a planned linear desired movement is imminent.
- This information includes, in particular, an indication of the desired start and target end points of the Tool Center Point, as a result of which the first control functionality receives the information, as an invariant, that the desired positions of the Tool Center Point of the imminent desired movement are Start and target endpoints runs along certain straight lines. If at least one of the actual positions deviates from this straight line by the predetermined value during the actual movement of the robot arm, the first control functionality closes upon the collision.
- the straight line can also be specified by another description known from mathematics.
- failure to execute the movement of the Robo ⁇ terarms results in addition to detect, ie even if no collision came up, but the robot does not move as expected.
- An example is, if the Tool Center Point is to move along a linear path, at least one actual position of the Tool Center Point deviates too much from the corresponding straight line.
- the electronic control device in particular the first
- Control functionality evaluates the movement of the Tool Center Point at the beginning of a movement to obtain the target movement or an invariant associated with the target movement by extrapolating this movement. In this case it can be provided that no information is exchanged between the first and the second control functionality.
- the first control functions from the actual positions may ality during a preferably predetermined amount of time to record, for example, the tool center point and from this the future desired movement of the robot arm extrapo ⁇ lose.
- the basis of the extrapolation can be information about which type of webs are possible in principle, eg linear webs or even circular webs.
- the extrapolation should preferably be completed before the speed of the Tool Center Point becomes so high that potential collisions become dangerous.
- the at least one invariant is associated with a constant setpoint speed of the tool center point during its movement.
- the actual speed and / or the actual acceleration of the Tool Center Point can then be determined and evaluated as at least one derived variable of the actual position of the Tool Center Point.
- the invariant is not fulfilled if the actual speed of the Tool Center Point deviates by a specified value and / or the amount of the actual acceleration of the Tool Center Point exceeds a predetermined value.
- the at least one invariant is associated with a constant desired acceleration of the tool center point during its movement.
- the actual acceleration can and / or the change with time of the actual acceleration of the Tool Center Point is determined and evaluated as at least one derived variable of the actual position of the Tool Center Point.
- the invariant is not fulfilled if the actual acceleration of the Tool Center Point deviates by a predetermined value and / or the amount of the time change of the actual acceleration of the Tool Center Point exceeds a predetermined value.
- no assumptions are made about the entire target path, but only about the local behavior on the target path. For example, a maximum allowable or reasonable curvature of the path along which the Tool Center Point is to move, be accepted. If the curvature increases in a section, it could be a collision.
- the tool center point should move along a desired path.
- the tool center point moves along an actual path.
- the desired path is a curved path.
- the Invari- ante then refers to a maximum curvature of the rümm ⁇ th path, so it is concluded that a collision of the robot arm with the object when an evaluation of the signals of the position sensors results in that the curvature of the actual path exceeds a predetermined value.
- the desired path is a circular path of the tool Center points with a predetermined curvature and the invariant refers to the predetermined curvature. Then, a collision of the robot arm with the object can be concluded, if an evaluation of the signals of the position sensors shows that the curvature of the actual path deviates from the predetermined curvature by a predetermined value.
- the local curvature can be related to the speed, so that the initiation of the safety function due to a larger curvature only occurs when the speed exceeds a certain value. This means that relatively large bends are only allowed at relatively low speeds. Can thus be a function of the speed of the tool center point during movement along the actual web to a collision of the robot arm with the object ge ⁇ closed addition, according to another variant of the method according to the invention.
- the electronic control device can access pre-configured values of the curvature, for example, as part of an ESM (this is the abbreviation for "Event Driven Safety Monitoring", a custom About ⁇ monitoring function) can be defined.
- ESM Event Driven Safety Monitoring
- Another invariant may be that the actual lane can not be reversed. As a result, at least those collisions directed parallel to the web tangent can be detected, which are directed counter to the direction of movement.
- FIG. 1 shows a robot in a perspective illustration
- FIG. 1 shows a robot 1 which has a robot arm 2 and an electronic control device 10.
- the robot arm 2 comprises a plurality of links arranged one after the other and connected by joints.
- the links are in particular a stationary or movable frame 3 and a carousel 4 rotatably mounted relative to the frame 3 about a vertical axis AI.
- Further links of the robot arm 2 are in the case of the present embodiment a rocker 5, a boom 6 and a preferably multi-axis robot hand 7 with an example as a flange 8 running fastening device for attaching an end effector 11th
- the rocker 5 is pivotally mounted at the lower end, for example on a swing bearing head not shown on the carousel 4 about a preferably horizontal axis A2.
- a swing bearing head not shown on the carousel 4 about a preferably horizontal axis A2.
- At the upper end of the rocker 5 is in turn about a likewise preferably horizontal axis A3 of the boom 6 pivotally stored.
- This end carries the robot hand 7 with its preferably three axes A4, A5, A6.
- the robot 1 or its robot arm 2 In order to move the robot 1 or its robot arm 2, it comprises drives which are connected in a generally known manner to the electronic control device 10 (robot control).
- the drives are in particular electric drives, which include electric motors 9. At least the motors or the electric motors 9 are arranged or fastened in or on the robot arm 2. In Fig. 1, only some of the electric motors 9 are shown.
- the drive are preferably regulated electric drives.
- Power electronics of the electric drives are arranged for example within a housing of a control cabinet, not shown, in which, for example, the electronic control device 10 is arranged.
- the electric motors 9 are in the case of the present embodiment, three-phase motors, for example, three-phase synchronous motors.
- the power electronics can also be arranged in and / or on the robot arm 2.
- the electronic control device 10 includes, for example, a processor not shown in detail and may be embodied, for example, as a computer.
- the elekt ⁇ tronic control device 10 is configured such that it comprises a first and a second control functionality Steuerfunkti ⁇ tionality.
- the first control functionality takes over the task of a safety controller and the second control functionality takes over the remaining controls of the Robo ⁇ ters.
- On the electronic control device 10 runs a computer program, a so-called user program, by means of which the control device 10 controls the drives in an automatic operation in the context of the task so possibly controls so that the robot arm 2 and the flange 8 of the robot 1 and a dem Robotarm 2 associated Tool Center Point TCP performs a predetermined movement. This is eg from the second
- the tool center point should move along a desired path.
- the tool center point moves along an actual path.
- the electronic control device 10 in the normal operation of the robot 1 also controls by means of the user program attached to the flange 8 end effector 11.
- the robot 1 or its robot arm 2 further comprises a plurality of position sensors 12 preferably designed as resolvers.
- the position sensors 12 are implemented in a safe manner and are set up to determine the actual angular positions of two adjacent links 3-8 relative to one another ,
- the position sensors 12 are connected to the electronic control device 10 so that it is able to evaluate the signals originating from the position sensors 12. This is done in the case of the present embodiment by means of the first control functionality.
- each one of the axes A1-A6 at least one position sensor 12 is assigned, so that the electronic control device 10 in the proper operation of the robot 1 due to the signals coming from the position sensors 12 information about the actual angular positions of each of the members 3-8 of the robot arm 2 relative to its adjacent member 3-8.
- the electronic control device 10 is also in particular able to determine the actual position and possibly also the actual orientation of the tool center point TCP in the room.
- the electronic control device 10 determines the current one Speed, the current acceleration and / or the change of the current acceleration of the Tool Center Point TCP and / or the individual members 3-8.
- the robot 1 or its electronic control device 10 is set up to check during an actual movement of the robot arm 2, in particular during the movement of the tool center point TCP along an actual path on the basis of the signals originating from the position sensors 12 whether, based on the actual angular positions and / or derived variables of the actual angular positions and / or on the basis of the actual position and / or at least one derived variable of the actual position of the tool center point, at least one target value associated with the actual movement Movement of the robot arm or at least one for the movement of the tool center point TCP along the setpoint Path valid invariant for the actual movement of the robot arm or for the movement of the tool center point TCP along the actual path is met. If the invariant for the actual movement is not met, then the electronic control device 10 concludes that the robot arm 2 has collided with an object 13 and initiates a safety function of the robot.
- the invariant refers to the fact that the desired movement is smooth.
- 10 includes the electronic control device to a collision of the Ro ⁇ boterarms 2 with the object 13 when the third derivative of the actual position of the tool center point TCP to time or a change with time of the actual acceleration of the tool center point TCP a exceeds predetermined value.
- a collision of the robot arm 2 with the object 13 it is also possible for a collision of the robot arm 2 with the object 13 to be inferred if the third derivatives of the actual angular positions after the time or a time-dependent change in the actual accelerations of the actual angular positions exceed a predetermined value.
- the electronic control device 10 controls the robot arm 2 by means of an admittance or a force control.
- the predetermined value may then depend on the stiffness of the admittance or force control.
- the electronic control device 10 can obtain data due to non-secure technology. These are processed with the second control functionality. For example, data used or generated for a control fulfills the criteria not secure data. This data is used, for example, for the current movement of the robot arm 2. As a rule, these data or information can not be evaluated with the first control functionality since they originally originated, for example, from the non-secure user program. In some cases, however, it is possible to obtain information that is otherwise available only in non-secure control using secure technology, based on available secure data about assumptions / models.
- the desired movement of the robot arm 2 is associated with a linear movement of the tool center point TCP.
- the desired movement of the robot arm 2 takes place by means of a path planning carried out by the electronic control device 10. This path planning is carried out in particular by means of the second control functionality.
- the second control functionality of the first control functionality transmits information that a planned linear movement of the tool center point TCP is imminent.
- This information includes in particular an indication of the target start and target endpoints of the Tool Center Points TCP, whereby the first control functionality as Invariant receives the information that the target positions of the Tool Center Point TCP of the upcoming target movement on the target start and target end points run certain straight lines. If at least one of the actual positions deviates from the corresponding target Position during the movement of this line by the predetermined value, the first control functionality closes on the collision.
- collision detection there is also the possibility of detecting faulty execution of the path, ie even if no collision has occurred, but the robot arm does not move as expected. This is illustrated in a table shown in FIG.
- the electronic control device 10 concludes a collision, even if none is present. If there is an additional collision, there are two errors.
- the electronic control device 10 in particular its first control functionality, evaluates the movement of the tool center point TCP at the beginning of a movement in order to obtain the desired path by extrapolating this movement.
- the electronic control device 10 evaluates the movement of the tool center point TCP at the beginning of a movement in order to obtain the desired path by extrapolating this movement.
- no information is exchanged between the first and the second control functionality.
- the first control functionality At the beginning ofspanssaus ⁇ lead, for example, in an acceleration phase, the first control functionality, the movement of the tool center point TCP or members 3-8 to record during a preferably predetermined time period at the start of actual movement of the robot arm 2 and from this the future target extrapolate motion of the Robo ⁇ terarms. 2
- the basis of the extrapolation can be information about which type of webs are possible in principle, eg linear webs or even circular webs.
- the extrapolation should preferably be completed before attempting the speed of the center point TCP tool or the robot arm 2 is so high that potential collisions are ge ⁇ dangerous.
- the desired path is a curved path.
- the invariant then refers to e.g. to a maximum curvature of the curved path, so that a collision of the robot arm 2 is closed with the object 13 when an evaluation of the signals of the position sensors 12 shows that the curvature of the actual path exceeds a predetermined value.
- the desired path of the tool center point TCP is a circular path of the tool center point TCP with a predetermined curvature and the invariant refers to the predetermined curvature. Then a collision of the robot arm with the object can be concluded, if an evaluation of the signals of the position sensors results, that the curvature of the actual path deviates from the predetermined curvature by a predetermined value.
- the local curvature can be related to the speed, so that the initiation of the safety function due to the greater curvature only occurs when the speed exceeds a certain value. This means that relatively larger bends are allowed only at relatively low speeds.
- Another invariant may be that the actual lane can not be reversed. As a result, at least parallel to the web tangent directed collisions can be detected, which are directed against the direction of movement.
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Human Computer Interaction (AREA)
- Manipulator (AREA)
Abstract
Description
Claims
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
DE102015224641.8A DE102015224641A1 (en) | 2015-12-08 | 2015-12-08 | A method for detecting a collision of a robot arm with an object and robot with a robot arm |
PCT/EP2016/079477 WO2017097664A1 (en) | 2015-12-08 | 2016-12-01 | Method for detecting a collision of a robotic arm having an object, and robot having a robotic arm |
Publications (1)
Publication Number | Publication Date |
---|---|
EP3386686A1 true EP3386686A1 (en) | 2018-10-17 |
Family
ID=57460523
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
EP16805122.5A Withdrawn EP3386686A1 (en) | 2015-12-08 | 2016-12-01 | Method for detecting a collision of a robotic arm having an object, and robot having a robotic arm |
Country Status (5)
Country | Link |
---|---|
US (1) | US20190001504A1 (en) |
EP (1) | EP3386686A1 (en) |
CN (1) | CN108367437A (en) |
DE (1) | DE102015224641A1 (en) |
WO (1) | WO2017097664A1 (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113510746A (en) * | 2021-04-27 | 2021-10-19 | 中铁工程装备集团有限公司 | Rapid self-collision detection method with cooperation of multiple mechanical arms |
Families Citing this family (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP7013766B2 (en) * | 2017-09-22 | 2022-02-01 | セイコーエプソン株式会社 | Robot control device, robot system, and control method |
CN109079784B (en) * | 2018-08-16 | 2019-11-19 | 居鹤华 | A kind of multi-axis robot system modelling and control method based on axis invariant |
CN109807196B (en) * | 2019-03-08 | 2020-12-15 | 安徽机电职业技术学院 | Inspection robot |
JP2022527059A (en) * | 2019-03-28 | 2022-05-30 | ジェネシス ロボティクス アンド モーション テクノロジーズ リミテッド パートナーシップ | Collision detection |
US11224972B2 (en) | 2019-11-22 | 2022-01-18 | Fanuc Corporation | State machine for dynamic path planning |
DE102021000741A1 (en) | 2020-03-03 | 2021-09-09 | Sew-Eurodrive Gmbh & Co Kg | Process for operating a machine and system for carrying out the process |
CN111604897B (en) * | 2020-04-15 | 2022-12-02 | 上海钧控机器人有限公司 | Anti-collision safety protection method for moxibustion mechanical arm |
CN111390886B (en) * | 2020-04-23 | 2021-09-03 | 苏州霖怡明机电设备有限公司 | Rotary manipulator |
DE102020133102A1 (en) | 2020-12-11 | 2022-06-15 | Schaeffler Technologies AG & Co. KG | Impact protection safety device for robots |
DE102022112439B3 (en) | 2022-05-05 | 2023-07-27 | Franka Emika Gmbh | Safe robot |
DE102022111226B3 (en) | 2022-05-05 | 2023-07-27 | Franka Emika Gmbh | Encapsulated safety for the operation of a robotic manipulator |
CN116728406A (en) * | 2023-06-15 | 2023-09-12 | 甘肃云梯信息科技有限公司 | Manipulator somatosensory recognition control system based on support vector machine |
Family Cites Families (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB2106279A (en) * | 1981-09-19 | 1983-04-07 | Prutec Ltd | Automated machine safety |
JPH01230107A (en) * | 1988-03-10 | 1989-09-13 | Fanuc Ltd | Method for detecting collision of body to be driven by servomotor |
JP2608161B2 (en) * | 1990-03-29 | 1997-05-07 | ファナック株式会社 | Industrial robot stop control method |
JPH08229864A (en) * | 1995-03-01 | 1996-09-10 | Daikin Ind Ltd | Industrial robot collision detecting method and device thereof |
JP2003236787A (en) * | 2002-02-18 | 2003-08-26 | Kawasaki Heavy Ind Ltd | Drivingly controlling method and drivingly controlling device |
CN100592967C (en) * | 2003-07-29 | 2010-03-03 | 松下电器产业株式会社 | Robot control method and control device |
DE102004026185A1 (en) | 2004-05-28 | 2005-12-22 | Kuka Roboter Gmbh | Method and apparatus for operating a machine, such as a multi-axis industrial robot |
DE102008041602B4 (en) * | 2008-08-27 | 2015-07-30 | Deutsches Zentrum für Luft- und Raumfahrt e.V. | Robot and method for controlling a robot |
DE102008054312A1 (en) * | 2008-11-03 | 2010-05-06 | Kuka Roboter Gmbh | Method and device for reliable detection of a kinematic variable of a manipulator |
US20160008979A1 (en) * | 2013-03-07 | 2016-01-14 | Abb Technology Ag | Method for checking a robot path |
CN103722565B (en) * | 2014-01-23 | 2015-09-16 | 哈尔滨工业大学 | Anthropomorphic robot self collision monitoring system and method for supervising |
CN105004368B (en) * | 2015-06-29 | 2018-03-20 | 深圳乐动机器人有限公司 | A kind of collision checking method of autonomous robot, apparatus and system |
WO2017044686A1 (en) * | 2015-09-09 | 2017-03-16 | Carbon Robotics, Inc. | Robotic arm system and object avoidance methods |
JP6690213B2 (en) * | 2015-12-09 | 2020-04-28 | セイコーエプソン株式会社 | Robots, controllers and robot systems |
-
2015
- 2015-12-08 DE DE102015224641.8A patent/DE102015224641A1/en not_active Ceased
-
2016
- 2016-12-01 CN CN201680071924.8A patent/CN108367437A/en active Pending
- 2016-12-01 WO PCT/EP2016/079477 patent/WO2017097664A1/en unknown
- 2016-12-01 US US15/781,927 patent/US20190001504A1/en not_active Abandoned
- 2016-12-01 EP EP16805122.5A patent/EP3386686A1/en not_active Withdrawn
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113510746A (en) * | 2021-04-27 | 2021-10-19 | 中铁工程装备集团有限公司 | Rapid self-collision detection method with cooperation of multiple mechanical arms |
CN113510746B (en) * | 2021-04-27 | 2022-03-29 | 中铁工程装备集团有限公司 | Rapid self-collision detection method with cooperation of multiple mechanical arms |
Also Published As
Publication number | Publication date |
---|---|
CN108367437A (en) | 2018-08-03 |
DE102015224641A1 (en) | 2017-06-08 |
US20190001504A1 (en) | 2019-01-03 |
WO2017097664A1 (en) | 2017-06-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2017097664A1 (en) | Method for detecting a collision of a robotic arm having an object, and robot having a robotic arm | |
EP2347309B1 (en) | Method and device for reliably capturing a kinematic parameter of a manipulator | |
EP1366867B1 (en) | Method and device for avoiding collisions between industrial robots and other objects | |
EP3297794B1 (en) | Method and device for open-loop/closed-loop control of an actuator-driven robot joint | |
EP2989369B1 (en) | Apparatus and method for safeguarding an automatically operating machine | |
EP2205409B1 (en) | Manipulator, particularly industrial robot, having a redundant sensor arrangement, and method for the control thereof | |
EP1445075B2 (en) | Method for monitoring a robot and robot with monitoring means | |
EP2838698B2 (en) | Robot arrangement and method for controlling a robot | |
DE102010044644B4 (en) | Method for collision detection for a drive unit | |
DE102017001298B4 (en) | Robot simulation device that calculates a swept room | |
DE102007059480B4 (en) | Method and device for pose monitoring of a manipulator | |
WO2006103249A2 (en) | Method and control device for the targeted reaction in the event of contact between a machine element pertaining to a machine and an object | |
EP2946256B1 (en) | System, in particular a production system | |
DE102016014989B4 (en) | Collision monitoring of a robot | |
WO2008025577A1 (en) | Method and device for monitoring a machine element to prevent its collision with an object in a machine tool, a production machine and/or a machine that is configured as a robot | |
DE102017204211B4 (en) | Robot control and robot control method | |
WO2015158612A1 (en) | Robot device with a linear axis | |
WO2017080649A2 (en) | Sensitive robots using sensor technology arranged before the first robot axis | |
EP3244981B1 (en) | Amusement ride having a robot assembly | |
AT524080B1 (en) | Device and method for detecting speeds of arm segments of a robot | |
DE102020129823B4 (en) | Visualization of a protective field | |
EP3988256A1 (en) | Securing of a movable part of a machine | |
EP3827934A1 (en) | Computer program product robot and method for controlling a robot |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: UNKNOWN |
|
STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: THE INTERNATIONAL PUBLICATION HAS BEEN MADE |
|
PUAI | Public reference made under article 153(3) epc to a published international application that has entered the european phase |
Free format text: ORIGINAL CODE: 0009012 |
|
STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: REQUEST FOR EXAMINATION WAS MADE |
|
17P | Request for examination filed |
Effective date: 20180522 |
|
AK | Designated contracting states |
Kind code of ref document: A1 Designated state(s): AL AT BE BG CH CY CZ DE DK EE ES FI FR GB GR HR HU IE IS IT LI LT LU LV MC MK MT NL NO PL PT RO RS SE SI SK SM TR |
|
AX | Request for extension of the european patent |
Extension state: BA ME |
|
DAV | Request for validation of the european patent (deleted) | ||
DAX | Request for extension of the european patent (deleted) | ||
STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: EXAMINATION IS IN PROGRESS |
|
STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: EXAMINATION IS IN PROGRESS |
|
17Q | First examination report despatched |
Effective date: 20200922 |
|
STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: THE APPLICATION IS DEEMED TO BE WITHDRAWN |
|
18D | Application deemed to be withdrawn |
Effective date: 20210203 |
|
P01 | Opt-out of the competence of the unified patent court (upc) registered |
Effective date: 20230528 |