Closed-loop controller arrangement for direct or indirect hybrid drive of machine elements

By introducing acceleration pilot control and force pilot control considered inertia into the machine shaft closed-loop controller, the problems of insufficient rigidity of the transmission device and high cost of direct drive are solved, power optimization and accuracy improvement are achieved, and the cost and space of the torque motor are reduced. need.

CN118938653APending Publication Date: 2024-11-12SIEMENS AG
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202410570582.0
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Priority Date
2023-05-10
Filing Date
2024-05-09
Publication Date
2024-11-12

AI Technical Summary

Technical Problem

In existing machine shaft drive systems, the low rigidity of the transmission device leads to poor dynamic performance and positioning accuracy, the direct drive is costly and complex in integration, making it difficult to optimize the closed-loop controller structure cost-effectively.

Method used

A closed-loop controller structure is designed, and the force pilot control values ​​of the first and second drivers are determined by the third determining device using the acceleration pilot control value, and the addition device combines these values ​​to drive the driver, and performs force pilot control in consideration of shaft inertia. , optimize power and load distribution.

Benefits of technology

Improves power support during positioning, reduces the load on the second driver, reduces the cost and structural space of the torque motor, enhances the power and accuracy of the shaft, and is suitable for cost-optimized design of multiple driver shafts.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118938653A_ABST
    Figure CN118938653A_ABST
Patent Text Reader

Abstract

The invention relates to a closed-loop controller arrangement for a direct or indirect hybrid drive of machine elements, in particular to a closed-loop controller arrangement for a first drive and a second drive, the first drive acts via a transmission and the second drive acts directly on machine elements of a machine having a plurality of shafts, which machine elements can be adjusted relative to the shafts. The position closed-loop controller receives a position setpoint and a position actual value of the machine element and determines a speed setpoint of the machine element by means of these values. The first determination means receives a speed setting value and determines an obtained speed setting value using the speed setting value. The first speed closed-loop controller determines a first force setpoint by means of the difference between the actual speed value of the first drive and the obtained speed setpoint and actuates the first drive according to the first force setpoint. The second speed closed-loop controller determines a second force setpoint by means of the difference between the obtained speed setpoint and the actual speed value of the machine element and actuates the second drive according to the second force setpoint.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to a closed-loop controller structure for a first drive and a second drive, wherein the first drive acts on a machine element via a transmission device and the second drive acts directly on the machine element to move the machine element relative to an axis, wherein the closed-loop control of the first drive is carried out with the help of a first force-leading control value and the closed-loop control of the second drive is carried out with the help of a second force-leading control value.

[0002] The invention relates in particular to a closed-loop controller structure for a first drive and a second drive, wherein the first drive acts on a machine element via a transmission and the second drive acts directly on the machine element,

[0003] - wherein the closed-loop controller structure comprises a position closed-loop controller, which receives the difference between the position set value and the position actual value of the machine element respectively by means of a closed-loop control clock pulse and drives the first drive according to the corresponding position set value and the corresponding position actual value,

[0004] - wherein the closed-loop controller structure comprises a second speed closed-loop controller, which receives the difference between the obtained speed setting value and the speed actual value of the machine element respectively using the first speed closed-loop control clock pulse, determines the second force setting value of the second actuator according to the corresponding obtained speed setting value and the corresponding speed actual value of the machine element respectively, and drives the second actuator according to the corresponding second force setting value,

[0005] wherein the closed-loop controller structure has a first determination device which determines the corresponding obtained speed setpoint and outputs it to a first speed closed-loop controller,

[0006] - wherein the position closed-loop controller determines the speed setpoint of the machine element in each case as a function of the difference between the corresponding position setpoint and the corresponding position actual value and outputs the corresponding speed setpoint as an output signal,

[0007] - wherein the closed-loop controller structure comprises a first speed closed-loop controller, which receives the difference between the actual speed value of the first driver and the obtained speed setting value respectively by using the first speed closed-loop control clock pulse, determines the first force setting value of the first driver respectively according to the difference between the corresponding actual speed value of the first driver and the corresponding obtained speed setting value, and drives the first driver according to the corresponding setting value,

[0008] - wherein the first determining means receives the corresponding speed setting value and determines the obtained speed setting value using the corresponding speed setting value,

[0009] wherein the first determining device outputs the corresponding obtained speed setting value to the second speed closed-loop controller in addition to the first speed closed-loop controller.

[0010] The invention further relates to an open-loop control device for a first drive and a second drive, wherein the first drive acts on a machine element via a transmission and the second drive acts directly on the machine element,

[0011] - wherein the open-loop control device has a structure of an upper open-loop controller and a closed-loop controller,

[0012] - wherein the upper open-loop controller uses the closed-loop control clock pulse to preset the position setpoint for the closed-loop controller structure,

[0013] - wherein the closed loop controller structure is implemented as described above.

[0014] The invention also relates to a machine,

[0015] - wherein the machine comprises a machine element, a first drive, a second drive and a transmission,

[0016] - wherein the first drive acts on the machine element via a transmission and the second drive acts directly on the machine element,

[0017] - wherein the first drive and the second drive are controlled by such an open-loop control device.

[0018] The present invention also relates to a method for closed-loop control of a drive unit having a first drive and a second drive, wherein the first drive acts on a machine element via a transmission device and the second drive acts directly on the machine element to move the machine element relative to an axis, wherein closed-loop control of the first drive is performed by means of a first force leading control value and closed-loop control of the second drive is performed by means of a second force leading control value.

[0019] The invention relates in particular to a method for closed-loop control of a drive unit having a first drive and a second drive, wherein the first drive acts on a machine element via a transmission and the second drive acts directly on the machine element to move the machine element relative to a shaft,

[0020] wherein the position closed-loop controller receives the difference between the position setpoint value and the position actual value of the machine element using the closed-loop control clock pulse and controls the first drive according to the corresponding position setpoint value and the corresponding position actual value,

[0021] wherein the second speed closed-loop controller receives the difference between the obtained speed setting value and the speed actual value of the machine element respectively using the first speed closed-loop control clock pulse, determines the second force setting value of the second drive according to the corresponding obtained speed setting value and the corresponding speed actual value of the machine element respectively, and drives the second drive according to the corresponding second force setting value,

[0022] wherein the first determining means determines the corresponding obtained speed setting value and outputs it to the first speed closed-loop controller,

[0023] - wherein the position closed-loop controller determines the speed setpoint of the machine element in each case as a function of the difference between the corresponding position setpoint and the corresponding position actual value and outputs the corresponding speed setpoint as an output signal,

[0024] wherein the first speed closed-loop controller receives the difference between the actual speed value of the first drive and the obtained speed setting value respectively by using the first speed closed-loop control clock pulse, determines the first force setting value of the first drive respectively according to the difference between the corresponding actual speed value of the first drive and the corresponding obtained speed setting value, and drives the first drive according to the corresponding setting value,

[0025] - wherein the first determining means receives the corresponding speed setting value and determines the obtained speed setting value using the corresponding speed setting value,

[0026] wherein the first determining device outputs the corresponding obtained speed setting value to the second speed closed-loop controller in addition to the first speed closed-loop controller. Background Art

[0027] A machine axis usually consists of a drive, a transmission and a machine element. In this case, the drive acts on the machine element only with the transmission. A disadvantage of this arrangement is that the transmission has a relatively low rigidity and thus at least the kinematics of the machine element and in many cases also the positioning accuracy of the machine element is relatively low.

[0028] The invention is particularly directed to machine axes in which the drive system comprises a servomotor with a classical drive train (KGT (ball screw), transmission, etc.) and at the same time a direct drive (see Figure 1 ) This drive arrangement is distinguished from a classic master-slave arrangement with a symmetrical drive train by the fact that the force setpoints are not divided strictly proportionally but rather according to the task.

[0029] The advantage of this device is that it is able to combine the advantages of both drive types (direct and indirect).

[0030] - Direct drives are close to the load and can be used to transfer high-frequency force components. Direct drives close to the load can be used to damp oscillation modes close to the process.

