EP3826812B1 - Method and control system for calibrating a handling device - Google Patents
Method and control system for calibrating a handling device Download PDFInfo
- Publication number
- EP3826812B1 EP3826812B1 EP19725330.5A EP19725330A EP3826812B1 EP 3826812 B1 EP3826812 B1 EP 3826812B1 EP 19725330 A EP19725330 A EP 19725330A EP 3826812 B1 EP3826812 B1 EP 3826812B1
- Authority
- EP
- European Patent Office
- Prior art keywords
- arms
- tool head
- movable
- arm
- upper 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims description 128
- 230000033001 locomotion Effects 0.000 claims description 83
- 238000001514 detection method Methods 0.000 claims description 14
- 238000004519 manufacturing process Methods 0.000 claims description 6
- 238000012986 modification Methods 0.000 claims description 2
- 230000004048 modification Effects 0.000 claims description 2
- 230000001360 synchronised effect Effects 0.000 claims description 2
- 230000008569 process Effects 0.000 description 18
- 239000000725 suspension Substances 0.000 description 11
- 230000008878 coupling Effects 0.000 description 9
- 238000010168 coupling process Methods 0.000 description 9
- 238000005859 coupling reaction Methods 0.000 description 9
- 238000013461 design Methods 0.000 description 5
- 230000008901 benefit Effects 0.000 description 4
- 235000013361 beverage Nutrition 0.000 description 4
- 210000000245 forearm Anatomy 0.000 description 4
- 230000003287 optical effect Effects 0.000 description 4
- 238000004806 packaging method and process Methods 0.000 description 4
- 230000001953 sensory effect Effects 0.000 description 4
- 230000000694 effects Effects 0.000 description 3
- 238000013459 approach Methods 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 238000011423 initialization method Methods 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 238000012544 monitoring process Methods 0.000 description 2
- 238000005192 partition Methods 0.000 description 2
- 238000012360 testing method Methods 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 1
- 239000004566 building material Substances 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000018109 developmental process Effects 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 230000001788 irregular Effects 0.000 description 1
- 210000004258 portal system Anatomy 0.000 description 1
- 238000003825 pressing Methods 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 230000001960 triggered effect Effects 0.000 description 1
- 210000000623 ulna Anatomy 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1679—Programme controls characterised by the tasks executed
- B25J9/1692—Calibration of manipulator
-
- 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/1615—Programme controls characterised by special kind of manipulator, e.g. planar, scara, gantry, cantilever, space, closed chain, passive/active joints and tendon driven manipulators
- B25J9/1623—Parallel manipulator, Stewart platform, links are attached to a common base and to a common platform, plate which is moved parallel to the base
-
- 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/085—Force or torque sensors
-
- 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
-
- 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/39—Robotics, robotics to robotics hand
- G05B2219/39024—Calibration of manipulator
-
- 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/40—Robotics, robotics mapping to robotics vision
- G05B2219/40267—Parallel manipulator, end effector connected to at least two independent links
-
- 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/42—Servomotor, servo controller kind till VSS
- G05B2219/42304—Load, torque threshold as function of speed
-
- 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/50—Machine tool, machine tool null till machine tool work handling
- G05B2219/50391—Robot
Definitions
- the present invention relates to a method for referencing, calibrating and/or initializing a handling device, in particular a parallel kinematic robot also known as a so-called tripod, according to the features of independent method claim 1.
- the invention also relates to a program-controlled handling device with the features of claim 10 , in particular a program-controlled handling and/or parallel kinematics robot with a tool head suspended on at least two parallel kinematically movable arms, which is equipped with a control system which is particularly equipped and suitable for carrying out the method and which is used for referencing, calibration and/or the Initialize a handling device or a parallel kinematics robot is used.
- stackable and/or palletizable objects such as packages or bundles made up of several individual items, which can be formed from interconnected beverage containers, for example
- the objects are usually transported using horizontal conveyor systems with conveyor belts which the piece goods or containers are conveyed to a handling facility in an uninterrupted or irregular sequence.
- different methods are used for turning piece goods or containers, which can have, for example, suitable movable stops or two belts with different speeds.
- Grippers can also be provided with grippers that can be suspended from a portal system, for example, and moved, rotated and also moved in the vertical direction within a defined range of movement in order to be able to lift individual piece goods or containers for rotating and/or moving.
- the Grippers can also be arranged, for example, on multi-axis robot arms that are placed on the side of the horizontal conveyor devices.
- the handling of piece goods or bundles includes lifting, moving and/or aligning and bringing or transferring the respective piece goods or bundle into a desired position or orientation within a grouping suitable for stacking and/or palletizing.
- the known prior art already offers numerous gripping devices with gripping arms that can be adjusted against one another, such as, for example, the EP 2 388 216 A1 .
- Another gripping device shows, for example, the DE 102 04 513 A1 .
- One gripper arm is displaceable in relation to another gripper arm by means of an actuator, so that both gripper arms can be closed.
- gripping sections for gripping packages of building materials are provided on the sides facing one another.
- each of the arms of such a tripod or delta robot consists of an upper arm arranged on the base such that it can be pivoted about a pivot axis which is fixed to the frame, and a lower arm which is articulated to the upper arm and the coupling element.
- the lower arm is passive, running without a drive for pivoting it in relation to the upper arm or the coupling element.
- One or more of the lower arms can be connected to the associated upper arms and the coupling element, for example via ball joints.
- Such a single forearm is freely pivotable and has no intrinsic stability.
- All of the upper arms of a delta robot are mounted so that they can be pivoted and driven about pivot axes that preferably lie within a common plane. In every position, three forearms connected to the coupling element and each to their associated upper arm form a force triangle that can only be moved if the three upper arms synchronously execute the pivoting movements calculated for them about their pivot axes fixed to the frame.
- Two or more pivot axes can run parallel; as a rule, all pivot axes have two points of intersection with other pivot axes.
- At least one of the forearms can consist of two linkage elements, which can also be referred to as ulna and spoke and thus form a parallelogram linkage, in order to guide the coupling element in at least one predetermined orientation relative to the base.
- the coupling element serves as a work platform or tool head, which is also referred to as a tool center point (TCP) in practice.
- TCP tool center point
- a manipulator can be arranged on this tool head or TCP, e.g.
- the manipulator arranged on the work platform, the tool head or the TCP can optionally be rotatably mounted in order to align the manipulator or to be able to perform a desired rotation of the articles or piece goods.
- rotatably mounting the manipulator on the coupling element it is basically also conceivable to arrange the manipulator non-rotatably on the coupling element and to rotate the entire coupling element with a corresponding compensating movement of the arms by means of the telescopic shaft relative to the base.
- the parallel kinematic robots often used as handling robots have a very high positioning accuracy due to their precise controllability and the pronounced rigidity of the interacting movable actuating arms and can also be operated at very high positioning speeds.
- the actuator arms which are generally driven by electric motors, require a calibration of all existing drives in order to function properly, so that the control commands can also be converted into appropriate actuating movements. If there is no calibration or there is insufficient calibration, there would be a risk, especially after a restart of the system, that the control system would not have exact position values for the respective electric motor drives, which would also call into question the exact positioning of the drives.
- a new calibration of the system is therefore indispensable after every system restart, but also after every restart.
- the goal of such a calibration process is to adjust each of several electric motor-driven actuator arms of the parallel kinematic robot to move against a mechanical stop. Since this mechanical stop at the same time forms an end position within the range of movement of the actuating arm in question, the position thus determined can be recorded as part of the calibration process and transmitted to the control system as the end position.
- a calibration procedure that makes sense in practice requires the machine to be shut down, for example by pressing an emergency stop switch, because only then can a safety partition of the machine, which has to protect against unwanted manual intervention, be unlocked and opened.
- a safety partition which can be formed by a partially glazed enclosure known per se, usually has doors or flaps or the like, which can only be opened when the handling device is shut down.
- a calibration device which can be formed, for example, by a bolt that can be inserted within the pivoting range of an upper arm of the parallel kinematic robot, can then be inserted and secured in its intended position. Then, after the previously opened doors or flaps have been closed, the calibration process can be started by pivoting the upper arm, which can be pivoted by an electric motor, against the latch and thus assuming a defined end position of the upper arm. Since these calibration processes usually have to be carried out by two people and have to be repeated for each upper arm after the manually insertable bolt has been repositioned, the entire process is very time-consuming. In addition, there remains the risk that mechanical damage may occur to the handling device after a calibration that has been carried out incorrectly or incompletely.
- a parallel-arm robot with facilities for calibrating the position of actuator arms goes out of the DE 10 2013 014 273 B4 out.
- individual drive arms are pivoted to predetermined reference positions during position calibration, while position signals from rotation detectors of the arms are used to identify the original positions of the drive motors.
- the calibration devices used work with dial gauges, to which the drive arms are placed.
- the primary objective of the present invention can be seen as providing an improved calibration method that can be carried out in particular with less personnel and time expenditure, as well as a corresponding control system that not only leads to more reliable results, but that is also reproducible at any time, so that calibration errors caused by incorrect manual operation can be almost completely ruled out.
- the present invention proposes a method for referencing, calibrating and/or initializing a handling device, in particular a handling and/or parallel kinematic robot with a tool head suspended on at least two parallel kinematically movable arms, which has the following features and method steps includes.
- a movable and adjustable drive connection is provided between a stationary drive motor and the tool head, which can be moved about at least one axis of rotation, with the movable drive connection being provided in particular by a length-variable and/or articulated cardan shaft can be formed.
- each of the at least two arms includes an upper arm that can be moved by motor around a defined upper arm pivot axis between two end positions, and a lower arm that is pivotably mounted on the upper arm.
- These arms hold the tool head, which is movably suspended on the at least two lower arms and can be moved within a defined movement space by means of program-controlled and coordinated pivoting movements of the upper arms and the lower arms guided thereby.
- this can be a gripper arm with two grippers or gripper jaws that can be moved towards one another for grasping, lifting, moving, relocating or otherwise manipulating articles, objects, piece goods, bundles or groups of several such articles, objects, piece goods, bundles be, wherein the gripper arm is preferably configured rotatable as a whole with the grippers or gripper jaws that can be advanced towards one another.
- Both the upper arms, which can be moved around horizontal axes, and the drive shaft responsible for the rotational movements of the tool head are typically operated by electric motors, so that with both types of drive, referencing, calibration and/or re-initialization after a machine standstill, after a power failure, a shutdown and/or a renewed Starting a control device of the exact positions of the drive units is necessary in order to be able to ensure the desired precise setting and manipulation movements of all moving and driven elements and components of the handling and/or parallel kinematics robot.
- a first method step the load torques acting on the upper arm pivot axes are detected and the respective load torques acting on the at least two upper arms are compared and/or signals from position and /or angle sensors are adjusted by means of the motor drives to correspond in each case to the angular positions of the at least two upper arms.
- the central control unit responsible for controlling the motorized drives of the at least two upper arms is switched on and the control program is started, which, for example, requires some time for the program to start after a switch-off phase.
- all motor drives are also initialized and referenced in this starting phase in order to be able to convert every control command for driving the servomotors into drive movements that are as precise as possible.
- the primary goal is to find a central position for the tool head within its movement and/or manipulation space, which, due to a lack of optical or other position control can be done most sensibly by detecting the load moments acting on the upper arms, alternatively or additionally by evaluating signals from position and/or angle sensors.
- the upper arms When evaluating the load moments, the upper arms can be moved or moved up and down one after the other until they are within a hysteresis range of their load moments of less than one Newton meter, preferably less than 0.5 Nm, in particular approx. 0.3 Nm. have a matching load moment.
- the angular positions set on the upper arms by means of their drive motors both have minimum difference angles to the two end positions and also define a location of the tool head that is within a defined distance from an approximately central position within the movement space.
- the signals from the position and/or angle sensors assigned to the upper arms can be evaluated directly, this signal evaluation must be used to ensure that the angular positions set on the upper arms by means of their drive motors have both minimum difference angles to the two end positions and also a location of the tool head define, which is within a defined distance to an approximately central position within the movement space.
- both sensor variants which can optionally also be combined with one another, it can therefore be assumed that the tool head stands or hangs almost in the middle within the movement space and between the at least two movable arms after this procedure of the first method step.
- Such a parallel kinematics or handling robot which is the subject of the referencing, calibration and/or initialization method according to the invention, very often has three of the same dimensioned upper arms arranged at an angle of 120° to one another, each with identical lower arms and a tool head suspended between them so that it can move and/or rotate.
- Such so-called tripods are frequently used in practice and are excellently suited for precise movement control, for example for manipulating articles, objects, piece goods, bundles or for manipulating groups with several such articles, objects, piece goods, bundles.
- this suitability for tripods should not be understood as limiting, since the method is also suitable for parallel kinematic robots or handling robots with two arms of the same type or those with four or more movable arms.
- a second method step following the first method step described above moves the at least two upper arms by simultaneous and/or approximately synchronous pivoting about their respective pivot axes up to a limit position, which is determined by a mechanical stop of the drive connection, which can be moved independently of the upper arms, and/or by a longitudinal stop of the cardan shaft is defined to the tool head, after which in a third step of the tool head and / or its associated drive connection or cardan shaft by moving back the at least two upper arms u m a defined swivel angle is/are distanced from the limit position.
- the primary purpose of these second and third method steps is to find or define a stop for the longitudinal adjustability of the drive connection or cardan shaft, which should be done with the tool head centered approximately in the area of its vertical axis, which can be achieved by approximately the same angular positions of the upper arms .
- the tool head can be brought into a defined position by lowering or raising the upper arms the longitudinally adjustable drive connection or Cardan shaft still has enough room for adjustment - either upwards by reducing its length or downwards by lengthening it - in order not to reach its mechanical stop again after small adjustment movements in the subsequent process steps.
- the result of the second and third method steps is that the set angular positions of the at least two upper arms each have defined difference angles to the two end positions and/or define a location of the tool head that is within a defined distance from an approximately central position within the movement space.
- At least one of the at least two upper arms, in particular the three upper arms present, of the handling device or the handling robot is brought into one of its two end positions by motorized pivoting about its upper arm pivot axis, with the achieved angular position is detected by sensors and used for position and/or angle initialization of the respective upper arm. If at this point a sensory detection of the angular positions is mentioned, this in turn means a detection of load moments and/or angle values by means of angle sensors.
- absolute encoders can be read out, or different position sensors can be used and their signals evaluated.
- the respective upper arm can then be moved back from its previously set end position into a defined angular position and/or approximately into the previously assumed starting angular position.
- the drive units of the upper arms can be referenced in their respective positions.
- the upper end stops of the upper arms are normally suitable as the end positions of the upper arm pivoting movements selected for carrying out the fourth method step, which therefore also serve as reference positions for the referencing of the upper arm drive units.
- lower end stops of the upper arms can also be approached, which can also be used as reference positions for referencing the upper arm drive units.
- a fifth method step Since not only one of the upper arms, but the at least one other or the two, three or more other upper arms are to be referenced in the same way in a fifth method step, another of the at least two upper arms of the handling device or of the handling robot is brought into one of its two end positions or optionally into the same of the two end positions that was also selected in the fourth method step, by motorized pivoting about its upper arm pivot axis, the angular position thereby achieved is detected by sensors and used to initialize the position and/or angle of the affected upper arm.
- the upper arm is moved back from its end position reached in connection with the implementation of the fifth method step into the starting angular position previously assumed.
- a sixth method step that follows the fifth method step and is optional or necessary for a tripod as the handling robot, a third of a total of at least three existing upper arms of the handling device or the handling robot can be moved through motorized pivoting about its upper arm pivot axis is brought into one of its two or into the same of the two end positions, which was also selected in the fourth and fifth method step for the respective pivoted other upper arms, whereby here again the angular position reached in the end position is detected by sensors and is used for position and/or angle initialization or for referencing the swivel positions of the affected upper arm.
- this sixth method step can provide that the upper arm previously moved into its end position is moved back from its end position approximately into the previously assumed starting angular position.
- a fourth of a total of at least four existing upper arms of the handling device or of the The handling robot can be brought into one of its two end positions or into the same one of the two end positions by motorized pivoting about its upper arm pivot axis, which was also selected in the fourth, fifth and sixth method step for the other pivoted upper arms, with the angular position achieved here again is detected by sensors and used to initialize the position and/or angle of the affected upper arm. Possibly also in connection with the seventh Method step can be provided that the upper arm previously moved into its end position is moved back from its end position approximately into the previously assumed starting angular position.
- Such a torque limitation makes it possible to reliably detect an existing mechanical stop for each of the pivoting movements of the motor-driven upper arms that are carried out, without any optical or other sensory movement detection.
- a torque limit can be set for all movements of the axes that are carried out as part of a calibration and/or referencing process.
- Such a torque limit does not have to be fixed, but can be used and used in an advantageous manner for different angular positions and associated different torque values in a movement sequence due to the permanent dynamic possibility of change. This also results in the universal applicability and functionality of the referencing described, even with different grippers or tripod robots, which can be equipped, for example, with differently dimensioned arms and/or tool heads that are dimensioned differently and therefore have different weights.
- This determined torque can be used, for example, to set a suitable torque limit for the subsequent calibration process on the basis of this value, possibly plus a reasonable addition of, for example, 1.5 newton meters. This can be determined during the process of centering the tool head Sufficient torque to move the tool head to the center of its range of motion without exceeding this torque limit.
- the method can provide that an iterative torque detection is provided when pivoting (moving up) in the direction of the selected end position of at least one of the upper arms at its respective end stop.
- an iterative torque detection is provided when pivoting (moving up) in the direction of the selected end position of at least one of the upper arms at its respective end stop.
- the method according to the invention can also provide that while the second and/or third and/or fourth and/or fifth and/or sixth and/or seventh method steps and the corresponding motor movements of the upper arms are being carried out, one is repeated permanently and/or at defined time intervals
- the respective angular positions of the upper arms are detected, falling below a predetermined differential value for successively measured angular positions of a respective upper arm is recognized as a mechanical stop and/or end stop for the respective upper arm concerned.
- Such an angle and/or position limitation makes it possible, with simple sensory means, to reliably detect an existing mechanical stop for each of the pivoting movements of the motor-driven upper arms that are carried out. In this way, a position or Be set angle limit, which can be used and used for different angular positions in a movement. This also results in the universal applicability and functionality of the referencing described, even with different grippers or tripod robots, which can be equipped, for example, with differently dimensioned arms and/or tool heads that are dimensioned differently and therefore have different weights.
- Iterative angle detection when pivoting in the direction of the selected end position of at least one of the upper arms at its respective end stop can provide the advantage that any mechanical damage is avoided when the respective end stop is reached, since this is reached at a low adjustment speed. As a result, when the method is being carried out, it can be continuously recognized whether an end position and thus a mechanical stop has already been reached.
- This further mechanical stop can also be integrated into the method according to the invention or taken into account in the process, in that the current torque of each individual upper arm is first determined for all pivoting movements and also when driving against the longitudinal stop of the cardan and plus a reasonable addition of e.g. a value of around 1.5 Nm is set as the torque limit.
- the tripod robot or parallel kinematic robot can be released again as the next process step.
- a further embodiment variant of the method according to the invention can have an alternative and/or further method step in which, in addition to the calibration steps of the pivotable upper arms described above, a rotational position of the tool head suspended on the at least two parallel-kinematically movable arms is calibrated by rotating the tool head about a vertical or opposite to the vertical slightly inclined axis of rotation, the tool head is brought into a defined rotational position within the movement space with a known position and/or alignment of the at least two movable arms and is moved to a defined distance from an object and/or fixed contact point and then by rotating the tool head in contact with this object and/or brought to the contact point and the new rotational position reached in the process is recorded and processed for calibrating the rotary drive of the tool head.
- the robot can be moved from any position to approximately the middle of its working area.
- the upper arms are then raised up to the mechanical stop of the telescopic cardan joint, if one is available. If there is no telescoping cardan shaft, a defined limit torque can also serve as a useful positioning aid for a central position of a tool head suspended from the movable arms. Once this is done, all upper arms are in one position driven to then in turn move each individual upper arm axis against its mechanical end stop. In this way, a considerable reduction in the required personnel work and time expenditure can be achieved, for which a calibration typically only has to be pressed on a control unit. A fully automatic calibration of the tripod or the parallel kinematics robot can then take place.
- the present invention also proposes a program-controlled handling device, in particular a program-controlled handling and/or parallel kinematics robot with a tool head suspended on at least two parallel kinematically movable arms, with each of the at least two arms pivoting about a defined upper arm pivot axis comprises an upper arm that can be moved by motor between two end positions and a lower arm that is pivotably mounted on the upper arm, and wherein the arms hold the tool head that is movably suspended on the at least two lower arms and has a movable drive connection, in particular a length-variable and/or articulated cardan shaft between a stationary drive motor and the has a tool head movable about at least one axis of rotation, and by means of program-controlled and coordinated pivoting movements of the upper arms and the lower arms guided thereby within a defined rt movement space is movable.
- a program-controlled handling device in particular a program-controlled handling and/or parallel kinematics robot with a tool head suspended on at least two parallel kine
- control programs for controlling all movements of the at least two movable arms are stored in a central control unit and include a referencing, calibration and/or initialization program or multiple referencing, calibration and/or initialization programs that are used to carry out a of the method variants described above are provided and suitable.
- the program-controlled handling device characterized in this way or the handling and/or parallel kinematics robot can, for example as a handling and/or positioning robot, be part of a conveying, stacking and/or palletizing device, in particular for conveying, handling, stacking and/or for Palletizing piece goods and/or containers.
- the program-controlled handling device or the handling and/or parallel kinematics robot can also function as a handling and/or manipulation robot as part of a production and/or Form workpiece treatment device that can be used in particular for the production, treatment and / or modification of workpieces in a manufacturing environment.
- the schematic perspective view of the 1 FIG. 12 illustrates, by way of example, a machine environment 8 in which a handling device to be calibrated according to the present invention, formed in particular by a parallel kinematics robot, can be used.
- the machine environment shown which can in particular be part of a conveying, handling and/or palletizing machine for treating containers with several beverage containers, comprises a horizontal conveyor device 10 in the exemplary embodiment shown, on which packaged or piece goods, not shown here, such as containers, are transported in the transport direction 12 with a plurality of beverage containers each combined by an outer packaging are conveyed one after the other to a handling station 14, which has a level support and transport surface 16 for the packaged goods, piece goods or bundles, which in the transport direction 12 immediately follows the horizontal conveyor device 10, which is used for further transport of the packaged goods , piece goods or bundles is used in the transport direction 12, and which is at least large enough for the packaged goods, piece goods or bundles to be grasped, moved, rotated and can be positioned in the desired manner in order to form a
- layer pattern can then be transported further in the transport direction 12 and from the Support and transport surface 16 are transferred to a downstream conveyor surface 20, where any gaps that may still exist between the packaged goods, piece goods or bundles brought into the layer pattern are filled by means of contact beams 22 and/or that can be displaced transversely to the transport direction 12 and horizontally in the direction of the side edges of the layer pattern can be closed by pushing together the packaged goods, piece goods or bundles by means of at least one contact beam 22 that can be raised and lowered and thus brought transversely to the transport direction 12 .
- the layered arrangements formed in this way from the packaged goods, piece goods or bundles manipulated and arranged by means of the handling device 18 in the handling station 14 can preferably be stacked in layers on top of one another in a palletizing station which is located downstream of the conveying surface 20 but is not shown here and placed on a pallet for further packaging, handling and /or stored for transport and made accessible for shipping.
- the handling device 18 movably suspended in the handling station 14 is formed in the exemplary embodiment shown by a handling and/or parallel kinematic robot 24, which is equipped with three parallel kinematically movable arms 26 and a tool head 28 movably suspended thereon.
- the total of three movable arms 26 each comprise an upper arm that can be moved by motor about a defined upper arm pivot axis between two end positions and a lower arm that is pivotably mounted on the upper arm, which is shown in FIG 1 however, cannot be identified in detail.
- the arms 26 hold the tool head 28, which is movably suspended on the three lower arms and can be moved within a defined movement space 30 in the area of the support and transport surface 16 by means of program-controlled and coordinated pivoting movements of the upper arms and the lower arms guided thereby.
- the grippers or gripper jaws which are arranged on the tool head 28 and can be advanced towards one another for gripping, lifting, moving, transferring or otherwise manipulating the packaged goods, piece goods or bundles, whereby the gripper arm that can be used in this way is designed to be rotatable as a whole with the grippers or gripper jaws that can be advanced towards one another.
- rotational movements can be initiated and controlled, in particular, by means of a cardanically movable drive shaft 30 which leads downwards in a vertical or oblique direction from an upper suspension 32 of the parallel kinematics robot 24 to the tool head 28 .
- the upper suspension 32 on which the upper arms of the movable arms 26 and their drive motors are mounted, as well as the at least one drive motor for the cardan shaft or drive shaft 30, forms an upper part of a frame 34 of the handling station 14.
- the entire handling device 18 or the parallel kinematics robot 24 are held on this upper suspension 32 and movably mounted in the manner described.
- a conventional design for such parallel kinematics robots 24 provides pivot mountings for the total of three movable arms 26 on the upper suspension 32, with the upper arms 36 each being able to be moved about horizontal pivot axes 38 which are arranged below the upper suspension 32.
- Both the upper arms 36, which are movable about the horizontal pivot axes 38 and on which the lower arms 40 holding the tool head 28 are pivotably arranged, as well as the drive shaft 30, which is responsible for the rotational movements of the tool head 28 and the gripper jaws arranged thereon (not illustrated), are typically operated by an electric motor.
- the respective drive motors 42 for the upper arms 36 and 44 for the drive shaft 30, which are anchored in the upper suspension 32 are explained in more detail below Figures 2A to 2H are clearly recognizable.
- a particular advantage of the electric drive motors 42 and 44 used for the handling device 18 is, on the one hand, the high setting precision that can be achieved with them, as required for the exact guidance of the tool head 28 within the movement space above the support and transport surface 16 of the handling station 14 (cf. 1 ) is desirable.
- the drive motors 42 and/or 44 used show the special feature that with this drive variant, after a machine standstill, after a power failure, after a shutdown and/or after a restart, a calibration of a control device of the exact positions of the drive units is necessary in order to achieve the desired to be able to ensure precise setting and manipulation movements of all movable and driven elements and components of the handling and/or parallel kinematics robot 24 .
- the parallel kinematic or handling robot 24, which is the subject of the calibration method according to the invention, in the exemplary embodiment shown has three equally dimensioned upper arms 36, each arranged at a 120° angular offset to one another, each with identical lower arms 40 and movable in between and/or or has a rotatably suspended tool head 28 .
- Such so-called tripods are often used in practice and are excellently suited for precise movement control, for example for manipulating articles, objects, piece goods, bundles or for manipulating groups with several such articles, objects, piece goods, bundles, as above already referring to the 1 was explained.
- the tool head 28 can basically be in any position after it has been switched off and after it has been switched on again and a power supply restored, at least for the servomotors 42 of the upper arms 36, which is based on the Figure 2A it is clear where the tool head 28 is shifted to the right in the illustration, which is accompanied by two lowered upper arms 36 and a slightly raised upper arm 36 .
- any other position of the movable arms 26, the drive shaft 30 and the tool head 28 movably mounted on the lower arms 40 can be the starting position for the calibration method according to the invention, provided such a position can be reached with the maximum possible pivoting movements of the upper arms 36 .
- a first process step (cf. Figure 2B ) by establishing an approximately central position of the tool head 28 and an approximately vertical drive shaft 30 by detecting the load moments acting on the upper arm pivot axes 38 and by comparing the respective load moments acting on the total of three upper arms 36 by means of the motor drives 42 moving the upper arms 36 in each case approximately matching angular positions of all three upper arms 36 set.
- the load torques can be calculated very precisely from the 42 expended electrical currents are obtained, so that in the Figure 2B clarified approximately horizontal position of all three upper arms 36 can be adjusted.
- a central control unit responsible for controlling the motorized drives 42 of the upper arms 36 is switched on and the control program implemented there is started, which, for example, after a switch-off phase, requires a certain amount of time to start the program.
- all motor drives 42 are also initialized and referenced in this starting phase, in order to be able to convert each control command for driving the servomotors 42 into drive movements that are as precise as possible.
- the primary goal which is characteristic of the calibration method according to the invention, is to find an approximately central position for the tool head 28 within its movement and/or manipulation space, which, in the absence of optical or other position control, is most useful by detecting the load moments acting on the upper arms 36 can take place when the tool head 28 is unloaded.
- the upper arms 36 can, if necessary, be adjusted one after the other by relatively small adjustment angles or moved up and down until they have a matching load moment within a sensible hysteresis range of their load moments of, for example, less than one Newton meter.
- This useful hysteresis range which can be used advantageously in practice, can also be less than 0.5 Nm, in particular less than approx can be recognized or accepted.
- the angular positions set on the upper arms 36 by means of their drive motors 42 both have minimum difference angles to the upper and lower end positions and also define a location of the tool head 28 that is within a defined distance from an approximately central position within its range of motion is located. It can therefore be assumed that after this setting procedure of the first method step, the tool head 28 stands or hangs almost in the middle within the movement space and between the three movable arms 26 of the parallel kinematic robot 24 .
- the tool head 28 according to FIG Figure 2E gradually be lowered again until appropriate Figure 2F again a position with approximately horizontal upper arms 36 has been reached.
- a first method step immediately (if there is no drive shaft 30) or after going through the intermediate steps described (cf. Figures 2D through 2F ) following
- a further method step which is referred to here as the second method step, one of the total of three upper arms 36 of the handling robot 24 is brought into one of its two end positions, namely the upper end position (cf. Figure 2H ), whereby the extreme angular position reached in this way is detected by sensors and used to initialize the position and/or angle of the respective upper arm 36.
- the respective upper arm 36 can be moved back from its previously set upper end position approximately into the previously assumed initial angular position, which is the orientation of the arms 26 according to Figure 2G is equivalent to.
- the drive units 42 of the upper arms 36 can each be referenced in their positions.
- the upper end stops of the upper arms 36 are particularly suitable as the end positions of the upper arm pivoting movements selected for carrying out the second method step, which thus also serve as reference positions for the referencing of the upper arm drive units 42.
- a third method step another upper arm 36 of the handling device 18 or of the handling robot 24 can be brought into the same by motorized pivoting about its upper arm pivot axis 38 both end positions are brought, which are also in the second process step ( Figure 2H ) was selected, with the angular position reached being detected by sensors and used to initialize the position and/or angle of the upper arm 36 in question. Also here it is to be provided that the upper arm returns from its end position reached in connection with the implementation of the third method step approximately into the previously assumed starting angular position ( Figure 2G ) is moved back. The same applies to the third upper arm 36, which is to be referenced and calibrated in the same way in a fourth method step following the third method step.
- Such a torque limitation makes it possible to reliably detect an existing mechanical stop for each of the pivoting movements of the motor-driven upper arms carried out only on the basis of detecting the electrical currents to be applied and without any optical or other sensory motion detection, with this mechanical stop usually being characterized by a torque limit.
- a torque limit does not have to be fixed, but can be used and used in an advantageous manner for different angular positions and associated different torque values in a movement sequence due to the permanent dynamic possibility of change. This also results in the universal applicability and functionality of the referencing described, even with different grippers or tripod robots, which can be equipped, for example, with differently dimensioned arms and/or tool heads that are dimensioned differently and therefore have different weights.
- This determined torque can, for example be used to set a suitable torque limit for the subsequent calibration process on the basis of this value, if necessary plus a reasonable addition of, for example, 0.5 to about 1.5 Nm. During the process of centering the tool head, this determined torque can be sufficient to move the tool head to the center of its range of motion without exceeding this torque limit.
- the method can provide that an iterative torque detection is provided when pivoting (moving up) in the direction of the selected end position of at least one of the upper arms at its respective end stop.
- an iterative torque detection is provided when pivoting (moving up) in the direction of the selected end position of at least one of the upper arms at its respective end stop.
- This described method can be used when all conceivable mechanical stops for the handling robot are reached, for example when the tool head is placed on a platform below its movement space or on a horizontal conveyor device located there, which can be formed by a mat chain or similar conveyor device can. Since it does not make sense to move the tool head against this horizontal conveying device, in particular to press it down against this lower bearing surface, this position that has been reached can also be recognized and defined as the lower end position in the calibration method. If such a meaningful test was carried out with a touchdown of the gripper at its lower end stop, it can then be raised and the Centering must be carried out again in order to approach the upper end stops for calibration.
- FIG. 3A to 3C illustrate a further useful embodiment of the method according to the invention, in which, in an alternative or independent of the previously described and/or in a further method step in separate calibration steps, a rotational position of the tool head 28 suspended on the total of three parallel-kinematically movable arms 26 is calibrated by tool head 28, which is rotatable about a vertical axis of rotation 46 or a tool head slightly inclined relative to the vertical, is brought into a defined rotational position within its movement space with a known position and/or orientation of the three movable arms 26 ( Figure 3A ) and moved to a defined distance from an object and/or fixed contact point 48 ( Figure 3B ) and then brought into contact with this object and/or contact point 48 by rotating the tool head 28 and the new rotational position reached in the process is recorded and processed for calibrating the rotary drive 44 of the tool head 28 (cf. Figure 3C and the arrow indicating rotation).
- a gripping arm arranged on tool head 28 and suspended there is not shown for reasons of simplification, but serves as a part to be contacted, which is brought into contact with the object and/or fixed contact point 48 in order to control the rotary movements of drive shaft 30 and the drive movements of the drive motor responsible for this 44 to calibrate.
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Health & Medical Sciences (AREA)
- General Health & Medical Sciences (AREA)
- Orthopedic Medicine & Surgery (AREA)
- Manipulator (AREA)
Description
Die vorliegende Erfindung betrifft ein Verfahren zum Referenzieren, Kalibrieren und/oder Initialisieren einer Handhabungsvorrichtung, insbesondere eines auch als sog. Tripod bezeichneten Parallelkinematik-Roboters, gemäß den Merkmalen des unabhängigen Verfahrensanspruchs 1. Die Erfindung betrifft zudem eine programmgesteuerte Handhabungseinrichtung mit den Merkmalen des Anspruchs 10, insbesondere einen programmgesteuerten Handhabungs- und/oder Parallelkinematik-Roboter mit an mindestens zwei parallelkinematisch beweglichen Armen aufgehängtem Werkzeugkopf, der mit einem Steuerungssystem ausgestattet ist, das insbesondere zur Durchführung des Verfahrens ausgestattet und geeignet ist und das dem Referenzieren, der Kalibrierung und/oder dem Initialisieren einer Handhabungsvorrichtung bzw. eines Parallelkinematik-Roboters dient.The present invention relates to a method for referencing, calibrating and/or initializing a handling device, in particular a parallel kinematic robot also known as a so-called tripod, according to the features of independent method claim 1. The invention also relates to a program-controlled handling device with the features of
Sollen stapelbare und/oder palettierfähige Objekte wie Pakete oder aus mehreren einzelnen Artikeln zusammengefasste Gebinde, die bspw. aus miteinander verbundenen Getränkebehältern gebildet sein können, hierfür geeigneten Verpackungs- oder Palettieranlagen zugeführt werden, so erfolgt der Transport der Objekte meist mit Horizontalfördereinrichtungen mit Förderbändern, auf denen die Stückgüter oder Gebinde in ununterbrochener oder unregelmäßiger Folge zu einer Handhabungseinrichtung befördert werden. Dort erfolgt eine Verschiebung, Ausrichtung und/oder Drehen einzelner Stückgüter oder Gebinde, um diese in eine geeignete räumliche Anordnung zu bringen, die eine Basis bildet, um die Stückgüter oder Gebinde in nachgeordneten Gruppierstationen zu stapelfähigen Stückgut- oder Gebindelagen zusammenzuschieben. In aktuell eingesetzten Abfüll- und Verpackungslinien werden unterschiedliche Verfahren zum Drehen von Stückgütern oder Gebinden eingesetzt, die bspw. geeignete bewegliche Anschläge oder zwei Bänder mit unterschiedlichen Geschwindigkeiten aufweisen können. Bekannte Handhabungseinrichtungen können auch mit Greifern versehen sein, die bspw. an einem Portalsystem aufgehängt und in einem definierten Bewegungsbereich verschoben, rotiert und zudem in vertikaler Richtung bewegt werden können, um einzelne Stückgüter oder Gebinde zum Drehen und/oder Verschieben anheben zu können. Die Greifer können bspw. auch an Mehrachsroboterarmen angeordnet sein, die seitlich an den Horizontalfördereinrichtungen platziert sind.If stackable and/or palletizable objects such as packages or bundles made up of several individual items, which can be formed from interconnected beverage containers, for example, are to be fed to suitable packaging or palletizing systems, the objects are usually transported using horizontal conveyor systems with conveyor belts which the piece goods or containers are conveyed to a handling facility in an uninterrupted or irregular sequence. There is a displacement, alignment and / or rotation of individual cargo or containers to bring them into a suitable spatial arrangement that forms a basis to push the cargo or containers together in downstream grouping stations to stackable cargo or container layers. In currently used bottling and packaging lines, different methods are used for turning piece goods or containers, which can have, for example, suitable movable stops or two belts with different speeds. Known handling devices can also be provided with grippers that can be suspended from a portal system, for example, and moved, rotated and also moved in the vertical direction within a defined range of movement in order to be able to lift individual piece goods or containers for rotating and/or moving. the Grippers can also be arranged, for example, on multi-axis robot arms that are placed on the side of the horizontal conveyor devices.
Das Handhaben von Stückgütern oder Gebinden umfasst in der Praxis das Anheben, Versetzen und/oder die Ausrichtung und das Verbringen oder Überführen des jeweiligen Stückgutes oder Gebindes in eine gewünschte Position bzw. Orientierung innerhalb einer zum Stapeln und/oder Palettieren geeigneten Gruppierung. Um diese Anforderungen zu erfüllen, bietet der bekannte Stand der Technik bereits zahlreiche Greifvorrichtungen mit gegeneinander zustellbaren Greifarmen, so bspw. die
Neben Handhabungseinrichtungen in Gestalt von Portalrobotern werden in der Praxis auch andere Handhabungseinrichtungen zum Greifen, Verschieben, Drehen und/oder Versetzen von Artikeln oder Gebinden eingesetzt, die auf sog. Deltarobotern oder Parallelkinematik-Robotern basieren, welche in einer dreiarmigen Ausführung auch als Tripode bezeichnet werden. Jeder der Arme eines solchen Tripods oder Deltaroboters besteht aus einem an der Basis um eine gestellfeste Schwenkachse angetrieben verschwenkbar angeordneten Oberarm und einem mit dem Oberarm und dem Koppelelement gelenkig verbundenen Unterarm. Der Unterarm ist hierbei passiv, frei von einem Antrieb zu dessen Verschwenkung gegenüber dem Oberarm oder dem Koppelelement ausgeführt. Einer oder mehrere der Unterarme können bspw. über Kugelgelenke mit den jeweils zugehörigen Oberarmen und dem Koppelelement verbunden sein. Ein solcher einzelner Unterarm ist frei schwenkbar und besitzt keine Eigenstabilität. Alle Oberarme eines Deltaroboters sind jeweils um vorzugsweise innerhalb einer gemeinsamen Ebene liegende Schwenkachsen verschwenkbar angetrieben gelagert. Drei mit dem Koppelelement und jeweils mit ihrem zugehörigen Oberarm verbundene Unterarme bilden in jeder Position ein Kraftdreieck, das sich nur bewegen lässt, wenn die drei Oberarme synchron die für sie berechneten Schwenkbewegungen um deren gestellfeste Schwenkachsen ausführen. Zwei oder mehr Schwenkachsen können parallel verlaufen; in der Regel weisen alle Schwenkachsen zwei Schnittpunkte mit anderen Schwenkachsen auf.In addition to handling devices in the form of portal robots, other handling devices for gripping, moving, rotating and/or moving articles or containers are also used in practice, which are based on so-called delta robots or parallel kinematic robots, which in a three-armed design are also referred to as tripods . Each of the arms of such a tripod or delta robot consists of an upper arm arranged on the base such that it can be pivoted about a pivot axis which is fixed to the frame, and a lower arm which is articulated to the upper arm and the coupling element. Here, the lower arm is passive, running without a drive for pivoting it in relation to the upper arm or the coupling element. One or more of the lower arms can be connected to the associated upper arms and the coupling element, for example via ball joints. Such a single forearm is freely pivotable and has no intrinsic stability. All of the upper arms of a delta robot are mounted so that they can be pivoted and driven about pivot axes that preferably lie within a common plane. In every position, three forearms connected to the coupling element and each to their associated upper arm form a force triangle that can only be moved if the three upper arms synchronously execute the pivoting movements calculated for them about their pivot axes fixed to the frame. Two or more pivot axes can run parallel; as a rule, all pivot axes have two points of intersection with other pivot axes.
Wenigstens einer der Unterarme kann aus zwei auch als Elle und Speiche zu bezeichnenden und solchermaßen ein Parallelogrammgestänge bildenden Gestängeelementen bestehen, um das Koppelelement in zumindest einer vorgegebenen Ausrichtung relativ zur Basis zu führen. Das Koppelelement dient dabei als Arbeitsplattform oder Werkzeugkopf, die/der in der Praxis auch als Tool-Center-Point (TCP) bezeichnet wird. An diesem Werkzeugkopf oder TCP kann ein Manipulator angeordnet sein, bspw. in Gestalt von gegeneinander zustellbaren Greifarmen o. dgl. Handhabungseinrichtung, so dass damit Artikel, Gebinde o. dgl. Stückgüter ergriffen und gedreht, verschoben oder von einer Auflagefläche angehoben werden können.At least one of the forearms can consist of two linkage elements, which can also be referred to as ulna and spoke and thus form a parallelogram linkage, in order to guide the coupling element in at least one predetermined orientation relative to the base. The coupling element serves as a work platform or tool head, which is also referred to as a tool center point (TCP) in practice. A manipulator can be arranged on this tool head or TCP, e.g.
Der an der Arbeitsplattform, dem Werkzeugkopf bzw. dem TCP angeordnete Manipulator kann wahlweise drehbar gelagert sein, um den Manipulator ausrichten oder eine gewünschte Drehung der Artikel oder Stückgüter ausführen zu können. Anstelle einer drehbeweglichen Lagerung des Manipulators am Koppelelement ist es grundsätzlich auch denkbar, den Manipulator unverdrehbar am Koppelelement anzuordnen und das gesamte Koppelelement unter entsprechender Ausgleichbewegung der Arme vermittels der Teleskopwelle gegenüber der Basis zu verdrehen. Aus der
Die vielfach als Handhabungsroboter eingesetzten Parallelkinematik-Roboter verfügen aufgrund ihrer präzisen Steuerbarkeit und der ausgeprägten Steifigkeit der zusammenwirkenden beweglichen Stellarme über eine sehr hohe Positioniergenauigkeit und können überdies mit sehr hohen Positioniergeschwindigkeiten betrieben werden. Die in aller Regel elektromotorisch angetriebenen Stellarme bedürfen allerdings für ihre einwandfreie Funktion eine Kalibrierung aller vorhandenen Antriebe, damit die Steuerbefehle auch in entsprechende Stellbewegungen umgesetzt werden können. Bei fehlender oder unzureichender Kalibrierung bestünde insbesondere nach einem Neustart des Systems die Gefahr, dass das Steuersystem über keine exakten Positionswerte der jeweiligen elektromotorischen Antriebe verfügt, wodurch auch die exakte Positionierbarkeit der Antriebe in Frage gestellt wäre. Eine erneute Kalibrierung des Systems ist daher zumindest nach jedem Systemneustart, aber auch nach jedem Wiederstart unverzichtbar.The parallel kinematic robots often used as handling robots have a very high positioning accuracy due to their precise controllability and the pronounced rigidity of the interacting movable actuating arms and can also be operated at very high positioning speeds. However, the actuator arms, which are generally driven by electric motors, require a calibration of all existing drives in order to function properly, so that the control commands can also be converted into appropriate actuating movements. If there is no calibration or there is insufficient calibration, there would be a risk, especially after a restart of the system, that the control system would not have exact position values for the respective electric motor drives, which would also call into question the exact positioning of the drives. A new calibration of the system is therefore indispensable after every system restart, but also after every restart.
Grundsätzlich besteht das Ziel eines derartigen Kalibriervorganges darin, jeden von mehreren elektromotorisch angetriebenen Stellarmen des Parallelkinematik-Roboters gegen einen mechanischen Anschlag zu bewegen. Da dieser mechanische Anschlag gleichzeitig eine Endlage innerhalb des Bewegungsbereiches des betreffenden Stellarmes bildet, kann die dadurch ermittelte Position im Rahmen des Kalibriervorganges erfasst und dem Steuerungssystem als Endlagenposition übermittelt werden. Eine in der Praxis sinnvolle Vorgehensweise beim Kalibrieren erfordert das Stillsetzen der Maschine, etwa indem ein Not-Aus-Schalter betätigt wird, weil erst dann eine Sicherheitsabschottung der Maschine, die gegen ungewollte manuelle Eingriffe zu schützen hat, entriegelt und geöffnet werden kann. Eine solche Sicherheitsabschottung, die durch eine an sich bekannte teilverglaste Einhausung gebildet sein kann, weist in aller Regel Türen oder Klappen o. dgl. auf, die erst dann geöffnet werden können, wenn die Handhabungseinrichtung stillgelegt ist. Anschließend kann eine Kalibriervorrichtung, die etwa durch einen innerhalb des Schwenkbereiches eines Oberarmes des Parallelkinematik-Roboters einsetzbaren Riegel gebildet sein kann, eingesetzt und in seiner vorgesehenen Position gesichert werden. Anschließend kann nach Verschließen der zuvor geöffneten Türen oder Klappen der Kalibriervorgang gestartet werden, indem der elektromotorisch veschwenkbare Oberarm gegen den Riegel verschwenkt und damit eine definierte Endlage des Oberarms eingenommen wird. Da diese Kalibriervorgänge meist von zwei Personen durchzuführen und für jeden Oberarm nach Umpositionieren des manuell einsetzbaren Riegels wiederholt werden müssen, ist der gesamte Vorgang sehr zeitintensiv. Darüber hinaus verbleibt das Risiko, dass es nach einer fehlerhaft oder unvollständig durchgeführten Kalibrierung zu mechanischen Schäden an der Handhabungseinrichtung kommen kann.Basically, the goal of such a calibration process is to adjust each of several electric motor-driven actuator arms of the parallel kinematic robot to move against a mechanical stop. Since this mechanical stop at the same time forms an end position within the range of movement of the actuating arm in question, the position thus determined can be recorded as part of the calibration process and transmitted to the control system as the end position. A calibration procedure that makes sense in practice requires the machine to be shut down, for example by pressing an emergency stop switch, because only then can a safety partition of the machine, which has to protect against unwanted manual intervention, be unlocked and opened. Such a safety partition, which can be formed by a partially glazed enclosure known per se, usually has doors or flaps or the like, which can only be opened when the handling device is shut down. A calibration device, which can be formed, for example, by a bolt that can be inserted within the pivoting range of an upper arm of the parallel kinematic robot, can then be inserted and secured in its intended position. Then, after the previously opened doors or flaps have been closed, the calibration process can be started by pivoting the upper arm, which can be pivoted by an electric motor, against the latch and thus assuming a defined end position of the upper arm. Since these calibration processes usually have to be carried out by two people and have to be repeated for each upper arm after the manually insertable bolt has been repositioned, the entire process is very time-consuming. In addition, there remains the risk that mechanical damage may occur to the handling device after a calibration that has been carried out incorrectly or incompletely.
Ein Parallelarmroboter mit Einrichtungen zur Positionskalibrierung von Stellarmen geht aus der
Die Präzision einer solchen Kalibrierung hängt somit nicht nur von der exakten Befestigung der Messuhren, der Güte und Wiederholbarkeit der berührenden Zusammenwirkung des Antriebsarmes mit der Messuhr und der Anzeigegenauigkeit der Messuhren ab, sondern auch von der Ablesegenauigkeit der Messuhren, die durch einen Beobachter zu erfolgen hat, womit sich zahlreiche Fehlerquellen für die Messungen und für die Kalibriervorgänge ergeben.The precision of such a calibration thus depends not only on the exact attachment of the dial gauges, the quality and repeatability of the contacting interaction of the drive arm with the dial gauge and the accuracy of the display Dial gauges, but also on the reading accuracy of the dial gauges, which has to be done by an observer, which results in numerous sources of error for the measurements and for the calibration processes.
Angesichts der im Stand der Technik erkannten Nachteile und Einschränkungen kann das vorrangige Ziel der vorliegenden Erfindung darin gesehen werden, ein verbessertes und insbesondere mit weniger Personal- und Zeitaufwand durchführbares Kalibrierverfahren sowie ein entsprechendes Steuerungssystem zur Verfügung zu stellen, das nicht nur zu zuverlässigeren Ergebnissen führt, sondern das auch jederzeit reproduzierbar ist, so dass durch manuelle Fehlbedienungen ausgelöste Kalibrierfehler nahezu ausgeschlossen werden können.In view of the disadvantages and limitations recognized in the prior art, the primary objective of the present invention can be seen as providing an improved calibration method that can be carried out in particular with less personnel and time expenditure, as well as a corresponding control system that not only leads to more reliable results, but that is also reproducible at any time, so that calibration errors caused by incorrect manual operation can be almost completely ruled out.
Dieses Ziel der Erfindung wird mit den Gegenständen der unabhängigen Ansprüche erreicht. Merkmale vorteilhafter Weiterbildungen der Erfindung ergeben sich aus den abhängigen Ansprüchen sowie aus der nachfolgenden Erfindungsoffenbarung.This object of the invention is achieved with the subject-matters of the independent claims. Features of advantageous developments of the invention emerge from the dependent claims and from the following disclosure of the invention.
Zur Erreichung des als vorrangig identifizierten Ziels schlägt die vorliegende Erfindung ein Verfahren zum Referenzieren, Kalibrieren und/oder Initialisieren einer Handhabungseinrichtung, insbesondere eines Handhabungs- und/oder ParallelkinematikRoboters mit einem an mindestens zwei parallelkinematisch beweglichen Armen aufgehängten Werkzeugkopf vor, das die nachfolgenden Merkmale und Verfahrensschritte umfasst. Bei dem zu referenzierenden und/oder zu kalibrierenden und/oder zu initialisierenden Handhabungs- und/oder Parallelkinematik-Roboter ist eine bewegliche und verstellbare Antriebsverbindung zwischen einem ortsfesten Antriebsmotor und dem um mindestens eine Drehachse beweglichen Werkzeugkopf vorgesehen, wobei die bewegliche Antriebsverbindung insbesondere durch eine längenvariable und/oder gelenkig bewegliche Kardanwelle gebildet sein kann.In order to achieve the goal identified as having priority, the present invention proposes a method for referencing, calibrating and/or initializing a handling device, in particular a handling and/or parallel kinematic robot with a tool head suspended on at least two parallel kinematically movable arms, which has the following features and method steps includes. In the handling and/or parallel kinematics robot to be referenced and/or calibrated and/or initialized, a movable and adjustable drive connection is provided between a stationary drive motor and the tool head, which can be moved about at least one axis of rotation, with the movable drive connection being provided in particular by a length-variable and/or articulated cardan shaft can be formed.
Außerdem umfasst bei dem zu referenzierenden und/oder zu kalibrierenden und/oder zu initialisierenden Handhabungs- und/oder Parallelkinematik-Roboter jeder der mindestens zwei Arme einen um eine definierte Oberarm-Schwenkachse motorisch zwischen zwei Endlagen beweglichen Oberarm sowie einen am Oberarm schwenkbeweglich gelagerten Unterarm. Diese Arme halten den an den mindestens zwei Unterarmen beweglich aufgehängten Werkzeugkopf, der mittels programmgesteuerter und aufeinander abgestimmter Schwenkbewegungen der Oberarme sowie der dadurch geführten Unterarme innerhalb eines definierten Bewegungsraumes beweglich ist. Wenn im vorliegenden Zusammenhang allgemein von einem solchen Werkzeugkopf die Rede ist, so kann dies bspw. bei einem Handhabungsroboter ein Greifarm mit zwei gegeneinander zustellbaren Greifern oder Greifbacken zum Erfassen, Anheben, Verschieben, Umsetzen oder sonstigen Manipulieren von Artikeln, Gegenständen, Stückgütern, Gebinden oder Gruppierungen mit mehreren solcher Artikel, Gegenstände, Stückgüter, Gebinde sein, wobei der Greifarm mit den gegeneinander zustellbaren Greifern oder Greifbacken vorzugsweise als Ganzes rotierbar ausgestaltet ist. Diese Rotationsbewegungen können mittels der oben erwähnten Antriebsverbindung bzw. der längenverstellbaren und/oder gelenkig beweglichen Kardanwelle ausgelöst und gesteuert werden, welche Antriebsverbindung bzw. Kardanwelle in vertikaler oder schräger Richtung von einer oberen Aufhängung des Parallelkinematik-Roboters zum rotierbaren Werkzeugkopf nach unten führt.In addition, in the handling and/or parallel kinematics robot to be referenced and/or calibrated and/or initialized, each of the at least two arms includes an upper arm that can be moved by motor around a defined upper arm pivot axis between two end positions, and a lower arm that is pivotably mounted on the upper arm. These arms hold the tool head, which is movably suspended on the at least two lower arms and can be moved within a defined movement space by means of program-controlled and coordinated pivoting movements of the upper arms and the lower arms guided thereby. If in the present context of such a tool head is generally mentioned In the case of a handling robot, for example, this can be a gripper arm with two grippers or gripper jaws that can be moved towards one another for grasping, lifting, moving, relocating or otherwise manipulating articles, objects, piece goods, bundles or groups of several such articles, objects, piece goods, bundles be, wherein the gripper arm is preferably configured rotatable as a whole with the grippers or gripper jaws that can be advanced towards one another. These rotational movements can be triggered and controlled by means of the above-mentioned drive connection or the length-adjustable and/or articulated cardan shaft, which drive connection or cardan shaft leads downwards in a vertical or oblique direction from an upper suspension of the parallel kinematic robot to the rotatable tool head.
Sowohl die um horizontale Achsen beweglichen Oberarme als auch die für die Rotationsbewegungen des Werkzeugkopfes verantwortliche Antriebswelle sind typischerweise elektromotorisch betrieben, so dass bei beiden Antriebsarten eine Referenzierung, Kalibrierung und/oder Neuinitialisierung nach einem Maschinenstillstand, nach einem Stromausfall, einer Abschaltung und/oder einem erneuten Starten einer Steuerungsvorrichtung der exakten Positionen der Antriebseinheiten notwendig ist, um die angestrebten präzisen Stell- und Manipulationsbewegungen aller beweglichen und angetriebenen Elemente und Komponenten des Handhabungs- und/oder Parallelkinematik-Roboters sicherstellen zu können.Both the upper arms, which can be moved around horizontal axes, and the drive shaft responsible for the rotational movements of the tool head are typically operated by electric motors, so that with both types of drive, referencing, calibration and/or re-initialization after a machine standstill, after a power failure, a shutdown and/or a renewed Starting a control device of the exact positions of the drive units is necessary in order to be able to ensure the desired precise setting and manipulation movements of all moving and driven elements and components of the handling and/or parallel kinematics robot.
Bei dem erfindungsgemäßen Referenzierungs-, Kalibrierungs- und/oder Initialisierungsverfahren werden in einem ersten Verfahrensschritt mittels Erfassung der an den Oberarm-Schwenkachsen wirksamen Lastmomente und durch Vergleich der auf die mindestens zwei Oberarme wirkenden jeweiligen Lastmomente und/oder durch Erfassung von Signalen von Positions- und/oder Winkelsensoren mittels der motorischen Antriebe jeweils übereinstimmende Winkellagen der wenigstens zwei Oberarme eingestellt. Es versteht sich von selbst, dass zur Durchführung dieses ersten Verfahrensschrittes die für die Ansteuerung der motorischen Antriebe der wenigstens zwei Oberarme verantwortliche zentrale Steuerungseinheit eingeschaltet und das Steuerungsprogramm gestartet ist, was bspw. nach einer Abschaltphase einige Zeit für den Programmstart erfordert. Normalerweise werden in dieser Startphase auch alle motorischen Antriebe initialisiert und referenziert, um jeden Steuerungsbefehl zum Antrieb der Stellmotoren in möglichst exakte Antriebsbewegungen umsetzen zu können.In the referencing, calibration and/or initialization method according to the invention, in a first method step, the load torques acting on the upper arm pivot axes are detected and the respective load torques acting on the at least two upper arms are compared and/or signals from position and /or angle sensors are adjusted by means of the motor drives to correspond in each case to the angular positions of the at least two upper arms. It goes without saying that to carry out this first method step, the central control unit responsible for controlling the motorized drives of the at least two upper arms is switched on and the control program is started, which, for example, requires some time for the program to start after a switch-off phase. Normally, all motor drives are also initialized and referenced in this starting phase in order to be able to convert every control command for driving the servomotors into drive movements that are as precise as possible.
Bei dem hier beschriebenen ersten Verfahrensschritt, bei dem mittels einer Erfassung der an den Oberarm-Schwenkachsen wirksamen Lastmomente und mittels eines Vergleiches der auf die mindestens zwei Oberarme wirkenden jeweiligen Lastmomente und/oder mittels einer Erfassung der exakten Positionen der Oberarme durch Auswertung von Signalen von den Oberarmen zugeordneten Positions- und/oder Winkelsensoren mit Hilfe der motorischen Antriebe jeweils übereinstimmende Winkellagen der wenigstens zwei Oberarme eingestellt werden, besteht das vorrangige Ziel darin, für den Werkzeugkopf eine mittige Position innerhalb seines Bewegungs- und/oder Manipulationsraumes zu finden, was mangels optischer oder sonstiger Positionskontrolle am sinnvollsten über die Erfassung der auf die Oberarme wirkenden Lastmomente, alternativ oder zusätzlich jedoch auch durch die Auswertung von Signalen von Positions- und/oder Winkelsensoren erfolgen kann.In the first method step described here, in which, by detecting the load moments acting on the upper arm pivot axes and by comparing the respective load moments acting on the at least two upper arms and/or by detecting the exact positions of the upper arms by evaluating signals from the If the position and/or angle sensors assigned to the upper arms are set to match the angular positions of the at least two upper arms with the help of the motor drives, the primary goal is to find a central position for the tool head within its movement and/or manipulation space, which, due to a lack of optical or other position control can be done most sensibly by detecting the load moments acting on the upper arms, alternatively or additionally by evaluating signals from position and/or angle sensors.
Bei der Auswertung der Lastmomente können die Oberarme nacheinander solange verfahren bzw. auf und ab bewegt werden, bis sie innerhalb eines Hysteresebereiches ihrer Lastmomente von weniger als einem Newtonmeter, vorzugsweise von weniger als 0,5 Nm, insbesondere von ca. 0,3 Nm, ein übereinstimmendes Lastmoment aufweisen. Auf diese Weise kann sichergestellt werden, dass die an den Oberarmen mittels ihrer Antriebsmotoren eingestellten Winkellagen sowohl jeweils Mindestdifferenzwinkel zu den beiden Endlagen aufweisen als auch einen Aufenthaltsort des Werkzeugkopfes definieren, der sich innerhalb eines definierten Abstandes zu einer ungefähr mittigen Lage innerhalb des Bewegungsraumes befindet. Sofern dagegen direkt die Signale von den Oberarmen zugeordneten Positions- und/oder Winkelsensoren ausgewertet werden können, ist mittels dieser Signalauswertung zu gewährleisten, dass die an den Oberarmen mittels ihrer Antriebsmotoren eingestellten Winkellagen sowohl jeweils Mindestdifferenzwinkel zu den beiden Endlagen aufweisen als auch einen Aufenthaltsort des Werkzeugkopfes definieren, der sich innerhalb eines definierten Abstandes zu einer ungefähr mittigen Lage innerhalb des Bewegungsraumes befindet. Bei beiden Sensorvarianten, die wahlweise auch miteinander kombiniert werden können, kann daher angenommen werden, dass der Werkzeugkopf nach dieser Prozedur des ersten Verfahrensschrittes nahezu mittig innerhalb des Bewegungsraumes und zwischen den wenigstens zwei beweglichen Armen steht bzw. hängt.When evaluating the load moments, the upper arms can be moved or moved up and down one after the other until they are within a hysteresis range of their load moments of less than one Newton meter, preferably less than 0.5 Nm, in particular approx. 0.3 Nm. have a matching load moment. In this way it can be ensured that the angular positions set on the upper arms by means of their drive motors both have minimum difference angles to the two end positions and also define a location of the tool head that is within a defined distance from an approximately central position within the movement space. If, on the other hand, the signals from the position and/or angle sensors assigned to the upper arms can be evaluated directly, this signal evaluation must be used to ensure that the angular positions set on the upper arms by means of their drive motors have both minimum difference angles to the two end positions and also a location of the tool head define, which is within a defined distance to an approximately central position within the movement space. With both sensor variants, which can optionally also be combined with one another, it can therefore be assumed that the tool head stands or hangs almost in the middle within the movement space and between the at least two movable arms after this procedure of the first method step.
Es sei an dieser Stelle darauf hingewiesen, dass ein solcher Parallelkinematikoder Handhabungsroboter, der Gegenstand des erfindungsgemäßen Referenzierungs-, Kalibrierungs- und/oder Initialisierungsverfahrens ist, sehr häufig drei gleich dimensionierte und jeweils in 120°-Winkelversatz zueinander angeordnete Oberarme mit jeweils identischen Unterarmen und dazwischen beweglich und/oder drehbar aufgehängtem Werkzeugkopf aufweist. Solche sog. Tripode werden in der Praxis häufig eingesetzt und eignen sich in hervorragender Weise zur exakten Bewegungssteuerung, bspw. zum Manipulieren von Artikeln, Gegenständen, Stückgütern, Gebinden oder zum Manipulieren von Gruppierungen mit mehreren solcher Artikel, Gegenstände, Stückgüter, Gebinde. Diese Eignung für Tripode soll jedoch nicht einschränkend verstanden werden, da sich das Verfahren ebenso für Parallelkinematik-Roboter oder Handhabungsroboter mit zwei gleichartigen Armen oder auch solchen mit vier oder mehr beweglichen Armen eignet.It should be pointed out at this point that such a parallel kinematics or handling robot, which is the subject of the referencing, calibration and/or initialization method according to the invention, very often has three of the same dimensioned upper arms arranged at an angle of 120° to one another, each with identical lower arms and a tool head suspended between them so that it can move and/or rotate. Such so-called tripods are frequently used in practice and are excellently suited for precise movement control, for example for manipulating articles, objects, piece goods, bundles or for manipulating groups with several such articles, objects, piece goods, bundles. However, this suitability for tripods should not be understood as limiting, since the method is also suitable for parallel kinematic robots or handling robots with two arms of the same type or those with four or more movable arms.
Sofern im Zusammenhang mit besonderen Ausstattungsvarianten des erfindungsgemäßen Handhabungs- und/oder Parallelkinematikroboters nicht eine Überprüfung der Freigängigkeit bestimmter Antriebs- und/oder Drehübertragungskomponenten erfolgen soll, was sich anhand solcher Ausstattungsvarianten weiter unten noch näher beschrieben findet, werden bei dem erfindungsgemäßen Verfahren in einem sich an den oben beschriebenen ersten Verfahrensschritt anschließenden zweiten Verfahrensschritt die wenigstens zwei Oberarme durch gleichzeitiges und/oder annähernd synchrones Verschwenken um ihre jeweiligen Schwenkachsen bis zu einer Grenzlage bewegt, die durch einen mechanischen Anschlag der unabhängig von den Oberarmen beweglichen Antriebsverbindung und/oder durch einen Längsanschlag der Kardanwelle zum Werkzeugkopf definiert ist, wonach in einem dritten Verfahrensschritt der Werkzeugkopf und/oder die ihm zugeordnete Antriebsverbindung oder Kardanwelle durch Zurückbewegen der wenigstens zwei Oberarme um einen definierten Schwenkwinkel von der Grenzlage distanziert wird/werden.If, in connection with special equipment variants of the handling and/or parallel kinematic robot according to the invention, the freedom of movement of certain drive and/or rotary transmission components is not to be checked, which is described in more detail below on the basis of such equipment variants, in the method according to the invention in a second method step following the first method step described above moves the at least two upper arms by simultaneous and/or approximately synchronous pivoting about their respective pivot axes up to a limit position, which is determined by a mechanical stop of the drive connection, which can be moved independently of the upper arms, and/or by a longitudinal stop of the cardan shaft is defined to the tool head, after which in a third step of the tool head and / or its associated drive connection or cardan shaft by moving back the at least two upper arms u m a defined swivel angle is/are distanced from the limit position.
Der vorrangige Zweck dieser zweiten und dritten Verfahrensschritte ist es, einen Anschlag für die Längsverstellbarkeit der Antriebsverbindung oder Kardanwelle zu finden bzw. zu definieren, was sinnvollerweise bei ungefähr im Bereich seiner Hochachse zentriertem Werkzeugkopf erfolgen sollte, was durch ungefähr gleiche Winkelstellungen der Oberarme erreicht werden kann. Wenn in dieser ungefähr mittigen Stellung des Werkzeugkopfes alle Oberarme nach oben oder nach unten geschwenkt werden, bis der obere oder untere mechanische Anschlag für die Antriebsverbindung oder Kardanwelle erreicht ist, kann der Werkzeugkopf durch Absenken oder Anheben der Oberarme in eine definierte Lage gebracht werden, welche der längsverstellbaren Antriebsverbindung oder Kardanwelle noch genügend Verstellraum - entweder nach oben durch Reduzieren ihrer Länge oder nach unten durch ihre Verlängerung - lässt, um bei den nachfolgenden Verfahrensschritten nicht bereits nach kleinen Verstellbewegungen wieder an ihren mechanischen Anschlag zu gelangen. Insgesamt resultiert aus den zweiten und dritten Verfahrensschritten, dass die eingestellten Winkellagen der wenigstens zwei Oberarme jeweils definierte Differenzwinkel zu den beiden Endlagen aufweisen und/oder einen Aufenthaltsort des Werkzeugkopfes definieren, der sich innerhalb eines definierten Abstandes zu einer ungefähr mittigen Lage innerhalb des Bewegungsraumes befindet.The primary purpose of these second and third method steps is to find or define a stop for the longitudinal adjustability of the drive connection or cardan shaft, which should be done with the tool head centered approximately in the area of its vertical axis, which can be achieved by approximately the same angular positions of the upper arms . When all the upper arms are swiveled up or down in this approximately central position of the tool head until the upper or lower mechanical stop for the drive connection or cardan shaft is reached, the tool head can be brought into a defined position by lowering or raising the upper arms the longitudinally adjustable drive connection or Cardan shaft still has enough room for adjustment - either upwards by reducing its length or downwards by lengthening it - in order not to reach its mechanical stop again after small adjustment movements in the subsequent process steps. Overall, the result of the second and third method steps is that the set angular positions of the at least two upper arms each have defined difference angles to the two end positions and/or define a location of the tool head that is within a defined distance from an approximately central position within the movement space.
Anschließend wird in einem sich an die oben beschriebenen Verfahrensschritte anschließenden weiteren oder vierten Verfahrensschritt zumindest einer der wenigstens zwei Oberarme, insbesondere der drei vorhandenen Oberarme der Handhabungseinrichtung oder des Handhabungsroboters durch motorisches Verschwenken um seine Oberarm-Schwenkachse in eine seiner beiden Endlagen gebracht, wobei die hierbei erreichte Winkellage sensorisch erfasst und zur Lageund/oder Winkelinitialisierung des jeweiligen Oberarmes verwendet wird. Wenn an dieser Stelle von einer sensorischen Erfassung der Winkellagen gesprochen wird, so ist damit wiederum eine Erfassung von Lastmomenten und/oder von Winkelwerten mittels Winkelsensoren gemeint.Then, in a further or fourth method step that follows the method steps described above, at least one of the at least two upper arms, in particular the three upper arms present, of the handling device or the handling robot is brought into one of its two end positions by motorized pivoting about its upper arm pivot axis, with the achieved angular position is detected by sensors and used for position and/or angle initialization of the respective upper arm. If at this point a sensory detection of the angular positions is mentioned, this in turn means a detection of load moments and/or angle values by means of angle sensors.
Dabei können bspw. Absolutwertgeber ausgelesen werden, oder es können unterschiedliche Positionssensoren eingesetzt und deren Signale ausgewertet werden. Anschließend kann der jeweilige Oberarm aus seiner zuvor eingestellten Endlage in eine definierte Winkellage und/oder wieder ungefähr in die zuvor eingenommene Ausgangswinkellage zurückbewegt werden. Durch das Einnehmen der jeweiligen Endlagen bzw. mechanischen Anschläge für die Oberarme können die Antriebseinheiten der Oberarme jeweils in ihren Positionen referenziert werden. Als für die Durchführung des vierten Verfahrensschrittes ausgewählte Endlagen der Oberarmschwenkbewegungen eignen sich normalerweise die oberen Endanschläge der Oberarme, die somit auch als Referenzpositionen für die Referenzierungen der Oberarm-Antriebseinheiten dienen. Ebenso können jedoch auch untere Endanschläge der Oberarme angefahren werden, die ebenfalls als Referenzpositionen für die Referenzierungen der Oberarm-Antriebseinheiten verwendet werden können.For example, absolute encoders can be read out, or different position sensors can be used and their signals evaluated. The respective upper arm can then be moved back from its previously set end position into a defined angular position and/or approximately into the previously assumed starting angular position. By assuming the respective end positions or mechanical stops for the upper arms, the drive units of the upper arms can be referenced in their respective positions. The upper end stops of the upper arms are normally suitable as the end positions of the upper arm pivoting movements selected for carrying out the fourth method step, which therefore also serve as reference positions for the referencing of the upper arm drive units. However, lower end stops of the upper arms can also be approached, which can also be used as reference positions for referencing the upper arm drive units.
Da nicht nur einer der Oberarme, sondern der mindestens eine weitere bzw. die zwei, drei oder mehr weiteren Oberarme in derselben Weise zu referenzieren sind, wird in einem fünften Verfahrensschritt ein weiterer der wenigstens zwei Oberarme der Handhabungseinrichtung oder des Handhabungsroboters durch motorisches Verschwenken um seine Oberarm-Schwenkachse in eine seiner beiden Endlagen oder wahlweise in dieselbe der beiden Endlagen gebracht, die auch im vierten Verfahrensschritt ausgewählt war, wobei die hierbei erreichte Winkellage sensorisch erfasst und zur Lage- und/oder Winkelinitialisierung des betroffenen Oberarmes verwendet wird. Auch hierbei ist vorgesehen, dass der Oberarm aus seiner im Zusammenhang mit der Durchführung des fünften Verfahrensschrittes erreichten Endlage wieder in die zuvor eingenommene Ausgangswinkellage zurückbewegt wird.Since not only one of the upper arms, but the at least one other or the two, three or more other upper arms are to be referenced in the same way in a fifth method step, another of the at least two upper arms of the handling device or of the handling robot is brought into one of its two end positions or optionally into the same of the two end positions that was also selected in the fourth method step, by motorized pivoting about its upper arm pivot axis, the angular position thereby achieved is detected by sensors and used to initialize the position and/or angle of the affected upper arm. Here, too, it is provided that the upper arm is moved back from its end position reached in connection with the implementation of the fifth method step into the starting angular position previously assumed.
Sofern der Handhabungsroboter bzw. der Parallelkinematik-Roboter mehr als zwei bewegliche Arme aufweist, kann in einem sich an den fünften Verfahrensschritt anschließenden optionalen bzw. für einen Tripod als Handhabungsroboter notwendigen sechsten Verfahrensschritt ein dritter von insgesamt wenigstens drei vorhandenen Oberarmen der Handhabungseinrichtung oder des Handhabungsroboters durch motorisches Verschwenken um seine Oberarm-Schwenkachse in eine seiner beiden oder in dieselbe der beiden Endlagen gebracht wird, die auch im vierten und im fünften Verfahrensschritt für die jeweils verschwenkten anderen Oberarme ausgewählt war, wobei auch hier wiederum die in der Endlage erreichte Winkellage sensorisch erfasst und zur Lage- und/oder Winkelinitialisierung bzw. zur Referenzierung der Schwenkpositionen des betroffenen Oberarmes verwendet wird. Wahlweise kann dieser sechste Verfahrensschritte vorsehen, dass der vorhergehend in seine Endlage bewegte Oberarm aus seiner Endlage wieder ungefähr in die zuvor eingenommene Ausgangswinkellage zurückbewegt wird.If the handling robot or the parallel kinematics robot has more than two movable arms, in a sixth method step that follows the fifth method step and is optional or necessary for a tripod as the handling robot, a third of a total of at least three existing upper arms of the handling device or the handling robot can be moved through motorized pivoting about its upper arm pivot axis is brought into one of its two or into the same of the two end positions, which was also selected in the fourth and fifth method step for the respective pivoted other upper arms, whereby here again the angular position reached in the end position is detected by sensors and is used for position and/or angle initialization or for referencing the swivel positions of the affected upper arm. Optionally, this sixth method step can provide that the upper arm previously moved into its end position is moved back from its end position approximately into the previously assumed starting angular position.
Sofern der Handhabungsroboter bzw. der Parallelkinematik-Roboter mehr als drei bewegliche Arme aufweist, kann in einem sich an den sechsten Verfahrensschritt anschließenden optionalen bzw. für einen sog. Quadpod als Handhabungsroboter notwendigen siebten Verfahrensschritt ein vierter von insgesamt wenigstens vier vorhandenen Oberarmen der Handhabungseinrichtung oder des Handhabungsroboters durch motorisches Verschwenken um seine Oberarm-Schwenkachse in eine seiner beiden oder in dieselbe der beiden Endlagen gebracht werden, die auch im vierten, im fünften sowie im sechsten Verfahrensschritt für die jeweils verschwenkten anderen Oberarme ausgewählt war, wobei auch hier wieder die hierbei erreichte Winkellage sensorisch erfasst und zur Lage- und/oder Winkelinitialisierung des betroffenen Oberarmes verwendet wird. Ggf. kann auch im Zusammenhang mit dem siebten Verfahrensschritt vorgesehen sein, dass der vorhergehend in seine Endlage bewegte Oberarm aus seiner Endlage wieder ungefähr in die zuvor eingenommene Ausgangswinkellage zurückbewegt wird.If the handling robot or the parallel kinematics robot has more than three movable arms, a fourth of a total of at least four existing upper arms of the handling device or of the The handling robot can be brought into one of its two end positions or into the same one of the two end positions by motorized pivoting about its upper arm pivot axis, which was also selected in the fourth, fifth and sixth method step for the other pivoted upper arms, with the angular position achieved here again is detected by sensors and used to initialize the position and/or angle of the affected upper arm. Possibly also in connection with the seventh Method step can be provided that the upper arm previously moved into its end position is moved back from its end position approximately into the previously assumed starting angular position.
Bei dem erfindungsgemäßen Verfahren kann es insbesondere von Vorteil sein, wenn während der Durchführung der zweiten und/oder dritten und/oder vierten und/oder fünften und/oder sechsten und/siebten Verfahrensschritte und den entsprechenden motorischen Bewegungen der Oberarme eine permanente und/oder eine in definierten Zeitabständen wiederholte Erfassung der jeweiligen Antriebsdrehmomente erfolgt, da eine solche permanente Erfassung und Überwachung in vorteilhafter Weise dazu genutzt werden kann, dass eine Überschreitung eines vorgegebenen und/oder variabel definierbaren Differenzwertes für in aufeinanderfolgenden Messungen gewonnene Drehmomentwerte als mechanischer Anschlag und/oder Endanschlag für den jeweils betroffenen Oberarm erkannt wird.In the method according to the invention, it can be particularly advantageous if during the implementation of the second and / or third and / or fourth and / or fifth and / or sixth and / seventh method steps and the corresponding motor movements of the upper arms a permanent and / or The respective drive torques are recorded repeatedly at defined time intervals, since such permanent recording and monitoring can advantageously be used to ensure that exceeding a predetermined and/or variably definable difference value for torque values obtained in successive measurements as a mechanical stop and/or end stop for the affected upper arm is detected.
Eine solche Drehmomentlimitierung erlaubt es, ohne jegliche optische oder sonstige sensorische Bewegungserfassung einen existierenden mechanischen Anschlag für jede der durchgeführten Schwenkbewegungen der motorisch angetriebenen Oberarme zuverlässig zu erfassen. Auf diese Weise kann bei allen durchgeführten Bewegungen der Achsen im Rahmen eines Kalibrierungs- und/oder Referenzierungsverfahrens ein Drehmomentlimit gesetzt sein. Ein solches Drehmomentlimit muss keineswegs fest vorgegeben sein, sondern kann durch permanente dynamische Änderungsmöglichkeit in vorteilhafter Weise für unterschiedliche Winkelstellungen und damit zusammenhängend unterschiedliche Drehmomentwerte bei einem Bewegungsablauf eingesetzt und genutzt werden. Daraus folgt auch die universelle Einsetzbarkeit und Funktionsfähigkeit der beschriebenen Referenzierung auch bei unterschiedlichen Greifern oder Tripod-Robotern, die bspw. mit unterschiedlich dimensionierten Armen und/oder unterschiedlich dimensionierten und damit unterschiedlich schweren Werkzeugköpfen ausgestattet sein können.Such a torque limitation makes it possible to reliably detect an existing mechanical stop for each of the pivoting movements of the motor-driven upper arms that are carried out, without any optical or other sensory movement detection. In this way, a torque limit can be set for all movements of the axes that are carried out as part of a calibration and/or referencing process. Such a torque limit does not have to be fixed, but can be used and used in an advantageous manner for different angular positions and associated different torque values in a movement sequence due to the permanent dynamic possibility of change. This also results in the universal applicability and functionality of the referencing described, even with different grippers or tripod robots, which can be equipped, for example, with differently dimensioned arms and/or tool heads that are dimensioned differently and therefore have different weights.
Beim Starten der Zentrierung ist es von Vorteil, denjenigen Oberarm zu identifizieren, der bei einer Verstellung den höchsten Drehmomentwert liefert. Dieses ermittelte Drehmoment kann bspw. dazu verwendet werden, um auf Grundlage dieses Wertes, ggf. zuzüglich eines sinnvollen Zuschlages von bspw. 1,5 Newtonmeter, ein passendes Drehmomentlimit für den nachfolgenden Kalibrierungsvorgang zu setzen. Während des Vorganges der Zentrierung des Werkzeugkopfes kann dieses ermittelte Drehmoment ausreichen, um ohne Überschreitung dieses Drehmomentlimits den Werkzeugkopf in die Mitte seines Bewegungsraumes zu verfahren.When starting the centering, it is advantageous to identify the upper arm that delivers the highest torque value during an adjustment. This determined torque can be used, for example, to set a suitable torque limit for the subsequent calibration process on the basis of this value, possibly plus a reasonable addition of, for example, 1.5 newton meters. This can be determined during the process of centering the tool head Sufficient torque to move the tool head to the center of its range of motion without exceeding this torque limit.
Zudem kann das Verfahren vorsehen, dass eine iterative Drehmomenterfassung beim Verschwenken (Hochfahren) in Richtung der ausgewählten Endlage wenigstens eines der Oberarme an seinen jeweiligen Endanschlag vorgesehen ist. Hierdurch kann bei der Durchführung des Verfahrens ständig erkannt werden, ob bereits eine Endlage und damit ein mechanischer Anschlag erreicht wurde. Kommt es nämlich während einer Bewegung eines der Oberarme zum Überschreiten des zuvor ermittelten Drehmomentlimits, so wird überprüft, ob die betreffende Achse seit dem Setzen des Drehmomentlimits oder der letzten Drehmomenterhöhung sich um einen definierten kleinen Schwenkwinkel von bspw. mehr als 0,3 Winkelgrade bewegt hat. Ist dies der Fall, so wird dies nicht als Kollision bzw. als Erreichen des mechanischen Anschlages erkannt, sondern lediglich als Aussage, dass das vom Antrieb erzeugte Drehmoment nicht ausreicht zur Bewegung der entsprechenden Achse. Wenn anschließend das Drehmomentlimit um einen sinnvollen Wert von bspw. ca. 0,5 Newtonmeter erhöht wird, kann auf dieser Basis die Schwenkbewegung fortgesetzt werden. War jedoch die Achsbewegung bei der gemessenen Drehmomenterhöhung geringer als der definierte kleine Differenzwinkel von bspw. 0,3 Grad, so kann bei dem erfindungsgemäßen Verfahren davon ausgegangen werden, dass eine Kollision bzw. ein Erreichen einer Endlage oder eines mechanischen Endanschlags stattgefunden hat.In addition, the method can provide that an iterative torque detection is provided when pivoting (moving up) in the direction of the selected end position of at least one of the upper arms at its respective end stop. As a result, when the method is being carried out, it can be continuously recognized whether an end position and thus a mechanical stop has already been reached. If the previously determined torque limit is exceeded during a movement of one of the upper arms, a check is carried out to determine whether the axis in question has moved by a defined small swivel angle of, for example, more than 0.3 angular degrees since the torque limit was set or the last torque increase . If this is the case, this is not recognized as a collision or as reaching the mechanical stop, but only as a statement that the torque generated by the drive is not sufficient to move the corresponding axis. If the torque limit is then increased by a reasonable value of around 0.5 Newton meters, for example, the pivoting movement can be continued on this basis. However, if the axis movement during the measured increase in torque was less than the defined small difference angle of, for example, 0.3 degrees, it can be assumed in the method according to the invention that a collision or an end position or a mechanical end stop was reached.
Ebenso kann das erfindungsgemäße Verfahren vorsehen, dass während der Durchführung der zweiten und/oder dritten und/oder vierten und/oder fünften und/oder sechsten und/siebten Verfahrensschritte und den entsprechenden motorischen Bewegungen der Oberarme eine permanente und/oder eine in definierten Zeitabständen wiederholte Erfassung der jeweiligen Winkellagen der Oberarme erfolgt, wobei eine Unterschreitung eines vorgegebenen Differenzwertes für aufeinanderfolgend gemessene Winkellagen eines jeweiligen Oberarms als mechanischer Anschlag und/oder Endanschlag für den jeweils betroffenen Oberarm erkannt wird.The method according to the invention can also provide that while the second and/or third and/or fourth and/or fifth and/or sixth and/or seventh method steps and the corresponding motor movements of the upper arms are being carried out, one is repeated permanently and/or at defined time intervals The respective angular positions of the upper arms are detected, falling below a predetermined differential value for successively measured angular positions of a respective upper arm is recognized as a mechanical stop and/or end stop for the respective upper arm concerned.
Eine solche Winkel- und/oder Positionslimitierung erlaubt es, mit einfachen sensorischen Mitteln einen existierenden mechanischen Anschlag für jede der durchgeführten Schwenkbewegungen der motorisch angetriebenen Oberarme zuverlässig zu erfassen. Auf diese Weise kann bei allen durchgeführten Bewegungen der Achsen im Rahmen eines Kalibrierungs- und/oder Referenzierungsverfahrens ein Positions- oder Winkellimit gesetzt sein, welches für unterschiedliche Winkelstellungen bei einem Bewegungsablauf eingesetzt und genutzt werden kann. Daraus folgt auch die universelle Einsetzbarkeit und Funktionsfähigkeit der beschriebenen Referenzierung auch bei unterschiedlichen Greifern oder Tripod-Robotern, die bspw. mit unterschiedlich dimensionierten Armen und/oder unterschiedlich dimensionierten und damit unterschiedlich schweren Werkzeugköpfen ausgestattet sein können.Such an angle and/or position limitation makes it possible, with simple sensory means, to reliably detect an existing mechanical stop for each of the pivoting movements of the motor-driven upper arms that are carried out. In this way, a position or Be set angle limit, which can be used and used for different angular positions in a movement. This also results in the universal applicability and functionality of the referencing described, even with different grippers or tripod robots, which can be equipped, for example, with differently dimensioned arms and/or tool heads that are dimensioned differently and therefore have different weights.
Eine iterative Winkelerfassung beim Verschwenken in Richtung der ausgewählten Endlage wenigstens eines der Oberarme an seinen jeweiligen Endanschlag kann den Vorteil liefern, dass jegliche mechanische Beschädigung beim Erreichen des jeweiligen Endanschlags vermieden wird, da dieser mit geringer Verstellgeschwindigkeit erreicht wird. Hierdurch kann bei der Durchführung des Verfahrens ständig erkannt werden, ob bereits eine Endlage und damit ein mechanischer Anschlag erreicht wurde.Iterative angle detection when pivoting in the direction of the selected end position of at least one of the upper arms at its respective end stop can provide the advantage that any mechanical damage is avoided when the respective end stop is reached, since this is reached at a low adjustment speed. As a result, when the method is being carried out, it can be continuously recognized whether an end position and thus a mechanical stop has already been reached.
Diese beschriebenen Verfahrensvarianten können beim Erreichen aller denkbaren mechanischen Anschläge für den Handhabungsroboter verwendet werden, so bspw. auch beim Aufsetzen des Werkzeugkopfes auf einer unterhalb seines Bewegungsraumes befindlichen Plattform oder einer dort befindlichen Horizontalfördereinrichtung, die bspw. durch eine Mattenkette o. dgl. Fördereinrichtung gebildet sein kann. Da es nicht sinnvoll ist, den Werkzeugkopf gegen diese Horizontalfördereinrichtung zu bewegen, insbesondere gegen diese untere Auflagefläche nach unten zu drücken, kann auch diese erreichte Position erkannt und bei dem Kalibrierungsverfahren als untere Endlage definiert werden. Sofern ein solcher sinnvoller Test mit einem Aufsetzen des Greifers an seinem unteren Endanschlag durchgeführt wurde, kann er anschließend angehoben und die Zentrierung erneut durchgeführt werden, um die oberen Endanschläge zur Kalibrierung anzufahren.These process variants described can be used when all conceivable mechanical stops for the handling robot are reached, for example when the tool head is placed on a platform located below its movement space or on a horizontal conveyor device located there, which can be formed, for example, by a mat chain or similar conveyor device can. Since it does not make sense to move the tool head against this horizontal conveying device, in particular to press it down against this lower bearing surface, this position that has been reached can also be recognized and defined as the lower end position in the calibration process. If such a meaningful test was carried out by placing the gripper on its lower end stop, it can then be lifted and centered again in order to approach the upper end stops for calibration.
Wie dies schon weiter oben anhand einer in der Praxis häufig eingesetzten Variante eines Parallelkinematik-Roboters mit rotierbarem Werkzeugkopf beschrieben wurde, ist zwischen einer oberen Rahmenanordnung bzw. Aufhängung, an der auch die zwei oder drei oder mehr beweglichen Oberarme mit ihren Antriebsmotoren befestigt sein können, und dem rotierbaren Werkzeugkopf eine Wellenverbindung angeordnet, insbesondere in Gestalt einer teleskopierbaren Kardanwelle. Es leuchtet unmittelbar ein, dass eine solche teleskopierbare Kardanwelle nur innerhalb von sinnvollen Grenzen längsverschieblich sein muss. Eine Verschiebbarkeit über sinnvolle Bewegungsgrenzen hinaus ist allein schon aus Gewichtsgründen nicht zweckmäßig. Diese begrenzte Teleskopierbarkeit der Kardanwelle verlangt es andererseits, diesen weiteren Endanschlag beim Kalibrierungsverfahren in geeigneter Weise zu berücksichtigen.As has already been described above with reference to a variant of a parallel kinematics robot with a rotatable tool head that is frequently used in practice, between an upper frame arrangement or suspension, to which the two or three or more movable upper arms with their drive motors can also be attached, and the rotatable tool head arranged a shaft connection, in particular in the form of a telescoping cardan shaft. It is immediately obvious that such a telescoping cardan shaft only has to be longitudinally displaceable within sensible limits. Displaceability beyond sensible movement limits is not expedient if only for reasons of weight. This limited On the other hand, if the cardan shaft can be telescoped, this additional end stop must be taken into account in a suitable manner during the calibration process.
So kann auch dieser weitere mechanische Anschlag in das erfindungsgemäße Verfahren integriert bzw. bei diesem berücksichtigt werden, indem etwa bei allen Schwenkbewegungen und auch bei einer Fahrt gegen den Längsanschlag des Kardans zuerst das aktuelle Drehmoment jedes einzelnen Oberarmes ermittelt und zuzüglich eines sinnvollen Aufschlages von bspw. einem Wert von etwa 1,5 Nm als Drehmomentlimit gesetzt wird. Nach einer Fahrt gegen den oberen Längsanschlag des teleskopierbaren Kardans kann als nächst folgender Verfahrensschritt der Tripod-Roboter oder Parallelkinematik-Roboter wieder freigefahren wird.This further mechanical stop can also be integrated into the method according to the invention or taken into account in the process, in that the current torque of each individual upper arm is first determined for all pivoting movements and also when driving against the longitudinal stop of the cardan and plus a reasonable addition of e.g. a value of around 1.5 Nm is set as the torque limit. After driving against the upper longitudinal stop of the telescoping cardan, the tripod robot or parallel kinematic robot can be released again as the next process step.
Eine weitere Ausführungsvariante des erfindungsgemäßen Verfahrens kann einen alternativen und/oder weiteren Verfahrensschritt aufweisen, bei dem neben den oben beschriebenen Kalibrierungsschritten der verschwenkbaren Oberarme eine Drehlage des an den wenigstens zwei parallelkinematisch beweglichen Armen aufgehängtem Werkzeugkopfes kalibriert wird, indem der um eine vertikale oder gegenüber der Vertikalen leicht geneigten Drehachse rotierbare Werkzeugkopf innerhalb des Bewegungsraumes bei bekannter Position und/oder Ausrichtung der wenigstens zwei beweglichen Arme in eine definierte Drehlage gebracht und in einen definierten Abstand zu einem Gegenstand und/oder feststehenden Anlagepunkt bewegt und anschließend durch Rotieren des Werkzeugkopfes in Kontakt mit diesem Gegenstand und/oder Anlagepunkt gebracht und die dabei erreichte neue Drehlage zum Kalibrieren des Rotationsantriebes des Werkzeugkopfes erfasst und verarbeitet wird.A further embodiment variant of the method according to the invention can have an alternative and/or further method step in which, in addition to the calibration steps of the pivotable upper arms described above, a rotational position of the tool head suspended on the at least two parallel-kinematically movable arms is calibrated by rotating the tool head about a vertical or opposite to the vertical slightly inclined axis of rotation, the tool head is brought into a defined rotational position within the movement space with a known position and/or alignment of the at least two movable arms and is moved to a defined distance from an object and/or fixed contact point and then by rotating the tool head in contact with this object and/or brought to the contact point and the new rotational position reached in the process is recorded and processed for calibrating the rotary drive of the tool head.
Alle beschriebenen Verfahrensvarianten haben den Vorteil gemeinsam, dass sie jeweils präzise Neukalibrierungen von unterschiedlich ausgestalteten und/oder ausgestatteten Parallelkinematik-Robotern ohne jegliche manuelle Eingriffe ermöglichen.All of the method variants described have the advantage in common that they allow precise recalibration of differently configured and/or equipped parallel kinematic robots without any manual intervention.
Mittels einer speziell definierten Bewegungsabfolge, welche in Abhängigkeit des aktuellen Haltemoments der Oberarme ermittelt wird, kann der Roboter aus jeglicher Position annähernd in die Mitte seines Arbeitsbereichs verbracht werden. Anschließend erfolgt das Anheben der Oberarme bis zum mechanischen Anschlag des Teleskop-Kardangelenks, sofern ein solches vorhanden ist. Bei fehlender teleskopierbarer Kardanwelle kann auch ein definiertes Grenzdrehmoment als sinnvolle Positionierungshilfe für eine Mittellage eines an den beweglichen Armen aufgehängten Werkzeugkopfes dienen. Ist dies erfolgt, werden sämtliche Oberarme in eine Position gefahren um danach wiederum jede einzelne Oberarmachse gegen deren mechanischen Endanschlag zu bewegen. Auf diese Weise kann eine erhebliche Reduzierung des erforderlichen personellen Arbeits- und Zeitaufwands erreicht werden, dafür eine Kalibrierung typischerweise nur noch eine Taste in einer Bedieneinheit gedrückt werden muss. Anschließend kann eine vollständig automatische Kalibrierung des Tripoden bzw. des Parallelkinematik-Roboters ablaufen.Using a specially defined movement sequence, which is determined depending on the current holding torque of the upper arms, the robot can be moved from any position to approximately the middle of its working area. The upper arms are then raised up to the mechanical stop of the telescopic cardan joint, if one is available. If there is no telescoping cardan shaft, a defined limit torque can also serve as a useful positioning aid for a central position of a tool head suspended from the movable arms. Once this is done, all upper arms are in one position driven to then in turn move each individual upper arm axis against its mechanical end stop. In this way, a considerable reduction in the required personnel work and time expenditure can be achieved, for which a calibration typically only has to be pressed on a control unit. A fully automatic calibration of the tripod or the parallel kinematics robot can then take place.
Zur Erreichung des oben genannten Ziels schlägt die vorliegende Erfindung weiterhin eine programmgesteuerte Handhabungseinrichtung, insbesondere einen programmgesteuerten Handhabungs- und/oder Parallelkinematik-Roboter mit an mindestens zwei parallelkinematisch beweglichen Armen aufgehängtem Werkzeugkopf vor, wobei jeder der mindestens zwei Arme einen um eine definierte Oberarm-Schwenkachse motorisch zwischen zwei Endlagen beweglichen Oberarm sowie einen am Oberarm schwenkbeweglich gelagerten Unterarm umfasst, und wobei die Arme den an den mindestens zwei Unterarmen beweglich aufgehängten Werkzeugkopf halten, der eine bewegliche Antriebsverbindung, insbesondere eine längenvariable und/oder gelenkig bewegliche Kardanwelle zwischen einem ortsfesten Antriebsmotor und dem um mindestens eine Drehachse beweglichen Werkzeugkopf aufweist, und der mittels programmgesteuerter und aufeinander abgestimmter Schwenkbewegungen der Oberarme sowie der dadurch geführten Unterarme innerhalb eines definierten Bewegungsraumes beweglich ist. Es ist vorgesehen, dass die Steuerungsprogramme zur Steuerung aller Bewegungen der mindestens zwei beweglichen Arme in einer zentralen Steuerungseinheit abgespeichert sind und ein Referenzierungs-, Kalibrierungs- und/oder Initialisierungsprogramm oder mehrere Referenzierungs-, Kalibrierungs- und/oder Initialisierungsprogramme umfassen, die zur Durchführung eines der zuvor beschriebenen Verfahrensvarianten vorgesehen und geeignet sind.To achieve the above-mentioned goal, the present invention also proposes a program-controlled handling device, in particular a program-controlled handling and/or parallel kinematics robot with a tool head suspended on at least two parallel kinematically movable arms, with each of the at least two arms pivoting about a defined upper arm pivot axis comprises an upper arm that can be moved by motor between two end positions and a lower arm that is pivotably mounted on the upper arm, and wherein the arms hold the tool head that is movably suspended on the at least two lower arms and has a movable drive connection, in particular a length-variable and/or articulated cardan shaft between a stationary drive motor and the has a tool head movable about at least one axis of rotation, and by means of program-controlled and coordinated pivoting movements of the upper arms and the lower arms guided thereby within a defined rt movement space is movable. It is provided that the control programs for controlling all movements of the at least two movable arms are stored in a central control unit and include a referencing, calibration and/or initialization program or multiple referencing, calibration and/or initialization programs that are used to carry out a of the method variants described above are provided and suitable.
Die solchermaßen charakterisierte programmgesteuerte Handhabungseinrichtung bzw. der Handhabungs- und/oder Parallelkinematik-Roboter kann bspw. als Handhabungs- und/oder Positionierungsroboter einen Teil einer Förder-, Stapel- und/oder Palettiervorrichtung, insbesondere zur Förderung, Handhabung, Stapelung und/oder zur Palettierung von Stückgütern und/oder Gebinden bilden.The program-controlled handling device characterized in this way or the handling and/or parallel kinematics robot can, for example as a handling and/or positioning robot, be part of a conveying, stacking and/or palletizing device, in particular for conveying, handling, stacking and/or for Palletizing piece goods and/or containers.
Wahlweise kann die programmgesteuerte Handhabungseinrichtung bzw. der Handhabungs- und/oder Parallelkinematik-Roboter auch als Handhabungs- und/oder Manipulationsroboter einen Teil einer Fertigungs- und/oder Werkstückbehandlungsvorrichtung bilden, die insbesondere zur Herstellung, Behandlung und/oder Veränderung von Werkstücken in einer Fertigungsumgebung dienen kann.Optionally, the program-controlled handling device or the handling and/or parallel kinematics robot can also function as a handling and/or manipulation robot as part of a production and/or Form workpiece treatment device that can be used in particular for the production, treatment and / or modification of workpieces in a manufacturing environment.
Es sei an dieser Stelle ausdrücklich erwähnt, dass alle Aspekte und Ausführungsvarianten, die im Zusammenhang mit dem oben beschriebenen erfindungsgemäßen Verfahren erläutert wurden, gleichermaßen Teilaspekte der erfindungsgemäßen programmgesteuerte Handhabungseinrichtung bzw. des erfindungsgemäßen programmgesteuerten Handhabungs- und/oder ParallelkinematikRoboters betreffen oder sein können. Wenn daher an einer Stelle bei der Beschreibung oder auch bei den Anspruchsdefinitionen zum erfindungsgemäßen Verfahren von bestimmten Aspekten und/oder Zusammenhängen und/oder Wirkungen die Rede ist, so gilt dies gleichermaßen für die erfindungsgemäße Handhabungseinrichtung bzw. den erfindungsgemäßen Roboter. In umgekehrter Weise gilt dasselbe, so dass auch alle Aspekte und Ausführungsvarianten, die im Zusammenhang mit der erfindungsgemäßen programmgesteuerten Handhabungseinrichtung erläutert wurden, gleichermaßen Teilaspekte des erfindungsgemäßen Verfahrens betreffen oder sein können. Wenn daher an einer Stelle bei der Beschreibung oder auch bei den Anspruchsdefinitionen zur erfindungsgemäßen Handhabungseinrichtung von bestimmten Aspekten und/oder Zusammenhängen und/oder Wirkungen die Rede ist, so gilt dies gleichermaßen für das erfindungsgemäße Verfahren.It should be expressly mentioned at this point that all aspects and design variants that have been explained in connection with the method according to the invention described above equally relate or can be partial aspects of the program-controlled handling device according to the invention or the program-controlled handling and/or parallel kinematic robot according to the invention. Therefore, if certain aspects and/or connections and/or effects are mentioned at one point in the description or in the claim definitions for the method according to the invention, this applies equally to the handling device according to the invention or the robot according to the invention. The same applies in reverse, so that all aspects and design variants that have been explained in connection with the program-controlled handling device according to the invention equally relate to or can be partial aspects of the method according to the invention. Therefore, if certain aspects and/or connections and/or effects are mentioned at one point in the description or in the definition of claims for the handling device according to the invention, this applies equally to the method according to the invention.
Im Folgenden sollen Ausführungsbeispiele die Erfindung und ihre Vorteile anhand der beigefügten Figuren näher erläutern. Die Größenverhältnisse der einzelnen Elemente zueinander in den Figuren entsprechen nicht immer den realen Größenverhältnissen, da einige Formen vereinfacht und andere Formen zur besseren Veranschaulichung vergrößert im Verhältnis zu anderen Elementen dargestellt sind.
-
Fig. 1 zeigt eine Ausführungsvariante einer Maschinenumgebung, die insbesondere Teil einer Förder-, Handhabungs- und Paletteriermaschine zur Behandlung von Gebinden mit mehreren Getränkebehältern sein kann. -
Figuren 2A bis 2H zeigen in aufeinander folgenden Sequenzen verschiedene Kalibrierungsschritte einer Handhabungseinrichtung am Beispiel eines ParallelkinematikRoboters, der Teil der Maschinenumgebung gemäßFig. 1 sein kann. -
Figuren 3A bis 3C zeigen in drei aufeinander folgenden Sequenzen verschiedene Schritte eines weiteren Kalibrierungsverfahrens der Handhabungseinrichtung bzw. des Parallelkinematik-Roboters.
-
1 shows an embodiment variant of a machine environment, which can in particular be part of a conveying, handling and palletizing machine for treating packages with several beverage containers. -
Figures 2A to 2H show in successive sequences different calibration steps of a handling device using the example of a parallel kinematic robot, which is part of the machine environment according to1 can be. -
Figures 3A to 3C show in three consecutive sequences different steps of a further calibration method of the handling device or the parallel kinematics robot.
Für gleiche oder gleich wirkende Elemente der Erfindung werden in den
Die schematische Perspektivansicht der
Dieses mittels der Handhabungseinrichtung 18 in gewünschter Weise geformte Lagenbild kann anschließend in Transportrichtung 12 weiterbefördert und von der Auflage- und Transportfläche 16 an eine nachgeordnete Förderfläche 20 übergeben werden, wo ggf. noch bestehende Lücken zwischen den in das Lagenbild gebrachten Packgütern, Stückgütern oder Gebinden mittels quer zur Transportrichtung 12 und horizontal in Richtung zu den Seitenkanten des Lagenbildes verschiebbarer Anlagebalken 22 und/oder mittels wenigstens eines heb- und senkbaren und damit quer zur Transportrichtung 12 bringbaren Anlagebalkens 22 durch Zusammenschieben der Packgüter, Stückgüter oder Gebinde geschlossen werden können.This formed by the handling device 18 in the desired manner layer pattern can then be transported further in the
Die solchermaßen aus den mittels der Handhabungseinrichtung 18 in der Handhabungsstation 14 manipulierten und arrangierten Packgütern, Stückgütern oder Gebinden gebildeten Lagenanordnungen können in einer der Förderfläche 20 nachgeordneten, hier jedoch nicht gezeigten Palletierstation vorzugsweise jeweils lagenweise übereinander gestapelt und auf einer Palette zur weiteren Verpackung, Handhabung und/oder für einen Transport abgelegt und einem Versand zugänglich gemacht werden.The layered arrangements formed in this way from the packaged goods, piece goods or bundles manipulated and arranged by means of the handling device 18 in the
Wie es die
Zudem halten die Arme 26 den an den insgesamt drei Unterarmen beweglich aufgehängten Werkzeugkopf 28, der mittels programmgesteuerter und aufeinander abgestimmter Schwenkbewegungen der Oberarme sowie der dadurch geführten Unterarme innerhalb eines definierten Bewegungsraumes 30 im Bereich der Auflage- und Transportfläche 16 beweglich ist. Was ebenfalls in der
Diese Rotationsbewegungen können insbesondere mittels einer kardanisch beweglichen Antriebswelle 30 veranlasst und gesteuert werden, die in vertikaler oder schräger Richtung von einer oberen Aufhängung 32 des Parallelkinematik-Roboters 24 zum Werkzeugkopf 28 nach unten führt. Die obere Aufhängung 32, an der die Oberarme der beweglichen Arme 26 sowie deren Antriebsmotoren gelagert sowie auch der wenigstens eine Antriebsmotor für die Kardanwelle oder Antriebswelle 30 bildet einen oberen Teil eines Rahmengestells 34 der Handhabungsstation 14. Die gesamte Handhabungseinrichtung 18 bzw. der Parallelkinematik-Roboter 24 sind an dieser oberen Aufhängung 32 gehalten und in der beschriebenen Weise beweglich gelagert.These rotational movements can be initiated and controlled, in particular, by means of a cardanically
Eine für solche Parallelkinematik-Roboter 24 übliche Bauweise sieht jeweils Schwenklagerungen der insgesamt drei beweglichen Arme 26 an der oberen Aufhängung 32 vor, wobei die Oberarme 36 jeweils um horizontale Schwenkachsen 38 bewegt werden können, die unterhalb der oberen Aufhängung 32 angeordnet sind. Sowohl die um die horizontalen Schwenkachsen 38 beweglichen Oberarme 36, an denen die den Werkzeugkopf 28 haltenden Unterarme 40 schwenkbar angeordnet sind, als auch die für die Rotationsbewegungen des Werkzeugkopfes 28 und der daran angeordneten Greiferbacken (nicht verdeutlicht) verantwortliche Antriebswelle 30 sind typischerweise elektromotorisch betrieben, wobei die in der oberen Aufhängung 32 verankerten jeweiligen Antriebsmotoren 42 für die Oberarme 36 und 44 für die Antriebswelle 30 anhand der nachfolgend näher erläuterten
Ein besonderer Vorteil der für die Handhabungseinrichtung 18 verwendeten elektrischen Antriebsmotoren 42 und 44 besteht einerseits in der damit erreichbaren hohen Stellpräzision, wie sie für die exakte Führung des Werkzeugkopfes 28 innerhalb des Bewegungsraumes oberhalb der Auflage- und Transportfläche 16 der Handhabungsstation 14 (vgl.
Es sei an dieser Stelle darauf hingewiesen, dass der Parallelkinematik- oder Handhabungsroboter 24, der Gegenstand des erfindungsgemäßen Kalibrierungsverfahrens ist, im gezeigten Ausführungsbeispiel drei gleich dimensionierte und jeweils in 120°-Winkelversatz zueinander angeordnete Oberarme 36 mit jeweils identischen Unterarmen 40 und dazwischen beweglich und/oder drehbar aufgehängtem Werkzeugkopf 28 aufweist. Solche sog. Tripode werden in der Praxis häufig eingesetzt und eignen sich in hervorragender Weise zur exakten Bewegungssteuerung, etwa zum Manipulieren von Artikeln, Gegenständen, Stückgütern, Gebinden oder zum Manipulieren von Gruppierungen mit mehreren solcher Artikel, Gegenstände, Stückgüter, Gebinde, wie dies oben bereits unter Bezugnahme auf die
Bei dem anhand der
Um eine möglichst exakte Kalibrierung der beweglichen Komponenten zu ermöglichen, werden in einem ersten Verfahrensschritt (vgl.
Es muss an dieser Stelle nicht gesondert erwähnt werden, dass zur Durchführung dieses ersten Verfahrensschrittes eine für die Ansteuerung der motorischen Antriebe 42 der Oberarme 36 verantwortliche zentrale Steuerungseinheit (nicht dargestellt) eingeschaltet und das dort implementierte Steuerungsprogramm gestartet ist, was bspw. nach einer Abschaltphase einen gewissen Zeitraum für den Programmstart erfordert. Normalerweise werden in dieser Startphase auch alle motorischen Antriebe 42 initialisiert und referenziert, um jeden Steuerungsbefehl zum Antrieb der Stellmotoren 42 in möglichst exakte Antriebsbewegungen umsetzen zu können.It does not need to be mentioned separately at this point that, in order to carry out this first method step, a central control unit (not shown) responsible for controlling the motorized drives 42 of the
Bei dem hier beschriebenen ersten Verfahrensschritt, bei dem mittels einer Erfassung der an den horizontalen Oberarm-Schwenkachsen 38 wirksamen Lastmomente und mittels eines Vergleiches der auf die Oberarme 36 wirkenden jeweiligen Lastmomente mit Hilfe der motorischen Antriebe 42 jeweils ungefähr übereinstimmende Winkellagen der drei Oberarme 36 eingestellt werden, besteht das vorrangige und für das erfindungsgemäße Kalibrierungsverfahren charakteristische Ziel darin, für den Werkzeugkopf 28 eine ungefähr mittige Position innerhalb seines Bewegungs- und/oder Manipulationsraumes zu finden, was mangels optischer oder sonstiger Positionskontrolle am sinnvollsten über die Erfassung der auf die Oberarme 36 wirkenden Lastmomente bei unbelastetem Werkzeugkopf 28 erfolgen kann. Hierzu können die Oberarme 36 bedarfsweise nacheinander um relativ kleine Verstellwinkel solange verstellt bzw. auf und ab bewegt werden, bis sie innerhalb eines sinnvollen Hysteresebereiches ihrer Lastmomente von bspw. weniger als einem Newtonmeter ein übereinstimmendes Lastmoment aufweisen.In the first method step described here, in which roughly matching angular positions of the three
Dieser sinnvolle bzw. für die Praxis vorteilhaft einsetzbare Hysteresebereich kann wahlweise auch weniger als 0,5 Nm, insbesondere weniger als ca. 0,3 Nm betragen, so dass die Oberarme 36 ein innerhalb dieser Grenzen übereinstimmendes Lastmoment aufweisen können, was als Einstellung gleicher Stellwinkel erkannt bzw. angenommen werden kann. Auf diese Weise kann sichergestellt werden, dass die an den Oberarmen 36 mittels ihrer Antriebsmotoren 42 eingestellten Winkellagen sowohl jeweils Mindestdifferenzwinkel zu den oberen und unteren Endlagen aufweisen als auch einen Aufenthaltsort des Werkzeugkopfes 28 definieren, der sich innerhalb eines definierten Abstandes zu einer ungefähr mittigen Lage innerhalb seines Bewegungsraumes befindet. Es kann daher angenommen werden, dass der Werkzeugkopf 28 nach dieser Einstellungsprozedur des ersten Verfahrensschrittes nahezu mittig innerhalb des Bewegungsraumes und zwischen den drei beweglichen Armen 26 des ParallelkinematikRoboters 24 steht bzw. hängt.This useful hysteresis range, which can be used advantageously in practice, can also be less than 0.5 Nm, in particular less than approx can be recognized or accepted. In this way, it can be ensured that the angular positions set on the
Nachdem diese mittige Position des Werkzeugkopfes 28 bei ungefähr horizontal ausgerichteten Oberarmen 36 erreicht ist, werden die Oberarme 36 gleichzeitig und synchron in langsamer Verstellbewegung nach oben verschwenkt, was in
Da bei einer solchermaßen teleskopierbaren Antriebswelle 30 die kürzest mögliche Längeneinstellung eine nicht überwindbare mechanische Begrenzung darstellt, ist eine Berücksichtigung der Grenzen der Teleskopierbarkeit der Antriebswelle 30 zwingend zu berücksichtigen, zumal dieser Anschlag auch Auswirkungen auf die Ausdehnung des Bewegungsraumes des Werkzeugkopfes 28 nach oben hat.Since with a
Da jedoch nicht alle Parallelkinematik-Roboter 24 mit drehbaren Werkzeugköpfen 28 und damit mit solchen Antriebswellen 30 ausgestattet sein müssen, sondern in einfacheren Ausführungsvarianten auch ohne eine solche Antriebswelle 30 auskommen können, wird der anhand der folgenden Figuren erläuterte folgende Kalibrierungsablauf als zweiter Verfahrensschritt, d.h. ohne Berücksichtigung der Erfassung des mechanischen Anschlages der in ihrer Längsrichtung teleskopierbaren Antriebswelle 30 bezeichnet.However, since not all parallel kinematic robots 24 have to be equipped with rotatable tool heads 28 and thus with
Nachdem der obere Anschlag für die teleskopierbare Antriebswelle 30 gemäß
Die hierbei durchgeführten Schwenk-, Hebe- und Senkbewegungen sind durch Pfeile angedeutet, wobei lediglich der in
Anschließend kann der jeweilige Oberarm 36 aus seiner zuvor eingestellten oberen Endlage wieder ungefähr in die zuvor eingenommene Ausgangswinkellage zurückbewegt werden, was der Ausrichtung der Arme 26 gemäß
Da nicht nur einer der Oberarme 36, sondern auch die beiden weiteren Oberarme 36 in derselben Weise zu referenzieren sind, kann in einem dritten Verfahrensschritt ein weiterer Oberarm 36 der Handhabungseinrichtung 18 oder des Handhabungsroboters 24 durch motorisches Verschwenken um seine Oberarm-Schwenkachse 38 in dieselbe der beiden Endlagen gebracht werden, die auch im zweiten Verfahrensschritt (
Weiterhin kann erwähnt werden, dass es im Zusammenhang mit den oben erläuterten Verfahrensschritten des erfindungsgemäßen Verfahrens sinnvoll ist, während der Durchführung der zweiten und/oder dritten und/oder vierten und/oder fünften Verfahrensschritte und den entsprechenden motorischen Bewegungen der Oberarme eine permanente und/oder eine in definierten Zeitabständen wiederholte Erfassung der jeweiligen Antriebsdrehmomente durchzuführen, da eine solche permanente Erfassung und Überwachung in vorteilhafter Weise dazu genutzt werden kann, um bei einer festgestellten Überschreitung eines vorgegebenen und/oder variabel definierbaren Differenzwertes für in aufeinanderfolgenden Messungen gewonnene Drehmomentwerte einen mechanischen Anschlag und/oder Endanschlag für den jeweils betroffenen Oberarm erkennen zu können.Furthermore, it can be mentioned that it makes sense in connection with the method steps of the method according to the invention explained above, while performing the second and/or third and/or fourth and/or fifth method steps and the corresponding motor movements of the upper arms to carry out a repeated recording of the respective drive torques at defined time intervals, since such a permanent recording and monitoring can be used in an advantageous manner to detect a mechanical stop and/or a mechanical stop and/or a mechanical stop and/or a mechanical stop and/or a mechanical stop and/or or end stop for the affected upper arm.
Eine derartige Drehmomentlimitierung erlaubt es, nur aufgrund einer Erfassung der aufzuwendenden elektrischen Ströme und ohne jegliche optische oder sonstige sensorische Bewegungserfassung einen existierenden mechanischen Anschlag für jede der durchgeführten Schwenkbewegungen der motorisch angetriebenen Oberarme zuverlässig zu erfassen, wobei dieser mechanische Anschlag normalerweise durch ein Drehmomentlimit charakterisiert ist. Ein solches Drehmomentlimit muss keineswegs fest vorgegeben sein, sondern kann durch permanente dynamische Änderungsmöglichkeit in vorteilhafter Weise für unterschiedliche Winkelstellungen und damit zusammenhängend unterschiedliche Drehmomentwerte bei einem Bewegungsablauf eingesetzt und genutzt werden. Daraus folgt auch die universelle Einsetzbarkeit und Funktionsfähigkeit der beschriebenen Referenzierung auch bei unterschiedlichen Greifern oder Tripod-Robotern, die bspw. mit unterschiedlich dimensionierten Armen und/oder unterschiedlich dimensionierten und damit unterschiedlich schweren Werkzeugköpfen ausgestattet sein können.Such a torque limitation makes it possible to reliably detect an existing mechanical stop for each of the pivoting movements of the motor-driven upper arms carried out only on the basis of detecting the electrical currents to be applied and without any optical or other sensory motion detection, with this mechanical stop usually being characterized by a torque limit. Such a torque limit does not have to be fixed, but can be used and used in an advantageous manner for different angular positions and associated different torque values in a movement sequence due to the permanent dynamic possibility of change. This also results in the universal applicability and functionality of the referencing described, even with different grippers or tripod robots, which can be equipped, for example, with differently dimensioned arms and/or tool heads that are dimensioned differently and therefore have different weights.
Beim Starten der Zentrierung im Rahmen eines Kalibrierungsvorganges kann es von Vorteil sein, denjenigen Oberarm zu identifizieren, der bei einer Verstellung den höchsten Drehmomentwert liefert. Dieses ermittelte Drehmoment kann bspw. dazu verwendet werden, um auf Grundlage dieses Wertes, ggf. zuzüglich eines sinnvollen Zuschlages von bspw. 0,5 bis etwa 1,5 Nm, ein passendes Drehmomentlimit für den nachfolgenden Kalibrierungsvorgang zu setzen. Während des Vorganges der Zentrierung des Werkzeugkopfes kann dieses ermittelte Drehmoment ausreichen, um ohne Überschreitung dieses Drehmomentlimits den Werkzeugkopf in die Mitte seines Bewegungsraumes zu verfahren.When starting the centering as part of a calibration process, it can be advantageous to identify the upper arm that delivers the highest torque value during an adjustment. This determined torque can, for example be used to set a suitable torque limit for the subsequent calibration process on the basis of this value, if necessary plus a reasonable addition of, for example, 0.5 to about 1.5 Nm. During the process of centering the tool head, this determined torque can be sufficient to move the tool head to the center of its range of motion without exceeding this torque limit.
Zudem kann das Verfahren vorsehen, dass eine iterative Drehmomenterfassung beim Verschwenken (Hochfahren) in Richtung der ausgewählten Endlage wenigstens eines der Oberarme an seinen jeweiligen Endanschlag vorgesehen ist. Hierdurch kann bei der Durchführung des Verfahrens ständig erkannt werden, ob bereits eine Endlage und damit ein mechanischer Anschlag erreicht wurde. Kommt es nämlich während einer Bewegung eines der Oberarme zum Überschreiten des zuvor ermittelten Drehmomentlimits, so wird überprüft, ob die betreffende Achse seit dem Setzen des Drehmomentlimits oder der letzten Drehmomenterhöhung sich um einen definierten kleinen Schwenkwinkel von bspw. mehr als 0,3° bewegt hat. Ist dies der Fall, so wird dies nicht als Kollision bzw. als Erreichen des mechanischen Anschlages erkannt, sondern lediglich als Aussage, dass das vom Antrieb erzeugte Drehmoment nicht ausreicht zur Bewegung der entsprechenden Achse. Wenn anschließend das Drehmomentlimit um einen sinnvollen Wert von bspw. ca. 0,5 Nm erhöht wird, kann auf dieser Basis die Schwenkbewegung fortgesetzt werden. War jedoch die Achsbewegung bei der gemessenen Drehmomenterhöhung geringer als der definierte kleine Differenzwinkel von bspw. 0,3°, so kann bei dem erfindungsgemäßen Verfahren davon ausgegangen werden, dass eine Kollision bzw. ein Erreichen einer Endlage oder eines mechanischen Endanschlags stattgefunden hat.In addition, the method can provide that an iterative torque detection is provided when pivoting (moving up) in the direction of the selected end position of at least one of the upper arms at its respective end stop. As a result, when the method is being carried out, it can be continuously recognized whether an end position and thus a mechanical stop has already been reached. If the previously determined torque limit is exceeded during a movement of one of the upper arms, a check is carried out to determine whether the axis in question has moved by a defined small swivel angle of, for example, more than 0.3° since the torque limit was set or the last torque increase . If this is the case, this is not recognized as a collision or as reaching the mechanical stop, but only as a statement that the torque generated by the drive is not sufficient to move the corresponding axis. If the torque limit is then increased by a reasonable value of around 0.5 Nm, for example, the pivoting movement can be continued on this basis. However, if the axis movement during the measured increase in torque was less than the defined small differential angle of, for example, 0.3°, it can be assumed in the method according to the invention that a collision or an end position or a mechanical end stop has been reached.
Dieses beschriebene Verfahren kann beim Erreichen aller denkbaren mechanischen Anschläge für den Handhabungsroboter verwendet werden, so bspw. auch beim Aufsetzen des Werkzeugkopfes auf einer unterhalb seines Bewegungsraumes befindlichen Plattform oder einer dort befindlichen Horizontalfördereinrichtung, die bspw. durch eine Mattenkette o. dgl. Fördereinrichtung gebildet sein kann. Da es nicht sinnvoll ist, den Werkzeugkopf gegen diese Horizontalfördereinrichtung zu bewegen, insbesondere gegen diese untere Auflagefläche nach unten zu drücken, kann auch diese erreichte Position erkannt und bei dem Kalibrierungsverfahren als untere Endlage definiert werden. Sofern ein solcher sinnvoller Test mit einem Aufsetzen des Greifers an seinem unteren Endanschlag durchgeführt wurde, kann er anschließend angehoben und die Zentrierung erneut durchgeführt werden, um die oberen Endanschläge zur Kalibrierung anzufahren.This described method can be used when all conceivable mechanical stops for the handling robot are reached, for example when the tool head is placed on a platform below its movement space or on a horizontal conveyor device located there, which can be formed by a mat chain or similar conveyor device can. Since it does not make sense to move the tool head against this horizontal conveying device, in particular to press it down against this lower bearing surface, this position that has been reached can also be recognized and defined as the lower end position in the calibration method. If such a meaningful test was carried out with a touchdown of the gripper at its lower end stop, it can then be raised and the Centering must be carried out again in order to approach the upper end stops for calibration.
Die schematische Darstellung der
Ein am Werkzeugkopf 28 angeordneter und dort aufgehängter Greifarm ist aus Vereinfachungsgründen nicht dargestellt, dient aber als zu kontaktierendes Teil, der mit dem Gegenstand und/oder feststehenden Anlagepunkt 48 in Kontakt gebracht wird, um die Drehbewegungen der Antriebswelle 30 und die Antriebsbewegungen des hierfür verantwortlichen Antriebsmotors 44 zu kalibrieren.A gripping arm arranged on
Wenn auch im Zusammenhang der Figuren generell von "schematischen" Darstellungen und Ansichten die Rede ist, so ist damit keineswegs gemeint, dass die Figurendarstellungen und deren Beschreibung hinsichtlich der Offenbarung der Erfindung von untergeordneter Bedeutung sein sollen. Der Fachmann ist durchaus in der Lage, aus den schematisch und abstrakt gezeichneten Darstellungen genug an Informationen zu entnehmen, die ihm das Verständnis der Erfindung erleichtern, ohne dass er etwa aus den gezeichneten und möglicherweise nicht exakt maßstabsgerechten Größenverhältnissen der beweglichen Teile der Handhabungseinrichtung 18 oder anderer gezeichneter Elemente in irgendeiner Weise in seinem Verständnis beeinträchtigt wäre. Die Figuren ermöglichen es dem Fachmann als Leser somit, anhand der konkreter erläuterten Umsetzungen des erfindungsgemäßen Verfahrens ein besseres Verständnis für den in den Ansprüchen sowie im allgemeinen Teil der Beschreibung allgemeiner und/oder abstrakter formulierten Erfindungsgedanken abzuleiten.Even if "schematic" representations and views are generally referred to in connection with the figures, this in no way means that the representations in the figures and their description are to be of secondary importance with regard to the disclosure of the invention. The person skilled in the art is quite capable of deriving enough information from the diagrammatic and abstractly drawn illustrations to make it easier for him to understand the invention, without having to go out of his way the drawn and possibly not exactly true-to-scale proportions of the moving parts of the handling device 18 or other drawn elements would in any way impair his understanding. The figures enable the person skilled in the art as a reader to derive a better understanding of the inventive concept formulated more generally and/or more abstractly in the claims and in the general part of the description on the basis of the more concretely explained implementations of the method according to the invention.
- 8 Maschinenumgebung8 machine environment
- 10 Horizontalfördereinrichtung10 horizontal conveyor
- 12 Transportrichtung, Förderrichtung12 transport direction, conveying direction
- 14 Handhabungsstation14 handling station
- 16 Auflage- und Transportfläche16 support and transport surface
- 18 Handhabungseinrichtung18 handling device
- 20 Förderfläche20 conveying surface
- 22 Anlagebalken22 investment bars
- 24 Parallelkinematik-Roboter, Handhabungsroboter24 parallel kinematic robots, handling robots
- 26 Arm, beweglicher Arm26 arm, articulated arm
- 28 Werkzeugkopf28 tool head
- 30 Antriebswelle, Kardanwelle, Antriebsverbindung30 drive shaft, cardan shaft, drive connection
- 32 obere Aufhängung32 upper suspension
- 34 Rahmengestell34 frame
- 36 Oberarm36 upper arm
- 38 horizontale Schwenkachse38 horizontal pan axis
- 40 Unterarm40 forearm
- 42 Antriebsmotor (für Oberarm)42 drive motor (for upper arm)
- 44 Antriebsmotor (für Antriebswelle)44 drive motor (for drive shaft)
- 46 Drehachse (Werkzeugkopf, rotierbarer Werkzeugkopf)46 axis of rotation (tool head, rotatable tool head)
- 48 Anlagepunkt, fester Gegenstand48 point of attachment, solid object
Claims (12)
- A method for referencing, calibrating, and/or initialising a handling device (18), in particular, a handling robot and/or parallel kinematic robot (24), with a tool head (28) suspended from at least two parallel-kinematically movable arms (26), which tool head (28) has a movable drive connection, in particular, a length-variably and/or articulately movable cardan shaft (30) between a stationary drive motor (44) and the tool head (28), which is movable about at least one rotational axis,- wherein each of the at least two arms (26) comprises an upper arm (36), which is motor-movable between two end positions about a defined upper-arm swivel axis (38), as well as also comprising a lower arm (40), which is mounted swivelably movable on the upper arm (36),- and wherein the arms (26) hold the tool head (28), which is movably suspended from the at least two lower arms (40), and which is movable within a defined movement range by program-controlled and mutually coordinated swivel movements of the upper arms (36) as well as of the thereby guided lower arms (40),- characterised in that corresponding angular positions of the at least two upper arms (36) are in each instance adjusted by the motor drives (42) in a first method step by detection of the load torques acting on the upper-arm swivel axes (38) and by comparison of the particular load torques acting on the at least two upper arms (36) and/or by detection of signals from position sensors and/or angle sensors,- whereupon the at least two upper arms (36) are moved in a second method step by simultaneous and/or approximately synchronous swivelling about their particular swivel axes (38) up to a limit position, which is defined by a mechanical stop of the drive connection to the tool head (28), which drive connection is movable independently of the upper arms (36), and whereupon the tool head (28) and/or the drive connection assigned thereto is/are in a third method step distanced by a defined swivel angle from the limit position by a return movement of the at least two upper arms (36),- whereby the adjusted angular positions of the at least two upper arms (36) in each instance have defined difference angles to the two end positions and/or define a situation of the tool head (28) located within a defined distance to a central position within the movement range,- wherein at least one of the at least two upper arms (36) of the handling device (18) is brought into one of the two end positions in a further or fourth method step by motorised swivelling about the particular upper-arm swivel axis (38); and the angular position reached in this connection is sensor-detected and used for the position initialisation and/or angle initialisation of the particular upper arm (36), whereupon the upper arm (36) is returned from its end position into a defined angular position and/or into the previously assumed initial angular position,- and whereupon a further of the at least two upper arms (36) of the handling device (18) is brought into one of its two end positions in a subsequent further or fifth method step by motorised swivelling about the particular upper-arm swivel axis (38) with said end position also having been selected in the previous or fourth method step; and the angular position reached in this connection is sensor-detected and used for the position initialisation and/or angle initialisation of the relevant upper arm (36).
- The method according to claim 1, in which a third of a total of at least three present upper arms (36) of the handling device (18) is brought into one of its two or into the same of the two end positions in a further or sixth method step following the fifth method step by motorised swivelling about its upper-arm swivel axis (38) with said end position also having been selected for each of the other swivelled upper arms (36) in the fourth and in the fifth method step; and the angular position reached in this connection is sensor-detected and used for the position initialisation and/or angle initialisation of the relevant upper arm (36).
- The method according to claim 2, in which a fourth of a total of at least four present upper arms (36) of the handling device (18) is brought into one of its two or into the same of the two end positions in a further or seventh method step following the sixth method step by motorised swivelling about its upper-arm swivel axis (38) with said end position also having been selected for each of the other swivelled upper arms (36) in the fourth, in the fifth, and also in the sixth method step; and the angular position reached in this connection is sensor-detected and used for the position initialisation and/or angle initialisation of the relevant upper arm (36).
- The method according to one of the claims 1 to 3, in which a detection of the particular drive torques is performed in a permanent manner and/or repeated at defined intervals during the carrying out of the second and/or third and/or fourth and/or fifth and/or sixth and/or seventh method steps and during the corresponding motorised movements of the upper arms (36); and wherein an exceeding of a specified difference value for successive torque values is identified as mechanical stop and/or end stop for the particular relevant upper arm (36).
- The method according to claim 4, in which an iterative torque detection during the swivelling toward the selected end position of at least one of the upper arms (36) to its particular end stop is provided.
- The method according to one of the claims 1 to 3, in which a detection of the particular angular positions of the upper arms (36) is performed in a permanent manner and/or repeated at defined intervals during the carrying out of the second and/or third and/or fourth and/or fifth and/or sixth and/or seventh method steps and during the corresponding motorised movements of the upper arms (36); and wherein a falling below of a specified difference value for successively measured angular positions of a particular upper arm (36) is identified as mechanical stop and/or end stop for the particular relevant upper arm (36).
- The method according to claim 6, in which an iterative angle detection during the swivelling toward the selected end position of at least one of the upper arms (36) to its particular end stop is provided.
- The method according to claim 6 or 7, in which, after having reached the upper and/or lower limit position defined by the mechanical stop for the angular position of the upper arms (36), the second and/or third and/or fourth and/or fifth and/or sixth and/or seventh method steps are performed in consideration of the maximally reachable angular position of the upper arms (36) in an adjustment together.
- The method according to one of the claims 1 to 8, in which an angular position of the tool head (38), which is suspended from the at least two parallel-kinematically movable arms (26), is calibrated in an alternative and/or further method step by the tool head (28) being brought into a defined angular position within the movement range with the position and/or orientation of the at least two movable arms (26) being known, which tool head (28) is rotatable about a rotational axis (46), and which rotational axis (46) is vertical or slightly inclined in relation to the vertical, and by the tool head (28) being moved to a defined distance from an object and/or from a stationary contact point (48), and by the tool head (28) subsequently being brought into contact with said object and/or contact point (48) by rotating the tool head (28), and by the new angular position reached thereby being detected and processed for the calibration of the rotary drive (44) of the tool head (28).
- A program-controlled handling device (18), in particular, a handling robot and/or parallel kinematic robot (24), with a tool head (28) suspended from at least two parallel-kinematically movable arms (26), wherein each of the at least two arms (26) comprises an upper arm (36), which is motor-movable between two end positions about a defined upper-arm swivel axis (38), as well as also comprising a lower arm (40), which is mounted swivelably movable on the upper arm (36), and wherein the arms (26) hold a tool head (28), which is movably suspended from at least two lower arms (40), and which tool head (28) has a movable drive connection, in particular, a length-variably and/or articulately movable cardan shaft (30) between a stationary drive motor (44) and the tool head (28), which is movable about at least one rotational axis, and which tool head (28) is movable within a defined movement range by program-controlled and mutually coordinated swivel movements of the upper arms (36) as well as of the thereby guided lower arms (40), wherein the handling device comprises a central control unit, in which control programs for the control of all movements of the at least two movable arms (26) are stored, which control programs comprise a referencing program, calibration program, and/or initialisation program or a plurality of referencing programs, calibration programs, and/or initialisation programs, which are provided and suitable to perform one of the method variants according to one of the claims 1 to 9.
- The program-controlled handling device (18) according to claim 10, which, as handling robot and/or positioning robot, forms a part of a conveying apparatus, stacking apparatus, and/or palletising apparatus, in particular, for the conveying, handling, stacking, and/or palletising of piece goods and/or packs.
- The program-controlled handling device (18) according to claim 10, which, as handling robot and/or manipulation robot, forms a part of a production apparatus and/or workpiece-treatment apparatus, in particular, for the production, treatment, and/or modification of workpieces in a production environment.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
SI201930340T SI3826812T1 (en) | 2018-07-24 | 2019-05-16 | Method and control system for calibrating a handling device |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
DE102018117802.6A DE102018117802A1 (en) | 2018-07-24 | 2018-07-24 | Method and control system for calibrating a handling device, in particular a parallel kinematics robot |
PCT/EP2019/062603 WO2020020505A1 (en) | 2018-07-24 | 2019-05-16 | Method and control system for calibrating a handling device |
Publications (2)
Publication Number | Publication Date |
---|---|
EP3826812A1 EP3826812A1 (en) | 2021-06-02 |
EP3826812B1 true EP3826812B1 (en) | 2022-07-20 |
Family
ID=66625175
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
EP19725330.5A Active EP3826812B1 (en) | 2018-07-24 | 2019-05-16 | Method and control system for calibrating a handling device |
Country Status (7)
Country | Link |
---|---|
US (1) | US11964395B2 (en) |
EP (1) | EP3826812B1 (en) |
CN (1) | CN112368117B (en) |
DE (1) | DE102018117802A1 (en) |
ES (1) | ES2926964T3 (en) |
SI (1) | SI3826812T1 (en) |
WO (1) | WO2020020505A1 (en) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114617114A (en) * | 2022-04-19 | 2022-06-14 | 浙江理工大学 | Solar weeding robot and control method thereof |
CN115535609B (en) * | 2022-08-15 | 2024-08-30 | 安徽浙云科技有限公司 | Transfer robot capable of remotely controlling and determining transfer path |
CN117984342B (en) * | 2023-11-07 | 2024-07-30 | 广州信邦智能装备股份有限公司 | Detection robot |
Family Cites Families (30)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4632560B2 (en) * | 2000-03-01 | 2011-02-16 | シーグ パック システムズ アクチェンゲゼルシャフト | Robots that operate products in a three-dimensional space |
DE10204513A1 (en) * | 2002-02-05 | 2003-08-21 | Probst Gmbh | Gripper device for gripping especially packs of building materials has first arm connected to vehicle and second arm guided on centre piece and movable relative to each other to open and close gripping device |
JP4275632B2 (en) | 2005-03-01 | 2009-06-10 | 新日本工機株式会社 | Calibration method for parallel mechanism mechanism, calibration verification method, calibration verification program, data collection method, and correction data collection method for spatial position correction |
JP4464318B2 (en) | 2005-05-16 | 2010-05-19 | オークマ株式会社 | Calibration method for parallel mechanism machine |
JP4638327B2 (en) | 2005-10-17 | 2011-02-23 | 新日本工機株式会社 | Parallel mechanism device, parallel mechanism device calibration method, calibration program, and recording medium |
JP4809390B2 (en) * | 2008-04-14 | 2011-11-09 | 村田機械株式会社 | Origin calibration method in parallel mechanism and calibration jig for origin calibration |
JP4598864B2 (en) * | 2009-01-29 | 2010-12-15 | ファナック株式会社 | Parallel robot |
CN102049786A (en) * | 2009-11-05 | 2011-05-11 | 鸿富锦精密工业(深圳)有限公司 | Rotating mechanism and robot with same |
DE102009057585B4 (en) * | 2009-12-09 | 2013-11-28 | Multivac Sepp Haggenmüller Gmbh & Co. Kg | Method for calibrating a robot |
DE102010020847A1 (en) * | 2010-05-18 | 2011-11-24 | Krones Ag | gripping device |
JP5408211B2 (en) * | 2011-09-06 | 2014-02-05 | 株式会社安川電機 | Parallel link robot, parallel link robot system, and parallel link robot control method |
US9579788B2 (en) * | 2012-02-10 | 2017-02-28 | Ascent Ventures, Llc | Automated testing and verification of a robotic system |
US9226796B2 (en) * | 2012-08-03 | 2016-01-05 | Stryker Corporation | Method for detecting a disturbance as an energy applicator of a surgical instrument traverses a cutting path |
WO2014029448A1 (en) | 2012-08-24 | 2014-02-27 | Abb Technology Ltd | Calibration tool for a delta robot |
JP5628873B2 (en) | 2012-08-31 | 2014-11-19 | ファナック株式会社 | Parallel link robot |
KR101421351B1 (en) * | 2012-11-30 | 2014-07-18 | (주)에이치아이디 | Parallel robot |
DE102013208082A1 (en) * | 2013-05-02 | 2014-11-06 | Krones Aktiengesellschaft | Device for handling articles |
DE102013106004A1 (en) | 2013-06-10 | 2014-12-11 | Krones Aktiengesellschaft | Device for handling articles and method for operating such a device |
US20160096329A1 (en) * | 2014-10-01 | 2016-04-07 | Flux Technology LLC | 3d tooling machine |
ES2648295T3 (en) * | 2014-11-07 | 2017-12-29 | Comau S.P.A. | Industrial robot and control procedure of an industrial robot |
DE102014223393A1 (en) * | 2014-11-17 | 2016-05-19 | Krones Aktiengesellschaft | Method for handling and / or manipulating articles such as containers or piece goods |
JP6259401B2 (en) * | 2015-01-16 | 2018-01-10 | 矢崎総業株式会社 | Alignment method |
JP2016221645A (en) * | 2015-06-02 | 2016-12-28 | セイコーエプソン株式会社 | Robot, robot control device and robot system |
KR20160143034A (en) | 2015-06-04 | 2016-12-14 | 한화테크윈 주식회사 | Method and apparatus for calibrating a delta robot |
DE102015219610A1 (en) * | 2015-10-09 | 2017-04-13 | Krones Aktiengesellschaft | Parallel kinematic robot and method of handling same |
JP6558850B2 (en) | 2015-10-13 | 2019-08-14 | 株式会社ミツバ | Robot apparatus and parallel robot |
JP6572439B2 (en) * | 2015-12-17 | 2019-09-11 | パナソニックIpマネジメント株式会社 | Working device and working method in working device |
CN105945909A (en) * | 2016-05-13 | 2016-09-21 | 大族激光科技产业集团股份有限公司 | Error correction method and system for three-degree-of-freedom parallel robot |
US10596700B2 (en) * | 2016-09-16 | 2020-03-24 | Carbon Robotics, Inc. | System and calibration, registration, and training methods |
CN206690067U (en) * | 2016-10-17 | 2017-12-01 | 宁德师范学院 | It is a kind of to be applied to the robot that express mail is distributed in express delivery office for incoming and outgoing mail |
-
2018
- 2018-07-24 DE DE102018117802.6A patent/DE102018117802A1/en active Pending
-
2019
- 2019-05-16 ES ES19725330T patent/ES2926964T3/en active Active
- 2019-05-16 CN CN201980044588.1A patent/CN112368117B/en active Active
- 2019-05-16 WO PCT/EP2019/062603 patent/WO2020020505A1/en unknown
- 2019-05-16 EP EP19725330.5A patent/EP3826812B1/en active Active
- 2019-05-16 SI SI201930340T patent/SI3826812T1/en unknown
- 2019-05-16 US US17/262,383 patent/US11964395B2/en active Active
Also Published As
Publication number | Publication date |
---|---|
CN112368117A (en) | 2021-02-12 |
SI3826812T1 (en) | 2022-11-30 |
US20210347055A1 (en) | 2021-11-11 |
ES2926964T3 (en) | 2022-10-31 |
US11964395B2 (en) | 2024-04-23 |
EP3826812A1 (en) | 2021-06-02 |
CN112368117B (en) | 2024-04-02 |
DE102018117802A1 (en) | 2020-01-30 |
WO2020020505A1 (en) | 2020-01-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP3020513B1 (en) | Method for handling and/or for manipulating articles such as containers or piece goods | |
EP3341164B1 (en) | Robot gripper | |
EP3826812B1 (en) | Method and control system for calibrating a handling device | |
EP3020514B1 (en) | Handling device and method for handling items | |
EP2799190B1 (en) | Device for handling articles | |
DE102015115866A1 (en) | Device for repacking packaged unit packaged goods | |
EP3365139B1 (en) | Parallel-kinematics robot and method for manipulating same | |
EP3221092B1 (en) | Apparatus and method for handling articles such as containers, piece goods or the like | |
WO2017067726A1 (en) | Parallel-kinematics robot and method for operating same | |
DE102014223389A1 (en) | Device and method for handling articles such as containers, piece goods or the like | |
EP3221093B1 (en) | Device and method for handling and/or manipulating articles such as containers or piece goods | |
EP3173192B1 (en) | Arrangement and process for the coordinated control of at least two robots with parallel kinematic | |
WO2017025221A1 (en) | Method for moving at least one handling unit designed for handling piece goods and device for handling piece goods | |
DE102015211348A1 (en) | Handling device and method for handling articles | |
DE102015211344B4 (en) | Device for handling articles and methods for detecting wear in such a handling device | |
WO2017029012A1 (en) | Device and method for handling and/or manipulating articles such as containers or piece goods | |
DE102015223528A1 (en) | Parallel kinematic robot with at least one unloading device and method for operating a parallel kinematic robot | |
DE102019104420A1 (en) | Arrangement and method for adjusting a robot arm | |
DE102013213609A1 (en) | Device for handling articles | |
DE102015223521A1 (en) | Parallel kinematic robot for capturing and moving piece goods, system with such a parallel kinematic robot and method for forming a reorientation of a variety of piece goods | |
DE102015219610A1 (en) | Parallel kinematic robot and method of handling same | |
WO2020094878A1 (en) | Robot and method for controlling the movement of a robot | |
DE102014223416A1 (en) | Device for handling and / or manipulating articles such as containers or piece goods | |
DE102015115965A1 (en) | Parallel kinematic robot and method of handling same | |
EP4159388A1 (en) | Device with a gripper |
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 |
|
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: 20201228 |
|
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 |
|
DAV | Request for validation of the european patent (deleted) | ||
DAX | Request for extension of the european patent (deleted) | ||
GRAP | Despatch of communication of intention to grant a patent |
Free format text: ORIGINAL CODE: EPIDOSNIGR1 |
|
STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: GRANT OF PATENT IS INTENDED |
|
INTG | Intention to grant announced |
Effective date: 20220217 |
|
GRAS | Grant fee paid |
Free format text: ORIGINAL CODE: EPIDOSNIGR3 |
|
GRAA | (expected) grant |
Free format text: ORIGINAL CODE: 0009210 |
|
STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: THE PATENT HAS BEEN GRANTED |
|
AK | Designated contracting states |
Kind code of ref document: B1 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 |
|
REG | Reference to a national code |
Ref country code: CH Ref legal event code: EP |
|
REG | Reference to a national code |
Ref country code: DE Ref legal event code: R096 Ref document number: 502019005027 Country of ref document: DE |
|
REG | Reference to a national code |
Ref country code: AT Ref legal event code: REF Ref document number: 1505243 Country of ref document: AT Kind code of ref document: T Effective date: 20220815 |
|
REG | Reference to a national code |
Ref country code: IE Ref legal event code: FG4D Free format text: LANGUAGE OF EP DOCUMENT: GERMAN |
|
REG | Reference to a national code |
Ref country code: ES Ref legal event code: FG2A Ref document number: 2926964 Country of ref document: ES Kind code of ref document: T3 Effective date: 20221031 |
|
REG | Reference to a national code |
Ref country code: LT Ref legal event code: MG9D |
|
REG | Reference to a national code |
Ref country code: NL Ref legal event code: MP Effective date: 20220720 |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: SE Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20220720 Ref country code: RS Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20220720 Ref country code: PT Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20221121 Ref country code: NO Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20221020 Ref country code: NL Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20220720 Ref country code: LV Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20220720 Ref country code: LT Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20220720 Ref country code: FI Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20220720 |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: PL Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20220720 Ref country code: IS Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20221120 Ref country code: HR Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20220720 Ref country code: GR Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20221021 |
|
REG | Reference to a national code |
Ref country code: DE Ref legal event code: R097 Ref document number: 502019005027 Country of ref document: DE |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: SM Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20220720 Ref country code: RO Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20220720 Ref country code: DK Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20220720 Ref country code: CZ Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20220720 |
|
PLBE | No opposition filed within time limit |
Free format text: ORIGINAL CODE: 0009261 |
|
STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: NO OPPOSITION FILED WITHIN TIME LIMIT |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: SK Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20220720 Ref country code: EE Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20220720 |
|
26N | No opposition filed |
Effective date: 20230421 |
|
P01 | Opt-out of the competence of the unified patent court (upc) registered |
Effective date: 20230523 |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: AL Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20220720 |
|
REG | Reference to a national code |
Ref country code: CH Ref legal event code: PL |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: MC Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20220720 |
|
REG | Reference to a national code |
Ref country code: BE Ref legal event code: MM Effective date: 20230531 |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: MC Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20220720 Ref country code: LU Free format text: LAPSE BECAUSE OF NON-PAYMENT OF DUE FEES Effective date: 20230516 Ref country code: LI Free format text: LAPSE BECAUSE OF NON-PAYMENT OF DUE FEES Effective date: 20230531 Ref country code: CH Free format text: LAPSE BECAUSE OF NON-PAYMENT OF DUE FEES Effective date: 20230531 |
|
REG | Reference to a national code |
Ref country code: IE Ref legal event code: MM4A |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: IE Free format text: LAPSE BECAUSE OF NON-PAYMENT OF DUE FEES Effective date: 20230516 |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: IE Free format text: LAPSE BECAUSE OF NON-PAYMENT OF DUE FEES Effective date: 20230516 |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: BE Free format text: LAPSE BECAUSE OF NON-PAYMENT OF DUE FEES Effective date: 20230531 |
|
PGFP | Annual fee paid to national office [announced via postgrant information from national office to epo] |
Ref country code: GB Payment date: 20240404 Year of fee payment: 6 |
|
PGFP | Annual fee paid to national office [announced via postgrant information from national office to epo] |
Ref country code: DE Payment date: 20240403 Year of fee payment: 6 |
|
PGFP | Annual fee paid to national office [announced via postgrant information from national office to epo] |
Ref country code: ES Payment date: 20240611 Year of fee payment: 6 |
|
PGFP | Annual fee paid to national office [announced via postgrant information from national office to epo] |
Ref country code: AT Payment date: 20240425 Year of fee payment: 6 |
|
PGFP | Annual fee paid to national office [announced via postgrant information from national office to epo] |
Ref country code: IT Payment date: 20240411 Year of fee payment: 6 Ref country code: FR Payment date: 20240408 Year of fee payment: 6 Ref country code: SI Payment date: 20240415 Year of fee payment: 6 |