Patent Application
20200353617
The present invention relates to methods for controlling a braking device for a drive unit of a joint between two members of a multi-axis robot arm of an articulated arm robot and corresponding robot systems.
In particular for robots for use in the field of human-robot collaboration (HRC) it is mandatory to provide for safety reasons an emergency stop or braking device in case of malfunction or sudden failure of the power supply, which is designed to stop the robot arm as quickly as possible in order to prevent injuries to an operator of the robot system or to prevent the object manipulated by the robot arm in the course of the activity to be performed by the robot arm or the robot arm itself from being damaged. Such an emergency stop can also be caused directly by the user, for example by pressing an emergency switch.
For example, braking devices are known for articulated arm robots in a wide variety of designs, with the aid of which the movement of the robot arm can be brought to an abrupt stop, at least to a very rapid stop within a defined period of time.
European Patent No. 3 045 273 discloses a braking mechanism in which a friction ring is mounted coaxially with the motor shaft, with which a pin of a locking device cooperates by engaging the pin radially in the friction ring in an emergency. Due to the fact that the friction ring is rotatable relative to the motor shaft under a defined frictional engagement, a slight braking delay of the rotational movement is realized when the radial pin engages.
The German patent application No. 10 2015 116 609 A1 reveals a braking device in which a brake star is non-rotatably arranged on the motor shaft of the drive unit, which has six radially protruding teeth arranged equidistantly in the circumferential direction. A brake activation device is provided coaxially to the axis of the motor shaft, which forces a locking pin into the rotational range of the brake star when required, e.g. during emergency braking, so that one tooth of the brake star comes into engagement with the locking pin. Such a braking device can also be designed to lock each joint of a multi-axis robot arm in the respective position when the robot is at a standstill.
If the absolute positions of the teeth in relation to the motor shaft are known and stored in a corresponding memory, the respective positions of the teeth can also be determined in principle by means of a rotary encoder, which detects the current angular position of the motor shaft, and by means of a correspondingly developed controller.
The absolute positions of the teeth, once determined, do not change as long as the relative position of the brake star in relation to the motor shaft or the rotor does not change, e.g. slips due to friction, as is the case with state-of-the-art technology. For these reasons, it is intended that the brake star is connected to the rotor so that it cannot rotate, e.g. by adhesive bonding.
Nevertheless, it is possible that corresponding faults may occur in such a generic braking device, which may require an emergency stop or even a complete stoppage of the robot. In this case, it may occur that the absolute position of at least one tooth of the brake star has changed over time or abruptly. Deviations in relation to the current position can occur during operation of the robot system, for example, if the tooth and/or the locking bolt have been plastically deformed and/or the brake star has shifted in relation to the rotor contrary to expectations. In order to ensure the functional reliability of the robot system and in particular of the braking devices of the joints, it is therefore absolutely essential to recognize or detect such deviations in good time.
Starting from this, it is an objective of the invention to provide a method for controlling a braking device for a drive unit of a joint between two members of a multi-axis robot arm of an articulated arm robot, by means of which the said faults can be detected in a simple manner.
This objective is solved according to the invention by a method for controlling a braking device for a drive unit of a joint between two members of a multi-axis robot arm of an articulated arm robot according to claim 1.
Accordingly, the invention relates to a method of controlling a braking device for a drive unit of a joint between two members of a multi-axis robot arm of an articulated arm robot comprising a brake activation device and a locking element, wherein the drive unit comprises a rotor with at least two radial brake elements, each enclosing a free circumferential segment therebetween in the circumferential direction, and wherein the brake activation device is adapted to bring the locking element into engagement with a brake element when required to stop rotation of the rotor, the method comprising the steps of
Preferably, the locking element is designed as a bolt which can engage with a brake star, which has at least two tooth-like, radially protruding brake elements, or with these brake elements.
If the brake bolt and/or a brake element is/are plastically deformed, at least one position detected by means of the method according to the invention is faulty or deviates from the respective stored value in relation to the brake element.
In a further embodiment of the method according to the invention, the method comprises the further steps:
The brake star may have several equidistantly arranged brake elements, so that according to the invention it may be provided that the aforementioned steps are repeated according to the number of brake elements present. In principle, these steps can only be carried out in one direction of rotation or successively in both directions of rotation.
By checking all positions according to the number of brake elements present, it can be determined whether the brake star, which should actually be connected to the rotor in a rotationally fixed manner, has rotated for any reason relative to the rotor without any deformations actually occurring on the brake elements and/or the brake bolt.
To provide additional control steps, it may also be provided that the torque is varied when the locking element is applied or attached to the brake element(s). Different torques or speeds of rotation make it possible, for example, to check whether the brake star only begins to move once a certain torque has been applied, because, for example, the bond between the brake star and the motor shaft is beginning to disintegrate. In addition, it may be provided that the rotor or the brake star is rotated by at least one segment width of the circumferential segment or by a total of 360°. This makes it possible to reliably detect that a deformed brake bolt is present, since it is more likely in such a case than with a deformed brake star that a circumferential segment can no longer be released because the locking bolt is jammed.
Preferably, the described steps of the method are performed individually for each joint of a multi-axis articulated arm robot.
If positional deviations can be determined by means of the method according to the invention, which is equivalent to a malfunction of the braking device or even a failure of the braking device or components thereof, it is then provided according to the invention that at least the braking device concerned is blocked and/or the entire articulated arm robot is shutdown.
The position deviations are compared with a previously defined and stored threshold value. Only if this threshold value is exceeded will the robot be put to a stop. The level of the threshold value or a threshold value range takes into account the resolutions of the encoder for measuring the angular position of the rotor, possible measurement inaccuracies, non-linearities or material-related flexibility and elasticity of individual components, so that misinterpretations do not occur.
A controller of the robot system or at least of the joint can have corresponding evaluation algorithms for this.
Ideally, the above mentioned steps of the method according to the invention are carried out successively for a first joint of the multi-axis robot arm, and if the position determination is successful without detected deviations with respect to this first joint, these steps of the method are carried out for a second joint following the first joint. In a preferred embodiment of this method, these steps are performed consecutively in one of the two sequences of the joints of the multi-axis robot arm for each joint individually, i.e. in the order of the axes. In other words, all the braking devices of the individual joints of the robot arm are checked from its one end, e.g. the distal end carrying an effector, to its other end, e.g. the stationary base, or vice versa, and the respective actual positions of the brake elements and/or the brake star are thus “measured”.
The invention further relates to a computer program, comprising program instructions which cause a processor to execute and/or control the steps of the described method when the computer program is running on the processor, as well as a data carrier device related thereto. The invention also relates to a computer system with a data processing device, wherein the data processing device is designed such that the described method is executed on the data processing device.
Furthermore, the invention also relates to a robot system with a multi-axis robot arm having means for carrying out the described method.
As mentioned, the step of detecting the actual position of the at least one brake element comprises determining, preferably calculating, this position from stored absolute positions with respect to this at least one brake element in relation to an absolute position of the rotor or motor shaft detected by means of an encoder and thus to the absolute position of the locking element arranged stationary relative to the motor shaft.
Before carrying out this step, it may therefore be necessary to determine or detect the absolute positions of at least one brake element of the brake star, preferably of all brake elements, in relation to the rotor and thus to the motor position.
This can be done physically by sampling corresponding values by means of corresponding rotary encoders, rotary position sensors and the like, which interact with the respective elements in a corresponding manner, e.g. by means of Hall elements known per se; preferably, however, according to the invention, these positions are to be determined, i.e. preferably calculated, by means of a correspondingly distinct control logic.
In this way, there is no need to use additional sensors and to install them at suitable positions within the braking device. The installation space for the braking device and thus the drive unit need not be unnecessarily restricted by this.
The determination of the positions as such has in itself an independent inventive step. For these reasons, the present invention relates in a further aspect to a method, separately or combined with the method described above, for controlling a braking device for a drive unit of a joint between two members of a multi-axis robot arm of an articulated arm robot comprising a brake activation device and a locking element, wherein said drive means comprises a rotor having at least two radial brake elements each circumferentially enclosing a free circumferential segment therebetween, and wherein said brake activation device is adapted to bring said locking element into engagement with a brake element as required to stop rotation of said rotor, said method comprising the steps of
Ideally, these steps are carried out immediately after completion of the assembly of such a robot arm and during start-up of operation. In other words, the motor of the drive unit drives the rotor with the brake star and is controlled against the bolt that is in a locked position, applying a sufficiently high current to ensure that the bolt is always in contact with a radial brake element of the brake star. The bolt is then released and the brake star is moved by the respective distance (i.e. short or long distance) within the circumferential segment in which the bolt initially lies.
In a further embodiment of the method, the torque when the locking element is applied to the brake element can be varied to ensure that it is actually fully applied.
By means of this method according to the invention, it is possible to “measure” the brake star as it were. It is therefore not necessary to manufacture it with high tolerances. Any deformations occurring during installation of the brake star have no influence.
The absolute positions obtained in this way are preferably stored in a memory assigned to the joint in the drive unit. This has the advantage that when a drive unit is removed and subsequently installed, the position data once determined need not be recorded again. In this respect, the braking device therefore no longer needs to be calibrated unless maintenance or repair work had to be carried out directly on it or components of it had to be replaced. The relevant data can, however, also be stored in a master controller of the robot system, in particular in addition.
The above-mentioned steps must therefore be repeated exactly twice as often as the number of brake elements equidistantly arranged on the rotor, since each brake element can come into contact with the bolt from both sides, depending on the direction of rotation. Consequently, these steps can be carried out in one direction of rotation, or one after the other in both directions of rotation, individually for each joint of a multi-axis articulated arm robot.
Further advantages and features of the present invention result from the description of the embodiment shown in the enclosed drawings.
The braking device shown schematically in
The braking device according to the invention comprises a brake activation device 1, which may be a magnet-activated holding or spring mechanism, for example. The brake activation device 1 is conceived and designed to activate a locking element in the form of a bolt 2 when required, e.g. in the event of an unexpected power failure, whereby the bolt 2 is then driven upwards, e.g. by a spring.
By means of a bearing disk 3, which is fixed to the housing, i.e. connected to a not shown housing of the drive unit, a motor shaft or a rotor 4 of the drive unit can be supported by known bearings (not shown). The brake activation device 1 with the bolt 2 is arranged stationary on the bearing disk 3.
The rotor 4 carries a brake element in the form of a brake star 5, which is connected, e.g. glued, to the rotor 4 in a rotationally fixed manner via an axially extending sleeve 6.
The brake star 5 has three webs 7 spaced at an equal circumferential angle to each other, which extend radially from an inner ring 8 of the brake star 5.
By means of the preferably solenoid-operated brake activation device 1, bolt 2 can be moved between a locked position, which it occupies without energy supply, and a release position occupied when energy is supplied.
The webs 7 are arranged at an equal distance from each other, i.e. with three webs 7, their central radial axes S are 120° apart. Since the webs 7 themselves have a certain width due to their design, as shown in
Since the positions of the edges 9 on both sides of each web 7 in relation to the angular position of the rotor 4 and thus of the motor position have been determined in advance and stored, and since the absolute, since stationary position PB of bolt 2 is known, it is then possible in the following to determine where the individual positions of the edges 9 are located by detecting the angular position of the rotor 4 or of the motor shaft in the control system, and thus to determine that circumferential segment UB in which bolt 2 is actually located after braking or locking has been carried out.
In a first step S1, locking bolt 2 is actuated so that in a subsequent step S2, when the brake star 2 is rotated, a first web 7 comes to rest against locking bolt 2 under a defined torque. Since the original position of the edge 9 of this web 7 coming into contact is known, it can be calculated in a further step S3 by means of the degree of rotation whether this original position of the edge 9 is maintained, taking into account certain tolerance ranges which influence the threshold value λmax, or whether a deviation λ can be detected, i.e. a new position of the edge 9′ could be recorded.
In a comparison step S4 this deviation λ is compared with the threshold value λmax. If it still moves in an area that indicates sufficient functionality of the braking device, the robot system is released for further operation in a step S5. However, if this threshold value λmax is exceeded, according to the invention the robot is stopped in an alternative step S6.
Ideally, the steps described above are carried out individually, preferably consecutively from one end to the other end, for each joint of the multi-axis robot arm when a robot is activated, and then again preferably at fixed intervals over the period of use of the robot.
| Number | Date | Country | Kind |
|---|---|---|---|
| 10 2019 112 029.2 | May 2019 | DE | national |