[0031] Due to the high transmission ratio, a servomotor of "cheap" design with a small installation space and power can compensate for high static and quasi-static loads.

[0032] The purpose of this drive group is to increase the axis power. Here it should be possible to:

[0033] - Increase productivity by driving higher jerk and / or higher acceleration with consistent quality,

[0034] - or reduce the tendency to oscillate in the case of consistent dynamics, thus improving the quality of the movement,

[0035] -Or improve quality / path accuracy while increasing power.

[0036] In the embodiment that often occurs, the axis driven indirectly via a ball screw or a transmission is supplemented by a direct drive on the load side. For this purpose, a linear motor is used in the linear axis and a torque motor is used in the case of a rotary axis (rotating axis).

[0037] The problem with this drive combination is mainly the complexity of integrating direct drives due to the motor size and the high cooling costs. In addition, the cost of direct drives is very high compared to indirect drives. If this solution is chosen for the 3 spindles of a robot, for example, significant additional costs are incurred, which, despite the added value brought by the increased power, still limit the competitiveness of the installation.

[0038] A closed-loop controller structure, an open-loop control device and a machine of the type mentioned are known from EP 2 174 748 A1. With this design of the machine axis, it is possible to position the machine element with high dynamics and high positioning accuracy, with appropriate control of the first drive and the second drive. In particular, the first drive can be used to transmit high-frequency force components and to damp process-related oscillations, while the second drive can withstand high static and low-frequency loads. However, no more detailed design of the closed-loop controller structure can be derived from EP 2 174 748 A1.

[0039] A closed-loop controller structure for a first drive and a second drive is known from US 2010 / 0 171 458 A1, wherein the first drive and the second drive act on a machine element via corresponding transmission devices, wherein the closed-loop controller structure includes a position closed-loop controller, which uses a closed-loop control clock pulse to respectively receive a position set value and a position actual value of the machine element, and drives the second drive according to the corresponding position set value and the corresponding position actual value, wherein the closed-loop controller structure includes a first speed closed-loop controller, which uses a first speed closed-loop control clock pulse to respectively receive a difference between an obtained speed set value and a speed actual value of the machine element, and determines a first force set value of the first drive according to the corresponding obtained speed set value and the corresponding speed actual value of the machine element, and drives the second drive according to the corresponding first force set value and the corresponding second force set value. The invention relates to a method for controlling a first drive according to a first force setting value, wherein the closed-loop controller structure has a first determining device, the first determining device determines the corresponding obtained speed setting value and outputs it to the first speed closed-loop controller, wherein the position closed-loop controller determines the speed setting value of the machine element according to the corresponding position setting value and the corresponding position actual value and outputs the corresponding speed setting value as an output signal, wherein the closed-loop controller structure includes a second speed closed-loop controller, the second speed closed-loop controller receives the difference between the speed setting value output by the position closed-loop controller and the corresponding speed actual value of the second drive respectively with the second speed closed-loop control clock pulse, and determines the first force setting value of the second drive according to the speed setting value and the corresponding speed actual value of the second drive respectively, and controls the second drive according to the corresponding first force setting value.

[0040] A substantially similar situation can be found in DE 10 2014 005 664 B3.

[0041] From EP 2 954 986 A1, a device for controlling and regulating a system with a plurality of kinematically interacting individual bodies, at least one of which is moved by a drive, is known. A load calculation device is provided for continuously calculating a force vector for each individual body during the movement of the system according to preset set coordinates, and a torque calculation device is provided for continuously calculating a compensation value of a compensation force vector during the movement based on the set coordinates and the force vector. In addition, the known device for controlling and regulating has a control unit for closed-loop and open-loop control during the movement according to target coordinates and at least one compensation torque via a closed-loop control unit for closed-loop control of the value of the force formation of at least one drive.

[0042] From EP 3 625 628 A1, a drive for a machine element is known, wherein a first drive, such as a transmission motor, acts directly on the machine element via a transmission, and a second drive, such as a torque motor, acts directly on the machine element. A position closed-loop controller receives a position setpoint and an actual position value of the machine element and determines a speed setpoint of the machine element as a function of these values. A first determining device receives the speed setpoint and determines the obtained speed setpoint using the speed setpoint. A first speed closed-loop controller determines a first force setpoint as a function of the difference between the actual speed value of the first drive and the obtained speed setpoint, and drives the first drive as a function of the force setpoint. A second speed closed-loop controller determines a second force setpoint based on the difference between the obtained speed setpoint and the actual speed of the machine element, and drives the second drive as a function of the force setpoint. The known closed-loop controller structure also includes a second determining device, which receives acceleration pilot control values ​​respectively using pilot control clock pulses and receives therefrom a first force pilot control value for the first drive and a second force pilot control value for the second drive in combination with a high-pass and a low-pass filter.

[0043] EP 0 604 672 A1 discloses a method for torque-controlled coupled drive systems, wherein the acceleration torque of each axis is determined from the inherent moment of inertia and the coupling moment of inertia in a torque calculation clock. The changes in the inherent moment of inertia and the coupling moment of inertia are tracked with a slower clock. Summary of the invention

[0044] The object of the present invention is to create a closed-loop controller structure for an axis having a plurality of drives which allows the magnitude of the drives to be designed in a cost-optimized manner.

[0045] This object is achieved by the closed-loop controller structure of the present invention.

[0046] According to the invention, a closed-loop controller structure of the type mentioned in the introduction is designed as follows:

[0047] A third determination device is provided, which includes a first inertia determination device for determining the first shaft inertia, wherein the third determination device includes a second inertia determination device for determining the second shaft inertia, and wherein the first shaft inertia and / or the second shaft inertia each participate in determining the first force pilot control value and the second force pilot control value with different, in particular adjustable weightings.

[0048] According to the invention, a closed-loop controller structure of the type mentioned at the outset is designed in particular in the following way:

[0049] The closed-loop controller structure has a third determining device that receives the acceleration pilot control value using the pilot control clock pulse, determines the corresponding second force pilot control value of the second actuator according to the corresponding acceleration pilot control value and outputs the corresponding second force pilot control value to the second adding device, and the second adding device adds the corresponding second force pilot control value to the corresponding second force setting value, so that the second actuator is driven according to the sum of the corresponding second force pilot control value and the corresponding second force setting value,

[0050] wherein the third determining device determines a corresponding first force pilot control value of the first drive by means of the corresponding temporary force pilot control value and outputs the corresponding first force pilot control value to a first adding device, which adds the corresponding first force pilot control value to the corresponding first force setpoint value, so that the first drive is driven according to the sum of the corresponding first force pilot control value and the corresponding first force setpoint value,

[0051] The third determining device comprises a first inertia determining device for determining the inertia of the first shaft,

[0052] The third determining device comprises a second inertia determining device for determining the inertia of the second shaft,

[0053] wherein a corresponding first force pilot control value is determined according to the motor inertia, the first axis inertia, the second axis inertia and the first scaling factor, and

[0054] The corresponding second force pilot control value is determined according to the second shaft inertia and the second scaling factor.

[0055] By determining the resulting speed setpoint from the position setpoint and the position actual value, in particular from the difference between the position setpoint and the position actual value, it is possible in particular to correct disturbances which are not noticeable in the position setpoint with high dynamic support.

[0056] The present invention proposes: a closed-loop controller structure has a third determining device, the third determining device uses a pilot control clock pulse to respectively receive acceleration pilot control values, determines the corresponding second force pilot control value of the second driver according to the corresponding acceleration pilot control value, and outputs the corresponding second force pilot control value to a second adding device, the second adding device adds the corresponding second force pilot control value to the corresponding second force setting value, so that the second driver is driven and controlled according to the sum of the corresponding second force pilot control value and the corresponding second force setting value.

[0057] This refinement improves the dynamics when positioning the machine element, in particular in the case of a change in the position setpoint value which is usually known in advance.

[0058] The present invention further proposes that: in addition to the corresponding second force pilot control value, the third determination device of the closed-loop controller structure also determines the corresponding first force pilot control value of the first actuator according to the corresponding temporary force pilot control value. Here, the third determination device outputs the corresponding first force pilot control value to the first adding device, and the first adding device adds the corresponding first force pilot control value to the corresponding first force setpoint, so that the first actuator is driven according to the sum of the corresponding first force pilot control value and the corresponding first force setpoint.

