METHOD FOR BRAKING CONTROL OF AT LEAST ONE SERVOMOTOR, ROBOT AND COMPUTER PROGRAM PRODUCT
Patent Information
- Application Number
- DE502020009578
- Authority / Receiving Office
- DE · DE
- Patent Type
- Patents
- Current Assignee / Owner
- Priority Date
- 2019-11-21
- Filing Date
- 2020-11-10
- Publication Date
- 2024-11-14
- Estimated Expiration
- 2040-11-10
AI Technical Summary
Existing methods for braking control of servomotors in industrial robots are not effective and safe, particularly in emergency situations where mechanical separation or braking is not possible, and they lack efficient energy management during regenerative braking.
A method using a frequency converter with a rectifier circuit connected to an alternating voltage network, a DC intermediate circuit with a capacitor and a brake chopper, and controllable power semiconductor switches, where regenerative braking is achieved by dynamically controlling the switch-on and switch-off thresholds of the brake chopper based on the servo motor's speed, allowing for controlled reduction of speed without mechanical brakes and minimizing energy storage to prevent unintended restarts.
This method enables safe and effective braking of servomotors by actively controlling regenerative braking, reducing the risk of unintended motor restarts and ensuring compliance with safety standards like Safe Torque Off, while optimizing energy usage during the braking process.
Description
[0001] The invention relates to a method for braking control of at least one servomotor using a frequency converter comprising a rectifier circuit connectable to an AC electrical network, a DC link circuit fed from the AC electrical network when connected to the AC electrical network, comprising an intermediate circuit capacitor and a braking resistor that can be connected and disconnected via a braking chopper of the DC link circuit, and at least one inverter circuit fed from the DC link circuit with controllable power semiconductor switches. The invention also relates to a correspondingly configured robot and an associated computer program product.
[0002] EP 2 224 586 A1 discloses a method for controlling a motor-driven industrial robot, which comprises at least one drive motor which is fed by a supply circuit which can be connected to the mains voltage and which comprises at least one rectifier circuit which can be connected to the mains voltage, an intermediate circuit with at least one intermediate circuit capacitor, and a bridge switch device which is connected to the output side of the drive motor and which provides an alternating or direct current supply for the drive motor, wherein the supply circuit of the drive motor is controlled by a control device for accelerating and decelerating the drive motor.The method therein for electrically braking the drive motor comprises the steps of disconnecting the intermediate circuit from the mains and regulating the intermediate circuit voltage to a predetermined value greater than zero, wherein the intermediate circuit capacitor is fed in a generator operation of the drive motor.
[0003] DE 10 2007 059 492 B4 discloses an industrial robot comprising a robot arm having a plurality of axes and at least one electric drive with a three-phase motor and with power electronics controlling the three-phase motor, wherein the power electronics comprise a three-phase inverter driving the three-phase motor and an intermediate circuit having an intermediate circuit capacitor and connected upstream of the three-phase inverter, with a first braking resistor and a first switch, wherein the electric drive is configured to move the relevant axis, wherein the industrial robot is configured to short-circuit the three-phase motor during emergency braking simultaneously by means of two mutually independent electrical current paths and to close the first switch during emergency braking in order to connect the braking resistor in parallel with the intermediate circuit capacitor,so that one of the two electrical current paths for emergency braking passes through the first braking resistor.
[0004] DE102016208888 shows a brake chopper switch that is switched on or off depending on whether an intermediate circuit voltage exceeds an upper threshold or falls below a lower threshold.
[0005] DE102016203701A1 discloses a robot arm with several joints driven by electric motors and a control device.
[0006] The object of the invention is to provide a method for braking control of at least one servo motor which operates particularly effectively and safely.
[0007] The object is achieved by a method for braking control of at least one servo motor by means of a frequency converter, which comprises a rectifier circuit connectable to an electrical AC voltage network, a DC intermediate circuit fed from the electrical AC voltage network when connected to the electrical AC voltage network, with an intermediate circuit capacitor and with a braking resistor that can be connected and disconnected via a braking chopper of the DC intermediate circuit, and at least one inverter circuit fed from the DC intermediate circuit with controllable power semiconductor switches, comprising the steps: Isolating the DC link from the AC electrical network, braking the servo motor by controlling the power semiconductor switches of the inverter circuit in a regenerative braking mode in order to reduce the speed of the servo motor, controlling the brake chopper in such a way that the braking resistor is switched on at a maximum DC link voltage, which forms a switch-on threshold for the brake chopper, and is disconnected at a minimum DC link voltage, which forms a switch-off threshold for the brake chopper, wherein the switch-on threshold and / or the switch-off threshold is dynamically changed during the regenerative braking mode of the servo motor depending on the current speed of the servo motor.
[0008] The method according to the invention can, in principle, be carried out by controlling a single servomotor. However, the method according to the invention can, in particular, be carried out by controlling at least two servomotors. In the specific embodiment of controlling the drives of a robot arm, the method according to the invention can, for example, be carried out by controlling six or seven servomotors that form the drives of a robot arm.
[0009] According to the invention, braking control means that during the implementation of the method, the one servomotor or the multiple servomotors are braked neither by mechanical brakes nor by (electro-)mechanical brakes, nor by short-circuit braking, but are braked during the implementation of the method exclusively in a generator mode of operation of the one servomotor or the multiple servomotors, which is actively controlled by the inverter circuit. In such an actively controlled generator mode of operation of the one servomotor or the multiple servomotors, electrical energy is thus fed into the DC voltage intermediate circuit via the inverter circuit.Energy is exchanged so that by switching the power semiconductor switches of the inverter circuit on and off, corresponding alternating currents can be introduced into the windings of one or more servomotors, generating magnetic fields that cause braking mechanical forces on the servomotor shaft(s). Braking is understood to mean the reduction of the speed of the respective servomotor shaft. Braking does not necessarily have to be carried out until the respective servomotor shaft comes to a complete standstill. Rather, braking can simply be carried out from a higher first speed to a lower second speed that is lower than the first speed.
[0010] In the case of two or more servomotors that are controlled to decelerate according to one of the methods according to the invention, not all of the servomotors have to be controlled to decelerate simultaneously. Rather, at any desired point in time, a first subgroup of a subset of servomotors can be controlled to decelerate, and a second subgroup of another subset of servomotors can be driven to decelerate, stationary at a constant speed, undriven, i.e., idling, or even accelerating. In a special state, only a single servomotor can be controlled to decelerate as a generator, and the other servomotors cannot be controlled to decelerate as a generator. In a special state, all of the servomotors can be controlled to decelerate as a generator simultaneously.
[0011] The at least one servomotor is electrically controlled by the frequency converter according to the invention in terms of its position (the motor position, i.e., the current angular position of the motor shaft), its speed, its acceleration, and / or its braking behavior (negative acceleration). In the case of two or more servomotors, the frequency converter has a number of inverter circuits corresponding to the number of servomotors. The plurality of inverter circuits are connected to a common DC intermediate circuit. The common DC intermediate circuit is fed by a common rectifier circuit from the same AC electrical network when the frequency converter is connected to the AC electrical network.However, during the braking control method according to the invention, the frequency converter, in particular the common rectifier circuit, is temporarily disconnected from the AC electrical network. This means that if two or more servomotors are in a state in which none of the servomotors are braking, the frequency converter is reconnected to the AC electrical network.
[0012] The AC electrical network supplies electrical energy from a power grid of a power supplier. This will generally be a low-voltage network. The low-voltage network can, in particular, be a three-phase AC network. The three-phase AC network supplies a sinusoidal AC mains voltage. This sinusoidal AC mains voltage can, in particular, have an effective value at which a voltage of, for example, 230 volts is applied between a line conductor of the three-phase AC network and a neutral conductor of the three-phase AC network, and a voltage of, for example, 400 volts is applied between any two of the three line conductors. The network frequency can, for example, be 50 Hertz or 60 Hertz. The three-phase AC network can, in particular, be configured as a TN system comprising three line conductors (L1, L2, L3), a neutral conductor (N), and a protective conductor (PE).
[0013] The rectifier circuit of the frequency converter can, for example, be a three-phase rectifier. The three-phase rectifier can be implemented in the form of an uncontrolled three-phase bridge.
[0014] The DC intermediate circuit is supplied with electrical energy from the AC electrical network when the frequency converter is connected to the AC electrical network. When the DC intermediate circuit is disconnected from the AC electrical network, as is the case during operating times when the method according to the invention is being carried out, the DC intermediate circuit is supplied exclusively with electrical energy from the inverter circuit, which can supply electrical energy during generator operation of the at least one servomotor.
[0015] During the operating times in which the method according to the invention is carried out, electrical energy can also be delivered from the intermediate circuit capacitor, either to the inverter circuit or to the braking resistor.
[0016] When connected to the DC link, the braking resistor is designed to extract electrical energy from the DC link and convert it into heat. When disconnected from the DC link, the braking resistor has no electrical effect on the DC link, meaning that the DC link remains unaffected by the braking resistor when the braking resistor is disconnected.
[0017] The brake chopper, which connects and / or disconnects the braking resistor to the DC link, is a controllable switch. The brake chopper can therefore be operated with pulse width control.
[0018] The inverter circuit fed from the DC link comprises power semiconductor switches which can be controlled electronically, for example by associated driver circuits. The inverter circuit can be a three-phase inverter and can be designed, for example, as a two-stage inverter (U-converter) or a pulse-controlled inverter. In the inverter circuit, the power semiconductor switches conduct the electrical energy to the servomotor when current and voltage have the same sign. The electrical energy thus flows from the DC link and into the servomotor. In generator mode, according to the invention, the freewheeling diodes associated with the power semiconductor switches do not conduct the electrical energy in order to transfer generator energy from the servomotor(s) into the DC link, i.e.to be fed back into the intermediate circuit capacitor, but the power semiconductor switches remain active and are controlled accordingly by the driver circuits assigned to the power semiconductor switches in order to draw electrical energy from the servo motors and feed it into the DC link, ie into the intermediate circuit capacitor.
[0019] In the method according to the invention, the DC link is first disconnected from the AC electrical network. This is at least expedient, for example, in the event of an emergency shutdown of the respective machine driven by the at least one servomotor, or even mandatory in view of certain safety requirements that must be observed.
[0020] For example, in the case of an emergency stop of category 0 (e.g. according to standard EN 60204) for industrial robots, an immediate interruption of the electrical power supply is required, especially if, for example, a mechanical separation, i.e. a disengagement in the drive train and / or mechanical braking alone is not possible.
[0021] On the other hand, a machine such as the exemplary industrial robot can have system states in which a controlled speed reduction of the servo motors, in particular down to a standstill at zero speed, occurs more quickly than through mere mechanical braking, in which the servo motors are not reduced in their speeds in a controlled manner.
[0022] In the method according to the invention, braking of the at least one servomotor therefore occurs by actively controlling the power semiconductor switches of the inverter circuit in a regenerative braking mode in order to reduce the speed of the servomotor in a controlled manner. However, since the frequency converter is disconnected from the AC electrical network in the situation in question, the invention ensures that, on the one hand, enough electrical energy remains in the DC link to operate the inverter circuit, but, on the other hand, the amount of energy in the DC link is reduced to a possible minimum, so that an unwanted, possibly faulty restart of the at least one servomotor can be at least largely or even completely prevented. In this way, the function of a safe torque off (STO, Safe Torque Off) can also be implemented.
[0023] According to the invention, this is achieved by controlling the brake chopper in such a way that the braking resistor is switched on at a maximum DC link voltage, which forms a switch-on threshold for the brake chopper, and is switched off at a minimum DC link voltage, which forms a switch-off threshold for the brake chopper. At the same time, the switch-on threshold and / or the switch-off threshold are dynamically changed during the regenerative braking operation of the servomotor depending on the current speed of the servomotor.By dynamically changing the switch-on threshold and / or switch-off threshold, the amount of electrical energy to be stored in the DC link can be dynamically adapted to the currently required conditions, namely with regard to both target variables, namely with regard to a sufficiently high amount of energy to be able to supply the inverter circuit with electrical energy so that the servo motor can be operated as a generator, i.e. braked, and with regard to the lowest possible amount of energy in order to remove sufficient energy from the system so that a potentially dangerous, unintentional restart of the servo motor is reliably prevented.
[0024] In contrast to the prior art, according to which it is known to regulate the intermediate circuit voltage applied to the intermediate circuit capacitor only to a predetermined target value, according to the invention such a target value is not fixed, but the switch-on threshold and / or the switch-off threshold of the brake chopper is changed dynamically during the generator operation of the at least one servo motor.
[0025] In a special embodiment, the switch-on threshold and / or the switch-off threshold are dynamically changed during the generator braking operation of the servo motor depending on the instantaneous speed of the servo motor in such a way that the intermediate circuit voltage is continuously reduced as the speed of the servo motor decreases.
[0026] In the case of more than one servomotor, the intermediate circuit voltage can be continuously reduced as the speed of the servomotor that currently induces the highest voltage during its generator operation decreases. During the implementation of a method according to the invention, i.e., during a braking operation, the servomotor in question can, if necessary, change depending on which servomotor the intermediate circuit voltage is continuously reduced as the speed of the servomotor decreases.So if the servo motor, depending on which the intermediate circuit voltage has been reduced so far, has come to a standstill or its current speed has been reduced at least to such an extent that another servo motor has a higher speed and therefore induces a higher voltage in the intermediate circuit voltage, the control of the intermediate circuit voltage can be switched over to this other servo motor, so that this other servo motor forms the new reference variable for the control of the intermediate circuit voltage.
[0027] The servomotor's speed can be determined based on the instantaneous speed of the servomotor measured by a motor position sensor. For this purpose, the instantaneous speed of the servomotor can be determined, i.e., calculated, from two measured angular positions of the servomotor shaft at two different points in time.
[0028] As an alternative to measuring the servomotor's speed using a motor position sensor, or in addition to measuring the servomotor's speed using a motor position sensor, for example to create a redundant, particularly diverse, evaluation, the servomotor's speed can be determined based on the measured, currently prevailing motor voltage in the servomotor. For this purpose, the current servomotor speed can be read from the characteristic curve based on a design-specific fixed characteristic curve of the servomotor via the currently measured motor voltage.
[0029] The reduction of the DC link voltage can be carried out, in particular, proportionally to the reduction in the servo motor's speed. The reduction of the DC link voltage can be carried out, in particular, synchronously with the reduction in the servo motor's speed.
[0030] As the speed of the servo motor decreases, the kinetic energy of the kinematic system coupled to the servo motor, such as a gearbox connected to the motor shaft of the servo motor, a link of the robot arm and / or a distal sub-chain of links and joints of the robot arm, is reduced. As a result, due to the reduced kinetic energy, only less braking energy is required to decelerate the coupled kinematic system, which is still moving at a slower rate, to a standstill. Ideally, therefore, at the moment the kinematic system coupled to the servo motor comes to a standstill, the electrical energy in the intermediate circuit is completely or at least largely removed. This then results in a further advantage, namely that an unwanted i.e.Restarting the servo motor, if caused by an error, is no longer possible because there is not enough electrical energy in the intermediate circuit to start the servo motor.
[0031] In a particular development, the switch-on threshold and / or the switch-off threshold can be changed during the generator braking operation of the servo motor depending on the current speed of the servo motor in such a way that the change in the switch-on threshold and / or the switch-off threshold is carried out on the basis of a current speed of the servo motor measured by means of a motor position sensor or on the basis of the measured motor voltage of the servo motor currently prevailing in the servo motor.
[0032] In a first embodiment, the switch-on threshold and / or switch-off threshold can be changed based on the instantaneous speed of the servo motor measured by a motor position sensor. The motor position sensor is used to detect the instantaneous angular position of the servo motor shaft. The motor position sensor is also referred to as a rotary encoder. The rotational speed and / or the angular acceleration of the servo motor shaft can be derived and thus determined from two angular positions of the servo motor shaft detected at different times. A resolver, an incremental encoder, or even an absolute encoder can be used as a motor position sensor, for example.
[0033] In a second embodiment, however, the change in the switch-on threshold and / or switch-off threshold can also be carried out based on the measured motor voltage currently prevailing in the servomotor. As is well known, in servomotors, the motor voltage, i.e., the electrical voltage in the windings, is proportional to the speed of the servomotor's motor shaft. The servomotor's motor voltage can thus be electrically tapped directly from the circuit to which the inverter circuit of the frequency converter according to the invention is connected. Consequently, no separate sensor components are necessary in this second embodiment.
[0034] The switch-on threshold and / or the switch-off threshold can be reduced to a predetermined minimum threshold value during the regenerative braking operation of the servo motor depending on the current speed of the servo motor, in particular the switch-off threshold can be reduced to a minimum threshold value which is below the mains voltage of the AC mains.
[0035] In general, the switch-on threshold and the switch-off threshold define a two-point controller with hysteresis. When the switch-on threshold is exceeded from a lower voltage, the brake chopper connects the braking resistor to the DC link, converting electrical energy into heat in the braking resistor and causing the DC link voltage to drop. However, when the voltage drops from the higher voltage, the voltage in the DC link must then continue to drop beyond the switch-on threshold until it falls below the switch-off threshold voltage. The switch-off threshold is therefore always below the switch-on threshold by a voltage difference that determines the hysteresis.When the switch-off threshold is undershot from a higher voltage, the brake chopper separates the brake resistor from the DC link again, so that the DC link voltage can rise again in the DC link.
[0036] By lowering the minimum threshold to a voltage value that is below the mains voltage of the AC network, the intermediate circuit voltage can be reduced to a maximum, which allows the generator power to be maximized so that the servo motor(s) can be braked with maximum generator energy.
[0037] The minimum threshold could thus be lowered to zero. However, depending on the control method, the inverter circuit drivers—i.e., the power semiconductor switches of the inverter circuit—may also be powered by electrical energy from the frequency converter's DC link. In this case, lowering the minimum threshold to zero volts is not practical.
[0038] In a special embodiment, the switch-on threshold and / or the switch-off threshold during the regenerative braking operation of the servomotor can therefore be reduced, depending on the current speed of the servomotor, only to a minimum threshold value at which a minimum voltage is present in the DC link, at which the regenerative braking operation of the servomotor is still ensured by controlling the power semiconductor switches of the inverter circuit. This minimum threshold value can, for example, be between zero and the mains voltage of the AC mains.
[0039] For the simultaneous control of at least two servo motors, the frequency converter can have a number of inverter circuits corresponding to the number of servo motors, which are connected to the common DC link of the frequency converter, wherein the switch-on threshold and / or the switch-off threshold is dynamically changed during the regenerative braking operation of one or more of the at least two servo motors depending on the current speed of the servo motor that currently induces the highest DC link voltage.
[0040] In the application of an exemplary robot arm, the robot arm can have multiple joints and multiple links that can be adjusted relative to one another by the movements of the robot arm's joints. Each joint can be assigned its own servomotor. Each of these multiple servomotors is configured to adjust the joint of the robot arm assigned to it, specifically by automatically controlling the servomotor. For this purpose, the robot arm can have a control device configured to automatically control the servomotors of the robot arm in order to automatically adjust the links of the robot arm relative to one another by driving the joints.
[0041] Each joint, and thus each servomotor assigned to that joint, moves a kinematic system formed by the distal kinematic subsystem upstream of that servomotor in the robot arm's kinematic chain. Thus, the servomotors located more proximally in the kinematic chain (servomotors of the robot arm's base axes) generally have to decelerate a greater amount of kinetic energy than the servomotors located more distally (servomotors of the robot arm's hand axes). However, depending on the pose of the robot arm's joints, a different servomotor may be subjected to the highest braking load at any given time.For example, a situation may arise where a base joint moving upwards against gravity needs to be decelerated, so the braking force is largely provided by gravity, and the associated servomotor is therefore not subject to any particular electrical braking load. On the other hand, a relatively light wrist of the robot arm may be moving in the direction of gravity, so that during deceleration, the acting acceleration due to gravity must also be counteracted by the servomotor, and thus the servomotor associated with the lighter wrist is subjected to a particularly high electrical braking load.
[0042] During the implementation of a method according to the invention, i.e. during the duration of a braking operation, the referenced servomotor, depending on which the intermediate circuit voltage is continuously reduced with its decreasing speed, can therefore change if necessary. Therefore, if the servomotor, depending on which the intermediate circuit voltage was previously reduced, has come to a standstill or its current speed has been reduced at least to such an extent that another servomotor has a higher speed and therefore consequently induces a higher voltage in the intermediate circuit voltage, the control of the intermediate circuit voltage can be switched to this other servomotor, so to speak, so that this other servomotor forms the new reference variable for controlling the intermediate circuit voltage.
[0043] In all embodiments according to the invention, the electrical energy in the DC link can be increased during the dynamic change of the switch-on threshold and / or the switch-off threshold during the regenerative braking operation of the servo motor in those states of the DC link in which the brake chopper has disconnected the braking resistor, by feeding the DC link capacitor exclusively with the energy generated by the at least one servo motor from the inverter circuit.
[0044] The at least one servo motor can specifically be a permanent magnet synchronous machine.
[0045] The object of the invention is also achieved by a robot having a robot arm with a plurality of joints and a plurality of members which can be adjusted relative to one another by the movements of the joints of the robot arm, wherein at least one of the joints is assigned a servo motor which is designed to adjust the at least one joint by automatically controlling the servo motor, and having a control device which is designed to automatically control at least one servo motor of the robot arm in order to automatically adjust the members of the robot arm relative to one another by driven movement of the joints, wherein the control device is designed and configured to carry out a method according to one of the described embodiments.
[0046] The control device can be designed as part of a robot controller. Alternatively, however, the control device can also be designed as a separate control unit that interacts with the robot controller, for example, via a communication link. The control device is particularly designed to control a frequency converter that comprises a rectifier circuit connectable to an AC electrical network, a DC link circuit fed from the AC electrical network when connected to the AC electrical network, having an intermediate circuit capacitor and a braking resistor that can be connected and disconnected via a braking chopper of the DC link circuit, and at least one inverter circuit fed from the DC link circuit with controllable power semiconductor switches.
[0047] The object according to the invention is also achieved by a computer program product comprising a machine-readable carrier on which program code is stored which can be read by a control device of the robot according to the invention and which, when read out, trains and / or sets up the control device to carry out a method according to one of the described embodiments when the program code is executed by the control device.
[0048] The computer program product can, for example, be a CD, a DVD, or a USB stick. The computer program product can also be a control card on which microprocessors are integrated. The computer program product can also be implemented as a download, which can be offered and sold via the Internet or another network.
[0049] The machine-readable medium can thus be a CD, a DVD, or a microprocessor on which the program code is stored. However, the machine-readable medium can also be a hard disk or an SSD drive onto which the program code has been downloaded, for example, by means of a download, particularly in the form of data packets.
[0050] The program code may be represented by an edited program and / or data stored on the machine-readable medium.
[0051] By reading out the edited program and / or the data, the reading control device is designed and / or configured to be able to carry out the method according to the invention.
[0052] The method according to the invention is carried out when the control device actually executes the program code, ie the edited program, accordingly and / or actually processes the data accordingly.
[0053] Specific embodiments of the invention are explained in more detail in the following description with reference to the accompanying figures. Regardless of the specific context in which they are mentioned, specific features of these exemplary embodiments may represent general features of the invention, even when considered individually or in further combinations.
[0054] They show: Fig. 1 is a flow chart of the method according to the invention, Fig. 2 is a side view of an exemplary industrial robot which comprises a robot arm with links, joints and servo motors, and which has a robot controller which is designed to carry out a method according to the invention, Fig. 3 is a schematic representation of a circuit diagram of an exemplary frequency converter with a servo motor, and Fig. 4 is a schematic representation of a circuit diagram of an exemplary modified frequency converter with two or more servo motors which are connected to a common DC voltage intermediate circuit.
[0055] In Fig. 1 is a schematic diagram of the sequence of the basic method according to the invention for braking control of at least one servo motor M by means of a frequency converter 1 ( Fig. 3 , Fig. 4 ) is shown.
[0056] The frequency converter 1 can, as in Fig. 3 and Fig. 4 is shown, a rectifier circuit 3 which can be connected to an electrical alternating voltage network 2, a DC voltage intermediate circuit 4 which, when connected to the electrical alternating voltage network 2, is fed from the electrical alternating voltage network 2 and has an intermediate circuit capacitor 5 and a braking resistor 6 which can be connected and disconnected via a braking chopper S7 of the DC voltage intermediate circuit 4, and at least one inverter circuit 7 which is fed from the DC voltage intermediate circuit 4 and has controllable power semiconductor switches S1 to S6.
[0057] The inventive method as described in Fig.1 shown, has the following steps: In the first step V1, the DC voltage intermediate circuit 4 is separated from the AC voltage electrical network 2.
[0058] In a subsequent second step V2, the servo motor M is braked by controlling the power semiconductor switches S1-S6 of the inverter circuit 7 in a generator braking mode in order to reduce the speed of the servo motor M,
[0059] In a third step V3, the brake chopper S7 is controlled in such a way that the braking resistor 6 is switched on at a maximum intermediate circuit voltage, which forms a switch-on threshold for the brake chopper S7, and is disconnected at a minimum intermediate circuit voltage, which forms a switch-off threshold for the brake chopper S7, wherein according to step V4 the switch-on threshold and / or the switch-off threshold is dynamically changed during the regenerative braking operation of the servo motor M depending on the instantaneous speed of the servo motor M.
[0060] The Fig. 2 shows an industrial robot 8 having a robot arm 9 and a robot controller 10. In the present embodiment, the robot arm 9 comprises several successively arranged links G1 to G7 that are rotatably connected to one another by means of joints L1 to L6.
[0061] The industrial robot 8 has the robot controller 10, which is configured to execute a robot program and automatically move the links G1-G7 and joints L1-L6 of the robot arm 9. One of the plurality of links G1-G7 forms an end link (G7) of the robot arm 9, which has a tool flange 11.
[0062] The robot controller 10 of the industrial robot 8 is designed or configured to execute a robot program by which the joints L1 to L6 of the robot arm 9 can be adjusted or rotated automatically or in manual mode according to the robot program. For this purpose, the robot controller 10 is connected to controllable electric drives, the servomotors M1 to M6, which are designed to adjust the respective joints L1 to L6 of the robot arm 9.
[0063] In the present embodiment, the members G1 to G7 are a robot base frame 13 and a carousel 14 mounted for rotation relative to the robot base frame 13 about a vertical axis A1. Further members of the robot arm 9 are a rocker arm 15, an arm extension 16, and a preferably multi-axis robot hand 17 with a fastening device designed as a tool flange 11 for attaching a tool. The rocker arm 15 is pivotably mounted on the carousel 14 about a preferably horizontal axis of rotation A2 at its lower end, i.e., at the joint L2 of the rocker arm 15, which can also be referred to as the rocker arm bearing head.
[0064] At the upper end of the rocker arm 15, the arm extension 16 is pivotally mounted about a preferably horizontal axis A3 at the first joint L3 of the rocker arm 15. This arm extension carries the robot hand 17 at its end, with its preferably three rotational axes A4, A5, A6. The joints L1 to L6 can each be driven by one of the electric servomotors M1 to M6 via the robot controller 10 in a program-controlled manner. For this purpose, the servomotors M1 to M6 are connected to a frequency converter 1 according to the invention, as shown in Fig. 3 and Fig. 4 is shown.
[0065] The frequency converter 1, as in Fig. 3 and Fig. 4 can be connected to an AC electrical network 2. The AC electrical network 2 can be a three-phase AC network, for example, at 50 Hertz. It can be configured, in particular, as a TN system.
[0066] If the frequency converter 1 is connected to the AC voltage network 2, its rectifier circuit 3 can convert the AC voltage supplied from the AC voltage network 2 into a corresponding DC voltage. The DC voltage is then fed to a DC link 4. The DC link 4 is equipped with an intermediate circuit capacitor 5 and a braking resistor 6 that can be connected and disconnected via a braking chopper S7 of the DC link 4.
[0067] At least one inverter circuit 7 fed from the DC voltage intermediate circuit 4 with controllable power semiconductor switches S1 to S6 is connected to the DC voltage intermediate circuit 4.
[0068] In the case of the embodiment of the Fig. 3 Only a single inverter circuit 7 is connected to the DC link 4. This single inverter circuit 7 supplies the single servo motor M according to Fig. 3 .
[0069] In the case of the embodiment of the Fig. 4 Several inverter circuits 7 are connected to the DC voltage intermediate circuit 4. These several inverter circuits 7 each supply one of several servo motors M1 to M6 according to Fig. 4 . In Fig. 4 For illustrative purposes, only two inverter circuits 7 and two servomotors M1 and M2 are shown in full. The dashed arrows and the designations M3 and M4 indicate a number of additional servomotors M3, M4, etc., and additional inverter circuits 7, all of which are connected to the common DC link 4.
[0070] In the case of Fig. 2For example, in the exemplary industrial robot 8 shown, a total of six inverter circuits 7 can be provided for the six servo motors M1 to M6 of the six joints L1 to L6 of the robot arm 9.
Claims
1. Method for the braking-based control of at least one servomotor (M, M1-M6) by way of a frequency converter (1) comprising a rectifier circuit (3) able to be connected to an electrical AC voltage grid (2), a DC link (4) that is fed from the electrical AC voltage grid (2) in the state connected to the electrical AC voltage grid (2), has a link capacitor (5) and has a braking resistor (6) that is able to be connected and disconnected via a braking chopper (S7) of the DC link (4), and at least one inverter circuit (7) that is fed from the DC link (4) and has driveable power semiconductor switches (S1-S6), comprising the following steps: - disconnecting the DC link (4) from the electrical AC voltage grid (2), - braking the servomotor (M, M1-M6) by driving the power semiconductor switches (S1-S6) of the inverter circuit (7) in a generative braking mode in order to reduce the speed of the servomotor (M, M1-M6), characterized by - driving the braking chopper (S7) such that the braking resistor (6) is connected at a maximum link voltage that forms a switch-on threshold for the braking chopper (S7) and is disconnected at a minimum link voltage that forms a switch-off threshold for the braking chopper (S7), wherein - the switch-on threshold and / or the switch-off threshold is changed dynamically during generative braking mode of the servomotor (M, M1-M6) depending on the current speed of the servomotor (M, M1-M6).
2. Method according to Claim 1, characterized in that the switch-on threshold and / or the switch-off threshold are changed dynamically during generative braking mode of the servomotor (M, M1-M6) depending on the current speed of the servomotor (M, M1-M6), such that the link voltage is reduced continuously as the speed of the servomotor (M, M1-M6) decreases.
3. Method according to Claim 2, characterized in that the link voltage is reduced in proportion to the decrease in the speed of the servomotor (M, M1-M6).
4. Method according to one of Claims 1 to 3, characterized in that the switch-on threshold and / or the switch-off threshold is changed during generative braking mode of the servomotor (M, M1-M6) depending on the current speed of the servomotor (M, M1-M6) by virtue of the switch-on threshold and / or the switch-off threshold being changed on the basis of a current speed of the servomotor (M, M1-M6) as measured by way of a motor position sensor or on the basis of the measured motor voltage of the servomotor (M, M1-M6) currently prevailing in the servomotor (M, M1-M6).
5. Method according to one of Claims 1 to 4, characterized in that the switch-on threshold and / or the switch-off threshold is lowered during generative braking mode of the servomotor (M, M1-M6), depending on the current speed of the servomotor (M, M1-M6), down to a predefined minimum threshold value, in particular the switch-off threshold value is lowered to a minimum threshold value below the grid voltage of the AC voltage grid (2).
6. Method according to one of Claims 1 to 5, characterized in that the switch-on threshold and / or the switch-off threshold is lowered during generative braking mode of the servomotor (M, M1-M6), depending on the current speed of the servomotor (M, M1-M6), only down to a minimum threshold value at which a minimum voltage is present in the DC link (4) at which generative braking mode of the servomotor (M, M1-M6) is still provided by driving the power semiconductor switches (S1-S6) of the inverter circuit (7).
7. Method according to one of Claims 1 to 6, characterized in that, in order to simultaneously drive at least two servomotors (M, M1-M6), the frequency converter (1) has a number of inverter circuits (7) corresponding to the number of servomotors (M, M1-M6) and connected to the common DC link (4) of the frequency converter (1), wherein the switch-on threshold and / or the switch-off threshold is changed dynamically during generative braking mode of one or more of the at least two servomotors (M, M1-M6) depending on the current speed of the servomotor (M, M1-M6) that is currently inducing the highest link voltage.
8. Method according to one of Claims 1 to 7, characterized in that the electrical energy in the DC link (4) is increased during the dynamic change in the switch-on threshold and / or the switch-off threshold during generative braking mode of the servomotor (M, M1-M6) in the states of the DC link (4) in which the braking chopper (S7) has disconnected the braking resistor (6) by virtue of the link capacitor (5) being fed exclusively by the energy from the inverter circuit (7) that is generated by the at least one servomotor (M, M1-M6).
9. Robot, having a robot arm (9) having multiple articulations (L1-L6) and multiple limbs (G1-G7) able to be adjusted relative to one another by the movements of the articulations (L1-L6) of the robot arm (9), wherein at least one of the articulations (L1-L6) is assigned a servomotor (M, M1-M6) that is designed to adjust the at least one articulation (L1-L6) by automatically driving the servomotor (M, M1-M6), and having a control device (10) that is designed to automatically drive at least one servomotor (M, M1-M6) of the robot arm (9) in order to automatically adjust the limbs (G1-G7) of the robot arm (9) relative to one another through driven movement of the articulations (L1-L6), characterized in that the control device (10) is designed and configured to perform a method according to one of Claims 1 to 8.
10. Computer program product having a machine-readable medium on which there is stored program code that is able to be read by a control device (10) of the robot (9) according to Claim 9 and, when read, designs and / or configures the control device (10) to perform a method according to one of Claims 1 to 8 when the program code is executed by the control device (10).