[0059] As a result, the dynamics achieved by the first drive during the positioning of the machine element can be increased, so that the resulting load on the second drive is reduced.

[0060] The invention proposes that the shaft inertia of the relevant shaft be taken into account when determining the force pilot control value, so that the force pilot control value is determined according to the corresponding shaft inertia.

[0061] EP 2 954 986 A1 explains how the total inertia from the perspective of each axis (also called total axis inertia or simply axis inertia) can be determined at any time from the machine model depending on the attitude and load. Mot In particular, it should be emphasized here that the axis inertia is determined dynamically during the movement of the system (machine), in particular in the clock of a closed-loop controller structure.

[0062] Usually, the so-called shaft inertia J Mot The (total) inertia of all parts moved by the drive (including the inertia of the drive itself). The axis management is derived from the sum of the inertias of the individual (relative to the axis) moving parts of the machine, which in turn can usually be obtained from the data of the machine or robot manufacturer.

[0063] Apart from the movable parts of the drive itself, all elements of the machine that are moved by the drive (i.e., the elements that follow the associated drive in the kinematic chain) contribute to the shaft inertia J Mot For this element, mechanical engineers usually have information about the moment of inertia or information from which the moment of inertia can be determined (geometrical values, mass, center of gravity, etc.).

[0064] The invention is based on an axle with a drive unit comprising two drives, a first drive (transmission motor) acting on a machine element via a gear (transmission) and a second drive (direct drive, torque motor) acting directly on the machine element.

[0065] The invention is also based on a drive model in which the stiffness of the drive train, in particular the transmission, is modeled by springs with a certain spring rate.

[0066] Axis inertia J Mot Now it is divided into the first axis inertia JMot,an and the second axis inertia J Mot,ab , the first shaft inertia is associated with the transmission driving side of the drive unit, and the second shaft inertia is associated with the transmission driven side of the drive train.

[0067] According to the invention, the third determination means of the closed-loop controller arrangement comprises a first inertia determination means which determines a first shaft inertia J associated with the transmission drive side of the drive unit for the associated shaft. Mot,an .J Mot,an It includes at least primarily the inertia of the first drive (transmission motor) and the transmission (transmission) as well as possible other components (eg primary transmission).

[0068] Furthermore, the third determination device comprises a second inertia determination device which determines, for the relevant shaft, a second shaft inertia J associated with the transmission output side of the drive unit. Mot,ab .J Mot,ab Includes the inertia of the second drive (torque motor) and the "load", where the load includes all mechanical components connected to the second drive along the kinematic chain of the machine, ie the mechanical components moved by it.

[0069] The following associations apply:

[0070] J Mot =J Mot,an +J Mot,ab / i 2

[0071] Where i is the transmission ratio.

[0072] Advantageously, the first axis inertia (J Mot,an ) and / or the second axis inertia (J Mot,ab ) each participate in the determination of the first force pilot control value F1V and the second force pilot control value F2V with different, in particular adjustable, weightings.

[0073] In particular, at least one of the two force pilot control values ​​F1V, F2V is dependent on both the first shaft inertia and the second shaft inertia.

[0074] Advantageously, according to the invention, the corresponding second force pilot control value (F2V) is determined as a function of the second shaft inertia J Mot,ab and the second scaling factor, and the corresponding first force pilot control value is determined according to the first axis inertia J Mot,an , Second axis inertia J Mot,ab And the first scaling factor is determined.

[0075] In a preferred embodiment of the closed-loop controller structure, it is proposed that the first determination device also receives the corresponding speed pilot control value and determines the corresponding obtained speed setting value as the sum of the corresponding speed setting value and the corresponding speed pilot control value. With this embodiment, the dynamics when positioning the machine element can also be further improved.

[0076] The so-called intalk effect results from the low-pass effect of the drive train. In order to transfer the movement of the motor to the load, the "drive train spring" must first be tensioned (in the mass-spring model of the drive train). As a result, sufficient torque is stored in the spring to set the load inertia in motion. The spring tensioning time can be shortened by means of a compensating movement of the motor. This movement is proportional to the acceleration, the load inertia and the spring stiffness. This so-called "intalk compensation" usually has a strong high-pass characteristic and causes hard force peaks in the mechanical system. In order to smooth the peaks, compensation can be performed, for example, by means of a low-pass filter.

[0077] In a preferred embodiment of the closed-loop controller structure, a first internal AC compensation determination device is provided to compensate for the internal AC effect, which receives the speed pilot control value and determines a compensated speed pilot control value. The speed pilot control value is advantageously multiplied by the transmission ratio if necessary before the value determined in this way is also supplied to the speed closed-loop controller.

[0078] In another preferred design scheme of the closed-loop controller structure, in order to compensate for the internal AC effect, a second internal AC compensation determination device is also provided, which receives the output value of the third adaptation block and determines the compensated first force pilot control value (after multiplication by the transmission ratio if necessary).

[0079] This object is also achieved by the open-loop control device of the present invention. According to the present invention, the closed-loop controller structure of the open-loop control device is designed as the closed-loop controller structure according to the present invention.

[0080] This object is also achieved by the machine of the invention.

[0081] According to the invention, the first drive and the second drive are controlled by the open-loop control device according to the invention.

[0082] In a preferred embodiment of the machine, the machine is designed as a machine tool, a production machine or a robot.

[0083] According to the invention, a method of the type mentioned in the introduction provides that the moment of inertia of the first axis is determined and the moment of inertia of the second axis is determined,

[0084] In this case, the first shaft moment of inertia and / or the second shaft moment of inertia each participates in determining the first force pilot control value and the second force pilot control value with different, in particular adjustable, weightings.

[0085] In particular, according to the invention, a method of the type mentioned in the introduction provides that a first determination device receives a corresponding speed setting value and uses the corresponding speed setting value to determine a obtained speed setting value,

[0086] - wherein the first determining means outputs the corresponding obtained speed setting value to the second speed closed-loop controller in addition to the first speed closed-loop controller,

[0087] wherein the third determining device determines a corresponding first force pilot control value of the first actuator according to the corresponding temporary force pilot control value and outputs the corresponding first force pilot control value to a first adding device, and the first adding device adds the corresponding first force pilot control value to the corresponding first force setpoint value, so that the first actuator is driven according to the sum of the corresponding first force pilot control value and the corresponding first force setpoint value,

[0088] wherein a corresponding first force pilot control value is determined as a function of the first axis moment of inertia, the second axis moment of inertia and the first scaling factor, and

[0089] wherein a corresponding second force pilot control value is determined as a function of the second shaft inertia and the second scaling factor. BRIEF DESCRIPTION OF THE DRAWINGS

[0090] The above characteristics, features and advantages of the present invention and the ways and methods for achieving them can be clearly understood in conjunction with the following description of the embodiments, which are explained in more detail in conjunction with the accompanying drawings. Herein, a schematic diagram is shown:

[0091] Figure 1 An example of a machine is shown,

[0092] Figure 2 A closed-loop controller structure with a controller according to the prior art is shown,

[0093] Figure 3 A closed-loop controller structure with a controller according to the present invention is shown,

[0094] Figure 4 Show according to Figure 3 A feasible design scheme for the closed-loop controller structure is

[0095] Figure 5 and Figure 6 shows the positioning behavior with respect to the scaling factor α,

[0096] Figure 7 and Figure 8shows the positioning behavior as a function of the scaling factor α and the limited torque,

[0097] Fig. 9 shows the closed-loop controller structure with internal AC compensation,

[0098] Fig.10 Showing the internal exchange effect,

[0099] Fig.11 A feasible implementation of the internal AC compensation determination device is shown.

[0100] Fig.12 shows the positioning behavior with internal AC compensation,

[0101] Fig.13 The torque curve is shown with internal AC compensation. DETAILED DESCRIPTION

[0102] according to Figures 1 to 3 The machine has a machine element 4. The machine element 4 is based on Figure 1 The view in FIG. 4 can be, for example, a workpiece table. In this case, the machine can be designed, for example, as a machine tool. Alternatively, the machine element 4 can be, for example, a gripper arm. In this case, the machine can be designed, for example, as a production machine. Alternatively, the machine element 4 can be part of a robot, for example an arm member of a robot gripper arm. Figure 1 , the machine element 4 can move in translation. However, the machine element 4 can also be rotatably turned or pivoted relative to a rotation axis (rotation axis).

[0103] The machine element 4 is moved relative to the first shaft via the first drive 1. The first drive 1 acts on the machine element 4 via a transmission 3. The transmission 3 can be designed, for example, as a transmission, a screw or a ball screw. Other designs are also possible. The transmission ratio i of the transmission 3 can be constant or dependent on the actual position value x of the machine element 4. Figure 1, the first drive 1 can be designed as a rotary drive, for example. In this case, if the first drive 1 rotates by any angle, for example 360°, then in the case of a translational movement of the machine element 4, the machine element 4 travels a distance determined by the transmission ratio i of the transmission 3, for example by the pitch of the screw or ball screw. Even when the machine element 4 also rotates when the first drive 1 rotates, the rotation angle of the machine element 4 is only exceptionally (i.e., in the case of a transmission ratio of 1) consistent with the rotation angle of the machine element when the first drive 1 rotates by a specific rotation angle, for example 20°. Usually, the machine element 1 rotates by different rotation angles, for example 50° in the case of a transmission ratio i of 2.5. In rare exceptional cases, the first drive 1 can also be designed as a linear drive. However, in this case, the first drive also acts on the machine element 4 via the transmission 3.

[0104] The machine element 4 is also moved relative to the first shaft via the second drive 2. The second drive 2 acts directly on the machine element 4. "Directly" means that the second drive 2 acts on the machine element 4 without an intermediate transmission. The second drive 2 acts, for example, according to Figure 1 The view in can be designed as a linear drive, ie a drive that moves in translation. In this case, if the second drive 2 moves an arbitrary distance, for example 10 mm, the machine element 4 also moves exactly the same distance, ie 10 mm according to the example mentioned.

[0105] However, in other embodiments of the invention, the second drive 2 can be designed as a rotary drive, in particular as a so-called torque motor. If the second drive 2 is rotated by any angle, for example 20°, in the embodiment as a rotary drive, the machine element 4 is also rotated by exactly the same angle relative to the rotation axis, according to the example mentioned, 20°.

[0106] The first machine element 4 is a part of the machine which is driven directly relative to the associated axis by means of a drive unit, which comprises a first drive and a second drive. However, apart from the first machine element 4, all other machine elements which follow the first machine element 4 and are directly or indirectly connected to it are likewise moved together by the movement of the first machine element 4 from the perspective of the associated drive unit in the kinematic chain of the machine.

[0107] For example, if in a robot a first arm component of a robot arm is pivoted about a first (rotational) axis relative to a stationary base by a first drive unit comprising a first drive and a second drive, then in addition to the first arm component (in this case corresponding to the first machine element 4), all other components (machine elements) of the robot arm that follow the first arm component in the kinematic chain, such as further arm components and drives, are also pivoted about the first axis up to the end effector. From the perspective of the drive unit involved, these components together form the "load" that is moved by the drive unit.

[0108] The first drive 1 and the second drive 2 are controlled by an open-loop control device 5. Figure 2 The open-loop control device 5 includes an upper open-loop controller 6 and a closed-loop controller structure 7. The upper open-loop controller 6 can be designed as a digital controller, a robot controller or an MC controller (motion controller). The design of the closed-loop controller structure 7 is the core subject of the present invention.

[0109] In accordance with Figure 2 In the prior art implementation (based on document EP3625628A1), the closed-loop controller structure 7 includes a position closed-loop controller 8. Figure 2 , the position closed-loop controller 8 can be particularly designed as a proportional (P) controller, that is, as a proportional regulator. The position closed-loop controller 8 receives the position set value x* from the superior open-loop controller 6. The position closed-loop controller 8 also receives the actual position value x of the machine element 4 from a measuring device (not shown in the figure). The position set value x* and the actual position value x are received with the position control clock. Therefore, with each position control clock, the position closed-loop controller 8 receives a new position set value x* and a new actual position value x of the machine element 4. The closed-loop control clock pulse is usually in the range of about 1 ms or slightly smaller, for example 250μs, 500μs, 1ms or 2ms.

[0110] The position closed-loop controller 8 determines the speed set value v* of the machine element 4 respectively according to the corresponding position set value x* and the corresponding position actual value x (in particular according to the difference between the corresponding position set value x* and the corresponding position actual value x). The term "according to" is intended to indicate that the values ​​mentioned in conjunction with the term "according to" are all values ​​included as variables in the determination of the respectively mentioned determined values. In the specific example, the corresponding speed set value v* is not related to other variable values, although it is related to the corresponding position set value x* and the corresponding position actual value x. Therefore, the term "according to" is contrasted with the terms "related to..." and "using". The terms are intended to indicate that the respectively determined values ​​are related to the respectively mentioned input values, but do not exclude the correlation that also exists in other variable values. The position closed-loop controller 8 outputs the respectively determined speed set value v* with a closed-loop control clock pulse.

[0111] according to Figure 2 The closed-loop controller structure 7 also includes a second speed closed-loop controller 9. The second speed closed-loop controller 9 can be configured to Figure 2 The view in is designed as a proportional controller. The second speed closed-loop controller 9 receives the difference between the obtained speed set value and the speed actual value v of the machine element 4 with the second speed closed-loop control clock pulse. The obtained speed set value and the speed actual value v are determined with the second speed closed-loop control clock pulse. Therefore, the second speed closed-loop controller 9 receives the difference between the new obtained speed set value and the new speed actual value v of the machine element 4 with each such clock. The second speed closed-loop control clock pulse (in terms of time) is at most as large as the closed-loop control clock pulse. However, the second speed closed-loop control clock pulse can also have a smaller value, for example half of the closed-loop control clock pulse.

[0112] According to the difference between the corresponding obtained speed setpoint and the corresponding speed actual value v of the machine element 4, the second speed closed-loop controller 9 determines the corresponding second force setpoint F2* of the second drive 2 with the second speed closed-loop control clock pulse. The second speed closed-loop controller 9 drives the second drive 2 according to the corresponding determined second force setpoint F2*.

[0113] In order to determine the respective actual speed value v of the machine element 1, the closed-loop controller structure 7 can, for example, include a differentiator 10, to which the respective actual position value x of the machine element 4 is supplied and which determines the respective actual speed value v of the machine element 4 by differentiating the respective actual position value x of the machine element 4. Alternatively, the respective actual speed value v of the machine element 4 can be determined in another way or can be directly measured.

[0114] In order to determine the corresponding obtained speed set value, the closed-loop controller structure 7 has a first determination device 11. The first determination device 11 receives the corresponding speed set value v* from the position closed-loop controller 8 and determines the corresponding obtained speed set value using the corresponding speed set value v*. The first determination device 11 outputs the corresponding obtained speed set value to the second speed closed-loop controller 9. The first determination device 11 works with the closed-loop control clock pulse, the first speed closed-loop control clock pulse or the second speed closed-loop control clock pulse, which will be discussed in detail below.

[0115] The closed-loop controller structure 7 also includes a first speed closed-loop controller 12. The first speed closed-loop controller 12 can be configured to Figure 2 The view in is designed as a PI (proportional integral) controller. The first determining device 11 outputs the corresponding obtained speed set value not only to the second speed closed-loop controller 9, but also to the first speed closed-loop controller 12. If necessary, the transmission ratio i of the transmission device 3 is taken into account in the first adaptation block 13. The first speed closed-loop controller 12 uses the first speed closed-loop control clock pulse to respectively receive the difference between the obtained speed set value and the speed actual value v1 of the first drive 1. The first speed closed-loop control clock pulse (in terms of time) is at most as large as the closed-loop control clock pulse. However, the first speed closed-loop control clock pulse can also have a smaller value, such as half of the closed-loop control clock pulse. Typically, the first speed closed-loop control clock pulse is equal to the second speed closed-loop control clock pulse. The corresponding speed actual value v1 of the first drive 1 can be different from the corresponding speed actual value v of the machine element 4, because the detection points of the speed actual value v1 of the first drive 1 and the speed actual value v of the machine element are based on Figure 2 The views in FIG. 1 are at different ends of the transmission 3 .

[0116] The first speed closed-loop controller 12 uses the first speed closed-loop control clock pulse to determine the corresponding first force setting value F1* of the first drive 1 according to the (difference) between the corresponding obtained speed setting value and the corresponding speed actual value v1 of the first drive 1. The first speed closed-loop controller 12 drives the first drive 1 according to the respectively determined first force setting value F1*. Therefore, the position closed-loop controller 8 also indirectly drives the first drive 1 according to the corresponding position setting value x* and the corresponding position actual value x.

[0117] In accordance with Figure 2 In the design of the closed-loop controller structure 7, the first determining means 11 can also be "degenerate". In this case, the corresponding obtained speed setting value is the same as the corresponding speed setting value v*. However, according to Figure 2, the first determining device 11 preferably also receives the corresponding speed pilot control value vV with its working clock. The working clock can be one of the closed-loop control clock pulses or the speed closed-loop control clock pulses. The corresponding speed pilot control value vV is preset for the first determining device 11 by the superior open-loop controller 6. The first determining device 11 determines the corresponding obtained speed setting value as the sum of the corresponding speed setting value v* determined by the position closed-loop controller 8 and the corresponding speed pilot control value vV.

[0118] As from Figure 2 As can be seen in the figure, the closed-loop controller structure 7 has a second determining device 14. The second determining device receives the acceleration pilot control value aV from the upper open-loop controller 6 using the pilot control clock pulse. The pilot control clock pulse can correspond to one of the closed-loop control clock pulse or the speed closed-loop control clock pulse. However, alternatively, the pilot control clock pulse can also have a smaller value, such as half of the second speed closed-loop control clock pulse.

[0119] The second determining device 14 determines at least one second force pilot control value F2V of the second actuator 2 according to the corresponding acceleration pilot control value aV. The second determining device 14 outputs the corresponding second force pilot control value F2V to the second adding device 15. The second adding device 15 adds the corresponding second force pilot control value F2V to the corresponding second force setpoint F2*. Therefore, the second actuator 2 is driven according to the sum of the corresponding second force pilot control value F2V and the second force setpoint F2*.

[0120] The second determination device 14 also has an adaptation device 16, which converts the corresponding acceleration pilot control value aV into a temporary force pilot control value. The adaptation device 16 takes into account the mass or inertia of the machine element 4. In the simplest case, the function of the adaptation device 16 is only a scaling by means of a suitably selected constant C.

[0121] The second determination device 14 then determines the corresponding second force pilot control value F2V as a function of the corresponding provisional force pilot control value. It is particularly possible that the second determination device 14 implements a high-pass filter 17, by means of which the second determination device 14 determines the corresponding second force pilot control value F2V by high-pass filtering the corresponding preliminary force pilot control value F2V. If necessary, the transmission ratio i of the transmission 3 can be taken into account in the second adaptation block 18.

[0122] The second determination device 14 also determines the corresponding first force pilot control value F1V of the first drive 1 as a function of the corresponding temporary force pilot control value. For this purpose, the second determination device 14 outputs the corresponding first force pilot control value F1V to the first addition device 19. The first addition device 19 forms the sum of the corresponding first force pilot control value F1V and the corresponding first force setpoint value F1*. The first drive 1 is thus driven as a function of the mentioned sum.

[0123] It is possible that the corresponding first force pilot control value F1V coincides with the corresponding temporary force pilot control value. However, the second determination device 14 advantageously comprises a low-pass filter 20. Therefore, the second determination device 14 determines the corresponding first force pilot control value F1V by low-pass filtering the corresponding temporary force pilot control value. In addition, similar to the determination of the corresponding second force pilot control value F2V, the transmission ratio i of the transmission device 3 is also taken into account in the third adaptation block 21 to determine the corresponding first force pilot control value F1V.

[0124] A special feature of the known closed-loop controller structures is the pilot control of the acceleration, which sets the power distribution with the aid of low-pass and high-pass filters for the transmission motor and the torque motor. However, this method offers few degrees of freedom in determining the magnitude of the torque motor. Since the torque motor must convert the maximum torque proportionally, it is usually the limiting factor for the acceleration of the shaft. In order to be able to drive the same acceleration as the reduced transmission motor, the magnitude of the torque motor must be designed to be significantly larger. However, due to the available construction space, this is usually not feasible.

[0125] Figure 3 FIG. 2 shows a closed-loop controller structure with a controller according to the present invention. Figure 2 In this case, components 1 to 4 are shown slightly differently, namely in the usual model representation. The first drive 1 is also labeled "GM" (transmission motor), the second drive 2 is labeled "TM" (torque motor) and the machine element 4 is labeled "L" (load). The transmission 3 (also referred to as the value of the transmission ratio "i") is now divided into model components 3 and 3A, wherein component 3A is shown as a spring and symbolically represents the limited stiffness of the drive train, in particular the transmission 3, in the model.

[0126] According to Figure 2 The known closed-loop controller structures are different, according to Figure 3The closed-loop controller structure according to the present invention has a third determining device 30, which uses the pilot control clock pulse to respectively receive the acceleration pilot control value aV, determines the corresponding second force pilot control value F2V of the second drive 2 according to the corresponding acceleration pilot control value aV, and outputs the corresponding second force pilot control value F2V to the second adding device 15. The second adding device adds the corresponding second force pilot control value F2V to the corresponding second force setting value F2*, so that the second drive 2 is driven and controlled according to the sum of the corresponding second force pilot control value F2V and the corresponding second force setting value F2*.

[0127] In addition, the third determination device 30 determines the corresponding first force leading control value F1V of the first drive 3 according to the corresponding temporary force leading control value F1V, and outputs the corresponding first force leading control value F1V to the first adding device 19, and the first adding device adds the corresponding first force leading control value F1V to the corresponding first force setting value F1*, so that the first drive 1 is driven according to the sum of the corresponding first force leading control value F1V and the corresponding first force setting value F1*.

[0128] Furthermore, the third determination means 30 comprises a first inertia determination means 31 which determines a first shaft inertia J associated with the transmission drive side of the drive train. Mot,an .

[0129] Furthermore, the third determination device 30 comprises a second inertia determination device 32 which determines a second axle inertia J associated with the transmission driven side of the drive train. Mot,ab .

[0130] Here, the corresponding second force pilot control value F2V is calculated as a function of the second shaft inertia J Mot,ab and the second scaling factor (1-α), and the corresponding first force pilot control value F1V is determined according to the first shaft inertia J Mot,an , Second axis inertia J Mot,ab and the first scaling factor α is determined.

[0131] Usually, J mot Describes the total inertia from the perspective of the axis.

[0132] The first axis inertia J Mot,an The inertia of the transmission motor 1 , the transmission 3 and possibly other transmission stages (preceding stages, belts, etc.) are included.

[0133] J Mot,an This is also the remaining inertia from the perspective of the transmission motor 1 after the dynamic decoupling of the load.

[0134] Second axis inertia J Mot,abThe inertia of the torque motor 2 and the "load" is included. Here, "load" is understood to mean the inertia acting on the drive unit via the machine element 4 driven by the drive unit. This inertia consists of all the inertias of the considered kinematic chain, of which the first axis inertia J Mot,an This inertia therefore includes the inertia of the machine element 4 and therefore the inertia of the subsequent, directly or indirectly connected machine elements 4 along the kinematic chain, referred to as “loads” for short, from the perspective of the drive unit.

[0135] Instead of following Figure 2 According to the invention, the torque of the load acceleration is divided between the drive, in particular the torque motor, and the transmission motor by means of scaling factors α1, α2 according to the complex division of the frequency range of the embodiment of the invention. The values ​​of the scaling factors provide degrees of freedom with which the magnitude of the power of the axis and the direct drive (torque motor) can be scaled.

[0136] In particular, there is a relationship between the scaling factors α1+α2=1 or α2=1-α1;

[0137] By means of this linkage, only the scaling factor α needs to be determined.

[0138] Selection by means of the factor α (or 1–α): Compensation of the second axis inertia J by the corresponding motor Mot,ab what share of.

[0139] The torque is derived from the acceleration setting value through the inertia (J Mot,an , J Mot,ab The torque for accelerating the drive train (transmission motor and transmission) is advantageously associated with the transmission motor, and the torque for accelerating the load is distributed between the transmission motor and the torque motor.

[0140] Three cases arise from the value of the scaling factor α:

[0141] α = 0: The torque for accelerating the load is associated with the torque motor alone. This situation is optimal with regard to the excitation of the natural frequency. If the shaft is approximated as a two-mass oscillator, each side of the oscillator is optimally driven and the spring never deflects. Therefore, there is no excitation of the natural frequency. However, the disadvantage is that this division requires the largest torque motor.

[0142] - α = 1: The torque for accelerating the load is associated with the transmission motor. Therefore, the shaft is accelerated only by the transmission motor. The torque motor is used only for damping. In this case, the excitation of the natural frequency is maximum, but the torque motor is minimum.

[0143] -0<α<1: The torque for accelerating the load is distributed between the torque motor and the transmission motor. The smaller the α value, the lower the excitation of the natural frequency and the higher the cost of the torque motor.

[0144] In the case of α > 0, the natural frequency of the shaft is always excited and forms oscillations. For these cases, the damping effect of the P-regulated torque motor can also be used to suppress the oscillations.

[0145] In the solution according to the invention, the second speed closed-loop controller 9 is particularly advantageously designed as a (pure) proportional controller and thus does not contain an I component. As a result, the second drive (torque motor) 2 does not have to absorb any holding torque and can be designed to be correspondingly smaller in magnitude. Active (liquid) cooling for the torque motor can therefore usually be dispensed with, thereby additionally reducing the required structural space for the corresponding torque motor.

[0146] It is possible that the closed-loop controller structure 7 can be implemented in hardware. However, preferably, the closed-loop controller structure 7 is based on Figure 4 The view in FIG. 2 is already a software block. In this case, the software block can be a component of a computer program 23. In this case, the computer program 23 includes a machine code that can be executed by the open-loop control device 24. In this case, the open-loop control device 24 is programmed with the aid of the computer program 23. In this case, the open-loop control device 24 uniformly implements the functions of the upper-level open-loop controller 6 and the closed-loop controller structure 7.

[0147] The closed-loop control structure 7 thus operates in a clocked manner, i.e. it receives its variables in accordance with a corresponding clock. If further variables are also specified for the control structure 7 as variables, the variables of the closed-loop control structure 7 are specified in accordance with their corresponding clock. In particular, the position setpoint x* and the position actual value and, if necessary, the velocity actual value v, the velocity pilot control value vV and the acceleration pilot control value aV of the machine element 1 are considered as variables.

[0148] However, the quantity determined by means of the closed-loop controller structure 7 can also be dependent on parameters. However, parameters are not variables. Parameters are quantities that are preset once in advance for the closed-loop controller structure 7 within the scope of its commissioning and then no longer change during continuous operation. Parameters can be, for example, proportional gain factors of the position closed-loop controller 8 and the speed closed-loop controllers 9, 12 and the integral time constant of the second speed closed-loop controller 12.

[0149] The design of the closed-loop controller structure 7 was explained above in conjunction with a machine element 1 that moves in translation, a first drive 2 that also moves in translation, and a second drive 3 that moves in rotation. However, the closed-loop controller structure 7 can also be implemented in a completely analogous manner if the machine element 1 moves in rotation and / or the first drive 2 moves in rotation and / or the second drive 3 moves in translation. In this case, it is only necessary to use the translational magnitude and the corresponding rotational magnitude as required, for example a speed setpoint or a rotational speed setpoint as required. The structural design of the closed-loop controller structure 7 is not affected by this.

[0150] Furthermore, the invention is explained above in conjunction with a superordinate open-loop controller 6 and individual closed-loop controller structures 7, wherein individual machine elements 1 are influenced via the closed-loop controller structures 7. However, the invention can also be used if a plurality of machine elements 1 are to be influenced via the first drive 2 and the second drive 3, respectively. In this case, a superordinate open-loop controller 6 can be provided uniformly for a plurality of machine elements 1. However, the corresponding closed-loop controller structures 7 can be provided individually for the respective machine elements 1.

[0151] Figure 5 and Figure 6 It is shown how the positioning behavior deteriorates as a function of the scaling factor α (Alpha) with increasing α and how the average torque of the torque motor decreases with increasing α.

[0152] In particular, Figure 5 describes the positioning for different values ​​of the scaling factor α, and Figure 6 The torque trend of the torque motor corresponding to different values ​​of the scaling factor α over time t is illustrated. The visible curves 5.1 and 6.1 show the corresponding trend when α=0, the curves 5.2 and 6.2 show the corresponding trend when α=0.33, the curves 5.3 and 6.3 show the corresponding trend when α=0.5, the curves 5.4 and 6.4 show the corresponding trend when α=0.66, and finally the curves 5.5 and 6.5 show the corresponding trend when α=1.

[0153] As explained, positioning accuracy and torque requirement can advantageously be “adjusted” via the factor α.

[0154] The extreme case α=1 is considered in more detail below. In this configuration, the control torque on the transmission motor is 100%. There is no pre-control torque at the torque motor, and the torque motor acts only as a damper.

[0155] In this case, the average torque of the torque motor is lowest. However, at the beginning of the acceleration phase, a torque peak is formed, which is similar to the torque level at other α values.

[0156] Figure 7 and Figure 8 It is shown that the positioning behavior does not deteriorate significantly with limited torque. In particular, curves 7.1 and 8.1 show the position or torque over time when α=1 and without limiting the torque, and curves 7.2 and 8.2 show the position or torque over time when α=1 and limiting the torque to 1000 Nm.

[0157] It can also be seen that the undershoot that occurs during positioning is due to the "pulling up" of the drive train. During the acceleration phase, an acceleration force is generated that acts on the load and counteracts the movement.

[0158] It can be verified that the distance between the measuring system at the transmission motor and the measuring system at the load is strongly dependent on the acceleration. Fig.10 Description association:

[0159] Fig.10 The curve 10.1 shows the course of the difference between the measuring systems during the acceleration phase. In particular, the curve 10.1 shows the acceleration (in rps 2 ), and curve 10.2 shows the difference in the positions provided by the two measuring systems (position difference), which is in degrees (°).

[0160] The described difference in the positions provided by the two measuring systems is also referred to in the literature as the “inter-communication effect”.

[0161] In order to prevent unwanted deviations at the load, the compensating movement of the transmission motor can be pre-controlled. This "internal AC compensation" is implemented in the setpoint channel. The compensating movement is derived from the product of the load inertia divided by the drive train stiffness. If necessary, a low-pass filter can slightly reduce the stiffness of the compensating movement.

[0162] Fig. 9 Description Figure 3 Possible adaptation of the closed-loop controller structure to compensate for internal AC effects.

[0163] Starts based on Figure 3 The closed-loop controller structure is based on Fig. 9 In the embodiment of the invention, it is proposed that in order to compensate for the internal AC effect, a first internal AC compensation determination device 40 is provided, which receives the speed pilot control value and determines the compensated speed pilot control value vV*. The speed pilot control value is advantageously multiplied by the transmission ratio i by means of a fourth adaptation block 41 before the value thus determined is also supplied to the speed closed-loop controller 12.

[0164] In addition, according to Fig. 9In the closed-loop controller structure, in order to compensate for the internal AC effect, a second internal AC compensation determination device 43 is also provided. The second internal AC compensation determination device receives the output value of the third adaptation block 35, and after multiplying it with the transmission ratio i, determines the compensated first force leading control value F1V* with the help of the fifth adaptation block 44.

[0165] Fig.11 A possible embodiment of the internal AC compensation determination device 40 or 43 is shown. As can be seen, the input signal is directly fed into the internal AC compensation determination device and is first fed successively to the double differentiator 45, the multiplication factor J Mot,ab / k and optionally to a low-pass filter 47 and then to an adder 48. The factor k represents the spring rate of the drive train, in particular the transmission.

[0166] Fig.12 and Fig.13 Note: The positioning behavior can be improved by using the internal AC compensation shown. In this case, the torque of the torque motor no longer reaches the previously limited torque limit.

[0167] In particular, Fig.12 and Fig.13 Note: Positioning behavior and torque curve at α=1, without internal AC compensation and without torque limitation (curve 12.1 and curve 13.1), without internal AC compensation and limiting the torque to 1000Nm (curve 12.2 and curve 13.2), and with internal AC compensation and limiting the torque to 1000Nm (curve 12.3 and curve 13.3).

[0168] As described, internal AC compensation advantageously results in an increase in positioning accuracy and a reduction in torque requirements.

[0169] Another advantage of the invention is that a damping effect (damping) can be achieved by means of a torque motor. The damping effect can be achieved in particular by: Figure 3 As described, the speed closed-loop controller of the torque motor has only a P component. Since the transmission motor ensures the suppression of static forces (process forces, gravity), the speed closed-loop controller of the torque motor can be adjusted in an "optimally damped" manner.

[0170] Alternatively, the phases of the torque motor can be short-circuited for damping. The current induced during the relative movement between the rotor and the stator thus acts as a torque for damping. In this case, only the damping produced cannot be adjusted.

[0171] Another advantage of the present invention is that when the I component of the speed controller of the torque motor is activated, there is no balancing static force through the motor and the motor does not have to be permanently energized. Therefore, compared with conventional solutions, a smaller motor can be used through the present invention. The space required for the torque motor and the cost of the torque motor are thereby reduced. In addition, in the solution according to the present invention, at least active cooling can be advantageously abandoned in the torque motor. By eliminating the cooling unit (fan, liquid cooling device), the structural space required for the corresponding torque motor at the machine is also reduced. This also significantly simplifies the integration of the torque motor into the machine, and if necessary, the machine can even be built smaller as a whole with the same technical data (maximum speed, acceleration, load / force at TCP (tool center point)).

[0172] Furthermore, the effort and costs of the cooling unit are high. By possibly dispensing with (active) cooling, the costs of the motor or machine as a whole are significantly reduced.

[0173] The present invention can be particularly advantageously used in a robot in which two drives all act on the rotary axis. So, particularly in a robot, the smallest possible loading value and the smallest possible drive weight are particularly important.

[0174] In summary, the invention has the significant advantage that the power of the axis can be greatly increased by the combination of two drives in combination with the closed-loop controller structure according to the invention. Of course, this applies as a whole to machines comprising a plurality of such axes, in particular in the form of a kinematic chain. By clever control and compensation, the costs of the torque motor on the driven side can be significantly reduced. The high productivity and increased precision with limited cost increase (compared to axes with only one drive) are particularly advantageous for integration into standard six-axis robots, thus opening up new fields of application (laser, water jet cutting, steel milling). But this is also advantageous for specific machine tool types.

[0175] Particularly advantageously, the closed-loop controller structure according to the invention and / or the superordinate open-loop controller and / or the machine in question with a plurality of machine elements 1 can also be implemented in the form of a digital twin, wherein the machine elements in particular form a kinematic chain. It is then possible to test the entire movement sequence of the machine in a simulation before the actual implementation, in particular under different load conditions. This is possible in particular with only a small amount of additional effort if the closed-loop controller structure (as already mentioned above) is anyway implemented at least largely in the form of software.

[0176] In summary, the present invention relates to the following facts:

[0177] The first drive 1 acts on the machine element 4 via the transmission device 3, and the second drive 2 acts directly on the machine element 4. The position closed-loop controller 8 receives the position setpoint x* and the position actual value x of the machine element 1, and determines the speed setpoint v* of the machine element 4 according to the values ​​x*, x. The first determination device 11 receives the speed setpoint v* and determines the obtained speed setpoint using the speed setpoint v*. The second speed closed-loop controller 9 determines the second force setpoint F2* according to the difference between the obtained speed setpoint and the speed actual value v of the machine element 1 and drives the second drive 2 according to the force setpoint F2*. The first speed closed-loop controller 12 determines the first force setpoint F1* based on the difference between the obtained speed setpoint and the actual speed v of the first drive 1, and drives the first drive 1 according to the force setpoint F1*.

[0178] Advantageously, the first axis inertia (J Mot,an ) and the second axis inertia (J Mot,ab ), which each participate in determining the first force pilot control value (F1V) and the second force pilot control value (F2V) with different, in particular adjustable, weightings.

[0179] The invention has many advantages. In particular, in addition to the adaptation of the transmission ratio i of the transmission 3, both speed closed-loop controllers 9, 12 operate with the same pilot value. The design of the second speed closed-loop controller 9 as a proportional regulator prevents static forces from being able to form for the second drive 2. However, the damping of the oscillations of the machine element 4 is not negatively affected by this. The proportional controller is completely sufficient for this. The solution according to the invention is robust and can be realized cost-effectively.

[0180] Although the present invention has been illustrated and described in more detail by means of preferred embodiments, the present invention is not limited to the disclosed examples and other variations may be derived therefrom by a person skilled in the art without departing from the scope of the present invention.

Claims

1. A closed-loop controller structure for a first driver (1) and a second driver (2), wherein: The first drive (1) acts on the machine element (4) via a transmission (3) and the second drive (2) acts directly on the machine element (4) to move the machine element (4) relative to the shaft, wherein the first drive (1) is closed-loop controlled by means of a first force control value (F2V) and the second drive (2) is closed-loop controlled by means of a second force control value (F1V), It is characterized in that A third determining device (30) is provided, the third determining device comprising determining the first shaft inertia (J Mot,an ) of a first inertia determining device (31), Wherein, the third determining means (30) comprises determining the second shaft inertia (J Mot,ab ) of a second inertia determining device (32), and Among them, the first axis inertia (J Mot,an ) and / or the second axis inertia (J Mot,ab ) respectively participate in determining the first force pilot control value (F1V) and the second force pilot control value (F2V) with different, in particular adjustable, weightings.

2. The closed-loop controller structure according to claim 1, in, The closed-loop controller structure comprises a position closed-loop controller (8), which receives the difference between the position set value (x*) and the position actual value (x) of the machine element (1) using a closed-loop control clock pulse and drives the first drive (1) according to the corresponding position set value (x*) and the corresponding position actual value (x). The closed-loop controller structure comprises a second speed closed-loop controller (9), which receives the difference between the obtained speed setting value and the speed actual value (v) of the machine element (4) by means of the first speed closed-loop control clock pulse, determines the second force setting value (F2*) for the second drive (2) by means of the corresponding obtained speed setting value and the corresponding speed actual value (v) of the machine element (4), and controls the second drive (2) according to the corresponding second force setting value (F2*), The closed-loop controller structure comprises a first determining device (11), which determines and outputs the corresponding obtained speed setting value to a first speed closed-loop controller (9). wherein the position closed-loop controller (8) determines a speed setpoint (v*) for the machine element (4) by means of a difference between the respective position setpoint (x*) and the respective position actual value (x) and outputs the respective speed setpoint (v*) as an output signal, The closed-loop controller structure comprises a first speed closed-loop controller (12), wherein the first speed closed-loop controller receives the difference between the actual speed value (v1) of the first driver (1) and the obtained speed setting value by using a first speed closed-loop control clock pulse, determines a first force setting value (F1*) for the first driver (1) by means of the difference between the corresponding actual speed value (v1) of the first driver (1) and the corresponding obtained speed setting value, and controls the first driver (1) according to the corresponding first force setting value (F1*), wherein the first determining means (11) receives the corresponding speed setting value (v*) and uses the corresponding speed setting value (v*) to determine the obtained speed setting value, The first determining device (11) outputs the corresponding obtained speed setting value to the second speed closed-loop controller (12) in addition to the first speed closed-loop controller (9). The closed-loop controller structure comprises a third determining device (30), which receives the acceleration pilot control value (aV) respectively by means of the pilot control clock pulse, determines the corresponding second force pilot control value (F2V) for the second drive (2) by means of the corresponding acceleration pilot control value (aV), and outputs the corresponding second force pilot control value (F2V) to a second adding device (15), and the second adding device adds the corresponding second force pilot control value (F2V) and the corresponding second force setting value (F2*) so that the corresponding second force pilot control value (F2V) and the corresponding second force setting value (F2*) are added to each other. The third determining device (30) determines a corresponding first force pilot control value (F1V) for the first drive (1) by means of a corresponding temporary force pilot control value, and outputs the corresponding first force pilot control value (F1V) to a first adding device (19), which adds the corresponding first force pilot control value (F1V) to the corresponding first force setpoint (F1*), so that the first drive (1) is driven according to the sum of the corresponding first force pilot control value (F1V) and the corresponding first force setpoint (F1*), Wherein, by means of the first axis inertia (J Mot,an ), the second axis inertia (J Mot,ab ) and a first scaling factor (α) to determine the corresponding first force pilot control value (F1V), and Wherein, by means of the second axis inertia (J Mot,ab ) and a second scaling factor (1-α) are used to determine the corresponding second force pilot control value (F2V).

3. The closed-loop controller structure according to claim 2, in, The sum of the first scaling factor (α) and the second scaling factor (1-α) is 1.

4. A closed-loop controller structure according to any one of the preceding claims, in, The first determination device (11) also receives the corresponding speed lead control value (vV) and determines the respectively obtained speed setting value as the sum of the corresponding speed setting value (v*) and the corresponding speed lead control value (vV).

5. A closed-loop controller structure according to any one of the preceding claims, in, In order to compensate for the internal AC effect, a first internal AC compensation determination device (40) is provided, which receives a speed lead control value (vV) and determines a compensated speed lead control value (vV*).

6. Closed-loop controller structure according to one of the preceding claims, in, In order to compensate for the internal AC effect, a second internal AC compensation determination device (41) is provided, which determines a compensated first force pilot control value (F1V*).

7. The closed-loop controller structure according to claim 5 or 6, in, There is a fourth adaptation block (41) for adapting the compensated speed pilot control value (vV*) to the transmission ratio (i), and / or there is a fifth adaptation block (44) for adapting the compensated first force pilot control value (F1V*) to the transmission ratio (i).

8. A closed-loop controller structure according to any one of the preceding claims, in, The second speed closed-loop controller (9) is implemented as a proportional controller.

9. An open-loop control device for a first drive and a second drive (2, 3), wherein: The first drive (1) acts on the machine element (1) via a transmission (3) and the second drive (2) acts directly on the machine element (4), The open-loop control device comprises an upper open-loop controller (6) and a closed-loop controller structure (7). The upper open-loop controller (6) uses a closed-loop control clock pulse to preset a position setting value (x*) for the closed-loop controller structure (7). It is characterized in that The closed-loop controller structure (7) is implemented as a closed-loop controller structure (7) according to any of the preceding claims.

10. A machine having a machine element (4), a first drive (1), a second drive (2) and a transmission (3), in, The first drive (1) acts on the machine element (4) via the transmission (3) and the second drive (2) acts directly on the machine element (4), Wherein, the first driver (1) and the second driver (2) are controlled by an open-loop control device (24) according to claim 9.

11. The machine according to claim 10, in, The machine is embodied as a machine tool, a production machine or a robot.

12. A machine according to claim 10 or 11, in, The second drive (2) is not equipped with or connected to a cooling unit for active cooling.

13. A method for closed-loop control of a drive unit having a first drive (1) and a second drive (2), wherein: The first drive (1) acts on the machine element (4) via a transmission (3) and the second drive (2) acts directly on the machine element (4) to move the machine element (4) relative to the shaft, wherein the first drive (1) is closed-loop controlled by means of a first force pilot control value (F1V) and the second drive is closed-loop controlled by means of a second force pilot control value (F2V), It is characterized in that Determine the first axis inertia (J Mot,an ) and determine the second axis inertia (J Mot,ab ), Among them, the first axis inertia (J Mot,an ) and / or the second axis inertia (J Mot,ab ) respectively participate in determining the first force pilot control value (F1V) and the second force pilot control value (F2V) with different, in particular adjustable, weightings.

14. The method according to claim 13, wherein the method is used for closed-loop control of a first drive (1) and a second drive (2), in, The position closed-loop controller (8) receives the difference between the position set value (x*) and the position actual value (x) of the machine element (4) by means of a closed-loop control clock pulse, and controls the first drive (1) according to the corresponding position set value (x*) and the corresponding position actual value (x). The second speed closed-loop controller (9) receives the difference between the obtained speed setting value and the speed actual value (v) of the machine element (4) using the first speed closed-loop control clock pulse, determines the second force setting value (F2*) for the second drive (2) according to the corresponding obtained speed setting value and the corresponding speed actual value (v) of the machine element (4), and controls the second drive (2) according to the corresponding second force setting value (F2*). The first determining device (11) determines the corresponding obtained speed setting value and outputs it to the first speed closed-loop controller (9). wherein the position closed-loop controller (8) determines a speed setpoint (v*) for the machine element (4) by means of a difference between the corresponding position setpoint (x*) and the corresponding position actual value (x), and outputs the corresponding speed setpoint (v*) as an output signal, The first speed closed-loop controller (12) receives the difference between the actual speed value (v1) of the first driver (1) and the obtained speed setting value by using the first speed closed-loop control clock pulse, determines the first force setting value (F1*) for the first driver (1) by using the difference between the corresponding actual speed value (v1) of the first driver (1) and the corresponding obtained speed setting value, and drives the first driver (1) according to the corresponding first force setting value (F1*). wherein the first determining means (11) receives the corresponding speed setting value (v*) and uses the corresponding speed setting value (v*) to determine the obtained speed setting value, The first determining device (11) outputs the corresponding obtained speed setting value to the second speed closed-loop controller (12) in addition to the first speed closed-loop controller (9). wherein a third determining device (30) determines a corresponding first force pilot control value (F1V) for the first drive (1) by means of a corresponding temporary force pilot control value and outputs the corresponding first force pilot control value (F1V) to a first adding device (19), which adds the corresponding first force pilot control value (F1V) to the corresponding first force setpoint value (F1*), so that the first drive (1) is driven according to the sum of the corresponding first force pilot control value (F1V) and the corresponding first force setpoint value (F1*), Wherein, by means of the first axis inertia (J Mot,an ), the second axis inertia (J Mot,ab ) and a first scaling factor (α) to determine the corresponding first force pilot control value (F1V), and Wherein, by means of the second axis inertia (J Mot,ab ) and a second scaling factor (1-α) are used to determine the corresponding second force pilot control value (F2V).

15. The method according to claim 14, in, The sum of the first scaling factor (α) and the second scaling factor (1-α) is 1.

16. The method according to claim 14 or 15, in, The first determination device (11) also receives the corresponding speed lead control value (vV) and determines the respectively obtained speed setting value as the sum of the corresponding speed setting value (v*) and the corresponding speed lead control value (vV).

17. The method according to any one of claims 13 to 16, in, In order to compensate for the internal AC effect, a first internal AC compensation determination device (40) is provided, which receives a speed lead control value (vV) and determines a compensated speed lead control value (vV*).

18. The method according to any one of claims 13 to 17, in, In order to compensate for the internal AC effect, a second internal AC compensation determination device (41) is provided, which determines a compensated first force pilot control value (F1V*).

19. The method according to claim 17 or 18, in, There is a fourth adaptation block (41) for adapting the compensated speed pilot control value (vV*) to the transmission ratio (i), and / or there is a fifth adaptation block (44) for adapting the compensated first force pilot control value (F1V*) to the transmission ratio (i).