[go: up one dir, main page]

CN113196185B - Position adjustment control to compensate for spring-dependent position errors - Google Patents

Position adjustment control to compensate for spring-dependent position errors Download PDF

Info

Publication number
CN113196185B
CN113196185B CN201980083904.6A CN201980083904A CN113196185B CN 113196185 B CN113196185 B CN 113196185B CN 201980083904 A CN201980083904 A CN 201980083904A CN 113196185 B CN113196185 B CN 113196185B
Authority
CN
China
Prior art keywords
target value
control device
value
ideal
sequence
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201980083904.6A
Other languages
Chinese (zh)
Other versions
CN113196185A (en
Inventor
安德烈亚斯·克洛策克
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Siemens Corp
Original Assignee
Siemens Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Siemens Corp filed Critical Siemens Corp
Publication of CN113196185A publication Critical patent/CN113196185A/en
Application granted granted Critical
Publication of CN113196185B publication Critical patent/CN113196185B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/18Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
    • G05B19/404Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by control arrangements for compensation, e.g. for backlash, overshoot, tool offset, tool wear, temperature, machine construction errors, load, inertia
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/18Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
    • G05B19/19Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D3/00Control of position or direction
    • G05D3/12Control of position or direction using feedback
    • G05D3/20Control of position or direction using feedback using a digital comparing device
    • HELECTRICITY
    • H02GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02PCONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
    • H02P23/00Arrangements or methods for the control of AC motors characterised by a control method other than vector control
    • H02P23/18Controlling the angular speed together with angular position or phase
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/41Servomotor, servo controller till figures
    • G05B2219/41443Position reference ffw for compensation of position

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Power Engineering (AREA)
  • Numerical Control (AREA)
  • Control Of Position Or Direction (AREA)

Abstract

A control command (C) for a control device (4) of the machine is provided, the control command (C) determining a sequence of ideal position target values (x) for a position adjustment shaft (1) of the machine. The sequence has successive segments in turn. Within a segment, the ideal position target value (x) monotonically increases or monotonically decreases. The monotonic direction is shifted from segment to segment. The control device (4) implements the position controller (13) and delivers the resulting position target value (x+δx) and the position actual value (x) to the position controller (13) in accordance with the sequence of the ideal position target value (x). The position controller (13) generates an actuation signal (v) for the actuator (12) of the shaft (1) and adjusts the position (x) of the respective shaft (1) accordingly. The resulting position target value (x+δx) corresponds to the sum of the ideal position target value (x) and the additional target value (δx). In the segment, if the ideal position target value (x) monotonically increases, the additional target value (δx) is a positive number. If the ideal position target value (x) monotonically decreases, the additional target value (δx) is negative. The additional target value (δx) comprises a first component (δx1), the first component (δx1) being related only to the position difference. The position difference is the corresponding ideal position target value (x) and the first ideal position target value (x) of the corresponding section or the difference between the corresponding ideal position target value (x) and the corresponding position actual value (x). The absolute value of the first component (δx1) of the additional target value (δx) increases strictly monotonically with increasing absolute value of the position difference and at least monotonically thereafter.

Description

补偿弹性相关的位置误差的位置调节控制Position control to compensate for elasticity-related position errors

技术领域Technical Field

本发明涉及一种用于机器的控制方法,该机器至少具有一个位置调节轴,The invention relates to a control method for a machine having at least one position-controlled axis.

-其中,机器的控制装置预设控制命令的序列,控制命令的序列对于至少一个位置调节轴确定理想位置目标值的序列。In this case, a control device of the machine predetermines a sequence of control commands which determines a sequence of ideal position target values for at least one position-controlled axis.

-其中,理想位置目标值的序列具有多个依次连续的部段,- wherein the sequence of ideal position target values has a plurality of successively consecutive sections,

-其中,在理想位置目标值的序列的相应的部段内,理想位置目标值单调上升或者单调下降,wherein, within a corresponding section of the sequence of ideal position target values, the ideal position target value increases monotonically or decreases monotonically,

-其中,从理想位置目标值的序列的部段到另一部段,直接依次连续的理想位置目标值的差值变换差值的正负号,- wherein the differences of the directly consecutive ideal position target values change their sign from one section to another of the sequence of ideal position target values,

-其中,控制装置对于至少一个位置调节轴实施位置调节器,- wherein the control device implements a position controller for at least one position-regulating axis,

-其中,控制装置根据理想位置目标值的序列将结果位置目标值和相应的实际位置值的序列输送至位置调节器,- wherein the control device supplies a sequence of resulting position target values and corresponding actual position values to the position controller based on the sequence of ideal position target values,

-其中,根据输送至位置调节器的相应的结果位置目标值和输送至位置调节器的相应的实际位置值,位置调节器得出用于至少一个轴的执行器的相应的第一致动信号并且由此根据相应的结果位置目标值直接或间接地调节至少一个轴的位置,- wherein, as a function of the respective resulting position target value supplied to the position controller and the respective actual position value supplied to the position controller, the position controller derives a respective first actuation signal for an actuator of the at least one axis and thereby directly or indirectly regulates the position of the at least one axis as a function of the respective resulting position target value,

-其中,通过在相应的理想位置目标值上添加相应的附加目标值来得出相应的结果位置目标值,- wherein the corresponding result position target value is obtained by adding the corresponding additional target value to the corresponding ideal position target value,

-其中,在理想位置目标值的序列的部段内,如果理想位置目标值单调上升,相应的附加目标值为正数,并且如果理想位置目标值单调下降,相应的附加附加值为负数。- wherein, within a section of the sequence of ideal position target values, if the ideal position target value increases monotonically, the corresponding additional target value is a positive number, and if the ideal position target value decreases monotonically, the corresponding additional target value is a negative number.

此外,本发明涉及一种用于机器的控制装置的控制程序,该控制装置具有至少一个位置调节轴,其中,控制程序包括机器编码,该机器编码由控制装置直接处理,其中,通过控制装置引起机器编码的处理,使得控制装置根据这种控制方法控制至少一个位置调节轴。Furthermore, the invention relates to a control program for a control device of a machine, the control device having at least one position-adjusting axis, wherein the control program comprises a machine code which is processed directly by the control device, wherein the processing of the machine code is caused by the control device such that the control device controls the at least one position-adjusting axis according to such a control method.

此外,本发明涉及一种机器的控制装置,该控制装置具有至少一个位置调节轴,其中,控制装置利用这种控制程序被编程为,其中,控制装置在运行中根据这种控制方法控制至少一个位置调节轴。The invention further relates to a control device for a machine having at least one position-controlled axis, wherein the control device is programmed with such a control program, wherein during operation the control device controls the at least one position-controlled axis according to such a control method.

此外,本发明涉及一种机器,其中,机器具有至少一个位置调节轴,其中,机器具有这种控制装置,使得控制装置在运行中根据这种控制方法控制至少一个机器的位置调节轴。Furthermore, the invention relates to a machine, wherein the machine has at least one position-controlled axis, wherein the machine has such a control device, so that during operation the control device controls at least one position-controlled axis of the machine according to such a control method.

背景技术Background technique

在轴的位置调节中,在所有情况中都出现通过摩擦引起的力。为了引起实际的行进运动,必须克服摩擦力。此外,任何机械结构(以及任何机床、机器人或者其他的生产机器的轴)都不具有无限大的刚性。因此会出现(即使比较小)的弹性形变。In all cases, forces occur in the position adjustment of axes, which are caused by friction. In order to produce the actual travel movement, the friction forces must be overcome. Furthermore, no mechanical structure (nor any axis of a machine tool, robot or other production machine) has infinite rigidity. Therefore, (even if relatively small) elastic deformations occur.

一种,该位置传感器检测借助于轴运动的物体的位置(例如TCP=Tool CenterPoint),该位置传感器准确检测的不是物体的位置而是执行器的位置,即借助于轴运动的物体的驱动器。如果位置传感器表示的位置精确对应于预设的目标位置,借助于轴运动的物体的实际位置由于弹性形变而偏离目标位置。在技术领域中,该效果通常被称为“丢失的运动”或缺失的运动。One, the position sensor detects the position of an object moving by means of an axis (e.g. TCP = Tool Center Point), which accurately detects not the position of the object but the position of the actuator, i.e. the drive of the object moving by means of the axis. If the position indicated by the position sensor corresponds exactly to the preset target position, the actual position of the object moving by means of the axis deviates from the target position due to elastic deformation. In the technical field, this effect is usually referred to as "lost motion" or missing motion.

然而,为了能够检测物体实际的位置,在一些情况中使用另外的测量系统,该测量系统尽可能地靠近运动的物体(例如提及的TCP)处布置。然而在许多情况下,在运动的物体附近的这种测量系统的布置不可行或者不能被执行。在这种情况中,必须承受所谓的丢失的运动。However, in order to be able to detect the actual position of the object, in some cases another measuring system is used, which is arranged as close as possible to the moving object (such as the mentioned TCP). However, in many cases, the arrangement of such a measuring system near the moving object is not feasible or cannot be performed. In this case, the so-called lost motion must be accepted.

在现有技术中,也已经考虑不同种类的补偿。特别地,在包括传动机构的轴上已知,在运动方向变化时出现的齿轮啮合间隙通过附加目标值来补偿,该附加目标值加在位置目标值上(或者以相反的符号加在位置实际值上)。在这种方法中,附加的目标值在理想位置目标值序列的相应的部段内具有恒定值。然而这些方法常常导致比它所解决的问题还要更多的问题。In the prior art, different types of compensation have also been considered. In particular, it is known that on shafts that include transmissions, the gear meshing backlash that occurs when the direction of movement changes is compensated by an additional target value that is added to the position target value (or to the position actual value with an opposite sign). In this method, the additional target value has a constant value within the corresponding section of the ideal position target value sequence. However, these methods often lead to more problems than they solve.

从EP 3 208 669 A1已知一种用于机器的控制方法,该机器具有至少一个位置调节轴。该轴是一个圆轴,使得位置为旋转位置。机器的控制装置预设控制命令的序列,该序列确定了用于至少一个位置调节轴的理想位置目标值的序列。控制装置实施了用于至少一个位置调节轴的位置调节器并且根据理想位置目标值的序列,控制装置将结果位置目标值的序列和相应的位置实际值输送至位置调节器。相应的结果位置目标值通过将修改值添加至相应的理想位置目标值来得出。修改值与位置调节轴的旋转位置和转速有关。A control method for a machine having at least one position regulating axis is known from EP 3 208 669 A1. The axis is a round axis, so that the position is a rotational position. A control device of the machine predetermines a sequence of control commands, which sequence determines a sequence of ideal position target values for at least one position regulating axis. The control device implements a position regulator for at least one position regulating axis and, depending on the sequence of ideal position target values, the control device delivers a sequence of resultant position target values and corresponding position actual values to the position regulator. The corresponding resultant position target value is obtained by adding a modification value to the corresponding ideal position target value. The modification value is related to the rotational position and the rotational speed of the position regulating axis.

发明内容Summary of the invention

本发明的目的在于,实现一种可行性,借助于该可行性不仅在包括传动机构的轴上、而且普遍地在轴上实现丢失的运动的良好的补偿。The object of the present invention is to provide a possibility by means of which a good compensation of lost movements can be achieved not only on shafts that include a gear mechanism, but on shafts in general.

本目的通过具有本发明的特征的控制方法实现。根据本发明的控制方法的有利的设计方案是各个实施例的内容。This object is achieved by a control method having the features of the present invention. Advantageous embodiments of the control method according to the present invention are the subject matter of the various exemplary embodiments.

根据本发明,开头所述种类的控制方法由此设计:According to the invention, a control method of the type mentioned at the outset is designed as follows:

-附加目标值包括第一分量,该第一分量仅仅与位置差值有关,the additional target value comprises a first component which is only related to the position difference,

-位置差值是相应的理想位置目标值与相应的部段的第一理想位置目标值的差值或者是相应的理想位置目标值与相应的位置实际值的差值并且The position difference value is the difference between the corresponding ideal position target value and the first ideal position target value of the corresponding segment or the difference between the corresponding ideal position target value and the corresponding position actual value and

-随着位置差值绝对值的增加,附加目标值的第一分量的绝对值在开始严格单调上升并且之后至少是单调的上升。With increasing absolute values of the position difference values, the absolute value of the first component of the additional target value rises strictly monotonically at the beginning and at least monotonically thereafter.

通过附加目标值的接合,因此至少一个位置调节轴能够明显运动超出它的实际目标位置。然而,由于轴的滞后,也就是说,在布置在执行器上的位置传感器的输出信号的后面,在适当的选择附加目标值的情况下,准确地接近所期望的位置。然而,通过在相应的理想位置目标值上,相应的附加目标值的温和的、逐渐的接合来防止突然的目标值跳跃。因此引起的轴的运动变得温和且柔和。By engaging the additional target value, at least one position-controlled axis can thus be moved significantly beyond its actual target position. However, due to the hysteresis of the axis, that is, behind the output signal of the position sensor arranged on the actuator, the desired position is accurately approached with a suitable choice of the additional target value. However, sudden target value jumps are prevented by the gentle, gradual engagement of the respective additional target value with the respective ideal position target value. The resulting movement of the axis becomes gentle and soft.

优选地,只要位置差值的绝对值达到了界限,第一分量的绝对值假定为预设的最大值并且随后在理想位置目标值的序列的相应的部段内保持恒定。由此,尤其能够以近乎理想的方式补偿滞后误差。Preferably, as soon as the absolute value of the position difference reaches a limit, the absolute value of the first component assumes a predefined maximum value and then remains constant within the corresponding section of the sequence of ideal position target values. In this way, hysteresis errors can be compensated in a nearly ideal manner.

优选地,第一分量在理想位置目标值的序列的相应的部段的开头具有值为零。通过这种方法,尤其实现了对于滞后误差的补偿的连续的过渡。Preferably, the first component has the value zero at the beginning of the respective segment of the sequence of ideal position target values. In particular, a continuous transition for the compensation of the hysteresis error is achieved by this method.

此外,有利的是,如果附加目标值包括第二分量,第二分量与至少一个轴的行进速度有关。特别地,第二分量能够与至少一个轴的行进速度成比例。这个方式基于的事实为,摩擦力经常具有与速度相关的分量。因此,除了力相关的丢失的运动还存在速度相关的丢失的运动。通过第二分量,能够以近似理想的方式补偿丢失的运动的速度相关的分量。第二分量的设置原则上能够替代第一分量的设置。但是,通常第二分量附加于第一分量而存在。Furthermore, it is advantageous if the additional target value comprises a second component, which is related to the travel speed of the at least one axis. In particular, the second component can be proportional to the travel speed of the at least one axis. This approach is based on the fact that friction forces often have a speed-dependent component. Therefore, in addition to force-dependent lost movements, there are also speed-dependent lost movements. By means of the second component, the speed-dependent component of the lost movement can be compensated in an approximately ideal manner. The provision of the second component can in principle replace the provision of the first component. However, the second component is usually present in addition to the first component.

控制装置通常实施附属于位置调节器的速度调节器。在这种情况下,位置调节器并不直接将相应的第一致动信号输送至执行器。确切说,位置调节器将具有结果速度目标值且此外具有相应的速度实际值的相应的第一致动信号输送至速度调节器,其中,相应的结果速度目标值与相应的第一致动信号有关。在这种情况下,速度调节器根据相应的结果速度目标值和相应的速度实际值得出用于至少一个轴的执行器的相应的第二致动信号,并且由此,根据相应的结果速度目标值直接或者间接调节至少一个轴的速度。The control device usually implements a speed regulator attached to the position regulator. In this case, the position regulator does not directly supply the respective first actuation signal to the actuator. Rather, the position regulator supplies the respective first actuation signal with the resulting speed target value and also with the respective speed actual value to the speed regulator, wherein the respective resulting speed target value is dependent on the respective first actuation signal. In this case, the speed regulator determines the respective second actuation signal for the actuator of the at least one axis as a function of the respective resulting speed target value and the respective speed actual value and thereby directly or indirectly regulates the speed of the at least one axis as a function of the respective resulting speed target value.

在最简单的情况下,结果速度目标值与相应的第一致动信号相同。然而通常这会导致更好的控制行为,如果控制装置根据结果位置目标值的序列,在不考虑相应的位置实际值时,控制装置得出相应的第一预控制信号并且通过在相应的理想速度目标值上添加第一预控制信号来得出相应的结果速度目标值。In the simplest case, the resulting speed target value is identical to the corresponding first actuation signal. However, this generally leads to a better control behavior if the control device derives the corresponding first precontrol signal from the sequence of resulting position target values without taking into account the corresponding actual position value and derives the corresponding resulting speed target value by adding the first precontrol signal to the corresponding ideal speed target value.

通常,如果控制装置根据结果位置目标值的序列,在不考虑相应的位置实际值的情况下得出相应的第二预控制信号,并且速度调节器不直接将相应的第二致动信号输送至执行器,而是控制装置通过将相应的第二预控制信号添加在相应的第二致动信号上来得出用于执行器的相应的第三致动信号,则导致了更好的控制行为。在这种情况下,根据相应的第三致动信号或者根据从相应的第三致动信号中导出的相应的第四致动信号来驱控执行器。Generally, a better control behavior results if the control device derives a corresponding second precontrol signal from the sequence of resulting position target values without taking into account the corresponding position actual value, and the speed regulator does not directly supply the corresponding second actuation signal to the actuator, but the control device derives a corresponding third actuation signal for the actuator by adding the corresponding second precontrol signal to the corresponding second actuation signal. In this case, the actuator is actuated according to the corresponding third actuation signal or according to a corresponding fourth actuation signal derived from the corresponding third actuation signal.

如果控制装置根据附加目标值的序列在不考虑其他变化的数值的情况下得出相应的第三预控制信号并且通过将相应的第三预控制信号添加在相应的第三致动信号上来得出用于执行器的相应的第四致动信号,则导致了特别良好的结果。在这种情况下,利用相应的第四致动信号来驱控执行器。Particularly good results result if the control device derives a respective third pilot control signal from the sequence of additional target values without taking into account other changing values and derives a respective fourth actuation signal for the actuator by adding the respective third pilot control signal to the respective third actuation signal. In this case, the actuator is actuated with the respective fourth actuation signal.

如果相应的第一预控制信号不添加在相应的第一致动信号上和/或第二预控制信号不添加在相应的第二致动信号上,添加相应的第三预控制信号也是可行的。在这种情况下,控制装置通过将相应的第三预控制信号添加在相应的第二致动信号上来得出用于执行器的相应的结果致动信号,利用该结果致动信号来驱控执行器。If the corresponding first pilot control signal is not added to the corresponding first actuation signal and/or the second pilot control signal is not added to the corresponding second actuation signal, it is also possible to add the corresponding third pilot control signal. In this case, the control device derives the corresponding result actuation signal for the actuator by adding the corresponding third pilot control signal to the corresponding second actuation signal, and uses the result actuation signal to control the actuator.

此外,目的通过具有本发明的特征的控制程序来实现。根据本发明,开头所述种类的控制程序被设计为,通过控制装置引起机器编码的处理,控制装置根据本发明的控制方法来控制至少一个位置调节轴。The object is further achieved by a control program having the features of the invention. According to the invention, a control program of the type mentioned at the outset is designed to cause processing of a machine code by a control device which controls at least one position-controlled axis according to the control method of the invention.

此外,目的通过具有本发明的特征的控制装置来实现。根据本发明,开头所述种类的控制装置利用根据本发明的控制程序被编程为,使得控制装置在运行中根据本发明的控制方法来控制至少一个位置调节轴。The object is further achieved by a control device having the features of the invention. According to the invention, a control device of the type mentioned at the outset is programmed with a control program according to the invention such that during operation the control device controls at least one position-controlled axis according to the control method according to the invention.

此外,目的通过具有本发明的特征的机器来实现。根据本发明,机器的控制装置根据本发明被设计成,使得控制装置在运行时根据本发明的控制方法来控制至少一个位置调节轴。Furthermore, the object is achieved by a machine having the features of the invention. According to the invention, the control device of the machine is designed according to the invention such that during operation the control device controls at least one position-controlled axis according to the control method according to the invention.

附图说明BRIEF DESCRIPTION OF THE DRAWINGS

下面根据结合附图对实施例的描绘,更加详细地解释本发明的上述特性、特征和优点以及这些如何实现他们的方式和方法。在此,在示意图中示出:The above-mentioned characteristics, features and advantages of the present invention and the ways and methods of how to achieve them are explained in more detail below based on the description of the embodiments in conjunction with the accompanying drawings. Here, it is shown in a schematic diagram:

图1示出了具有多个位置调节轴的机器,FIG1 shows a machine with multiple position-adjustable axes.

图2示出了理想位置目标值的序列,Figure 2 shows the sequence of ideal position target values,

图3示出了单个位置调节轴的位置调节,Figure 3 shows the position adjustment of a single position adjustment axis.

图4示出了附加目标值的第一分量的函数分布,FIG4 shows the functional distribution of the first component of the additional target value,

图5示出了对于正数和负数位置差异的图4的函数分布,FIG5 shows the functional distribution of FIG4 for positive and negative position differences,

图6示出了附加目标值的第二分量的函数分布并且FIG6 shows the functional distribution of the second component of the additional target value and

图7到图9示出了图3的位置调节的修改。7 to 9 show modifications of the position adjustment of FIG. 3 .

具体实施方式Detailed ways

根据图1,机器具有多个位置调节轴1。根据在图1中的示意图,机器能够例如为机床,使得借助于位置调节轴1,机床的刀具2相对于待处理的工件3平移定位和/或旋转定向。然而,机器替代地还能够为其他机器,例如是有可弯曲手臂的机器人或者处理机或者其他生产机器。至关重要的是,该机器(在数字意义上)具有至少一个位置调节轴1。According to FIG. 1 , the machine has a plurality of position-adjustable axes 1. According to the schematic diagram in FIG. 1 , the machine can be, for example, a machine tool, so that by means of the position-adjustable axes 1, a tool 2 of the machine tool is translationally positioned and/or rotationally oriented relative to a workpiece 3 to be processed. However, the machine can alternatively also be another machine, for example a robot with a flexible arm or a processing machine or other production machine. It is essential that the machine (in the numerical sense) has at least one position-adjustable axis 1.

机器具有控制装置4,控制装置4控制机器。控制装置4为数字化控制器(CNC)或者运动控制器。运动控制器从它的功能上来看与数字化控制器十分类似。基本上区别仅在应用中,即数字化控制器用于控制机床,运动控制器用于控制机器人或者其他机器。然而在两种情况(即数字化控制器和运动控制器)中实现了至少一个位置调节轴1、通常多个位置调节轴1的位置调节控制。The machine has a control device 4, which controls the machine. The control device 4 is a digital controller (CNC) or a motion controller. The motion controller is very similar to the digital controller in terms of its function. Basically, the difference is only in the application, that is, the digital controller is used to control machine tools, and the motion controller is used to control robots or other machines. However, in both cases (digital controller and motion controller), the position control of at least one position control axis 1, usually a plurality of position control axes 1, is realized.

控制装置4为软件可编程的。因此,控制装置4利用控制程序5被编程为。控制程序5对应于用于控制装置4的系统程序。控制程序5包括机器编码6。机器编码6能够由控制装置4直接处理。通过控制装置4引起机器编码6的处理,使得控制装置4根据控制方法控制至少一个位置调节轴1,该控制方法会在之后被详细阐述。The control device 4 is software programmable. Therefore, the control device 4 is programmed with a control program 5. The control program 5 corresponds to a system program for the control device 4. The control program 5 includes a machine code 6. The machine code 6 can be processed directly by the control device 4. The processing of the machine code 6 is caused by the control device 4 so that the control device 4 controls at least one position-controlled axis 1 according to a control method, which will be explained in detail later.

为了良好的秩序,应该提到的是,根据之后阐述的控制方法,控制装置4根据需要还能够根据下文解释的控制方法来控制机器的所有位置调节轴1或者至少多个位置调节轴1。至关重要的是,这在至少一个位置调节轴1中实现。因此,随后,还仅阐述了用于位置调节轴1之一的控制方法。因此,随后还始终仅谈论“位置调节轴1”。如果实施用于多个或者所有位置调节轴1的控制方法,通常对于所有这种轴1都以同种方法实施。然而这也不是强制性必需的。可行的是,对于各个位置调节轴实施本发明的不同的设计方案。For the sake of good order, it should be mentioned that according to the control method explained later, the control device 4 can also control all position adjustment axes 1 of the machine or at least a plurality of position adjustment axes 1 according to the control method explained below as needed. It is essential that this is implemented in at least one position adjustment axis 1. Therefore, only the control method for one of the position adjustment axes 1 is explained later. Therefore, only "position adjustment axis 1" is always discussed later. If a control method for a plurality of or all position adjustment axes 1 is implemented, it is usually implemented in the same way for all such axes 1. However, this is not mandatory. It is possible to implement different designs of the present invention for each position adjustment axis.

控制装置4被预设控制命令C的序列。控制命令C确定用于位置调节轴1的理想位置目标值x*的序列。例如,能够借助于子程序7预设控制装置4的控制命令C,子程序7限定了用于机器的多个轴1的相应的位置目标值x*的彼此协调的序列,使得协调的序列限定了刀具2相对于工件3行进的路径并且因此对于轴1分别限定对于相应的轴1彼此紧紧连续的位置目标值x*的序列。The control device 4 is preset with a sequence of control commands C. The control commands C determine a sequence of ideal position target values x* for the position-controlled axis 1. For example, the control commands C of the control device 4 can be preset with the aid of a subroutine 7 which defines a sequence of corresponding position target values x* for a plurality of axes 1 of the machine that is coordinated with one another, so that the coordinated sequence defines the path traveled by the tool 2 relative to the workpiece 3 and thus defines for each axis 1 a sequence of position target values x* that are closely successive with one another for the respective axis 1.

理想位置目标值x*作为以小的、通常恒定的时间间距δt的时间t的函数彼此跟随。理想位置目标值x*的序列根据图2中的示意图具有多个依次连续的部段。部段的边界在图2中通过垂直的虚线示出。显而易见地,在相应的部段的内部,理想位置目标值x*是单调上升或者单调下降的,大多数甚至是严格单调上升或者严格的单调下降的。在各个部段的内部不会实现位置调节轴1的方向反转。相反地,这种方向反转从部段到部段实现。因此,从部段到部段,直接依次连续的理想位置目标值x*之间的差值变换其符号。因此,如果(纯示例性地)在确定的部段中每个位置目标值x*都大于(或者至少不小于)紧接着的前面的位置目标值x*,那么在紧接着的后面的部段中每个位置目标值x*都小于(或者至少不大于)紧接着的前面的位置目标值x*。相反地,理想位置目标值x*(如在图2中所示)是否为正数或者负数或者部分正数和部分负数,在本发明的范畴内并不重要。The ideal position target value x* follows each other as a function of time t with a small, usually constant time interval δt. The sequence of the ideal position target value x* has a plurality of consecutive sections according to the schematic diagram in FIG. 2. The boundary of the section is shown by a vertical dotted line in FIG. 2. Obviously, inside the corresponding section, the ideal position target value x* is monotonically rising or monotonically falling, and most of them are even strictly monotonically rising or strictly monotonically falling. The direction reversal of the position control shaft 1 will not be achieved inside each section. On the contrary, this direction reversal is achieved from section to section. Therefore, from section to section, the difference between the ideal position target values x* that are directly consecutive in sequence changes its sign. Therefore, if (purely exemplary) each position target value x* in a certain section is greater than (or at least not less than) the immediately preceding position target value x*, then each position target value x* in the immediately following section is less than (or at least not greater than) the immediately preceding position target value x*. On the other hand, it is not important within the scope of the present invention whether the ideal position target value x* (as shown in FIG. 2 ) is positive or negative or partly positive and partly negative.

控制装置4根据机器编码6的处理(通常在软件中)实施位置调节。下面结合图3对于处理单个理想位置目标值x*详细阐述位置调节的结构和功能。然而,应该再次指出,阐述的步骤分别以时间间距δt以相应的下一个理想位置目标值x*来重复进行。The control device 4 implements the position control based on the processing (usually in software) of the machine code 6. The structure and function of the position control are explained in detail below in conjunction with Figure 3 for the processing of a single ideal position target value x*. However, it should be pointed out again that the explained steps are respectively repeated at time intervals δt with the corresponding next ideal position target value x*.

根据图3,控制装置4输送相应的理想位置目标值x*到节点8和确定块9。确定块9得出相应的附加目标值δx*,该附加目标值同样地输送至节点8。确定块9的作用方式之后详细阐明。在节点8中,相应的附加目标值δx*加在相应的理想位置目标值x*上。由此,得出相应的结果位置目标值x*+δx*。According to FIG. 3 , the control device 4 delivers the corresponding ideal position target value x* to the node 8 and the determination block 9. The determination block 9 determines the corresponding additional target value δx*, which is also delivered to the node 8. The function of the determination block 9 will be explained in detail later. In the node 8, the corresponding additional target value δx* is added to the corresponding ideal position target value x*. As a result, the corresponding resulting position target value x*+δx* is obtained.

控制装置4将相应的结果位置目标值x*+δx*输送至另一个节点10。此外,控制装置4将相应的位置实际值x输送至另一个节点10。能够例如借助于传统的位置传感器11来检测相应的位置实际值x,该位置传感器检测执行器12的位置,借助于执行器来调整位置调节轴1。The control device 4 delivers the corresponding resulting position target value x*+δx* to a further node 10. In addition, the control device 4 delivers the corresponding position actual value x to a further node 10. The corresponding position actual value x can be detected, for example, by means of a conventional position sensor 11, which detects the position of an actuator 12, by means of which the position control shaft 1 is adjusted.

在节点10中得出相应的结果位置目标值x*+δx*和相应的位置实际值x的差值。相应的差值(在专业领域中大多数被称为调节差值)会被输送到位置调节器13。位置调节器13能够例如根据图3中的示意图被设计为P调节器。然而位置调节器还能够被设计成其他,例如作为PI调节器。位置调节器13根据输送至它的相应的调节差值得出用于执行器12的相应的第一致动信号v*。由此,执行器根据相应的结果位置目标值x*+δx*调节位置调节轴1的位置x。The difference between the corresponding result position target value x*+δx* and the corresponding position actual value x is obtained in the node 10. The corresponding difference (mostly referred to as the adjustment difference in the professional field) will be sent to the position regulator 13. The position regulator 13 can be designed as a P regulator, for example, according to the schematic diagram in Figure 3. However, the position regulator can also be designed as something else, for example, as a PI regulator. The position regulator 13 derives the corresponding first actuation signal v* for the actuator 12 according to the corresponding adjustment difference sent to it. As a result, the actuator adjusts the position x of the position control shaft 1 according to the corresponding result position target value x*+δx*.

可行的是,第一致动信号v*直接作用在执行器12上。然而,通常控制装置4根据图3中的示意图实施速度调节器14,速度调节器从属于位置调节器13。在这种情况下,位置调节器13间接地调节位置调节轴1的位置。此外,在这种情况下,相应的第一致动信号v*为相应的理想速度目标值v*。速度调节器14能够例如构造为P调节器或者PI调节器。其他设计方案也是可行的。It is feasible that the first actuation signal v* acts directly on the actuator 12. However, the control device 4 usually implements a speed regulator 14 according to the schematic diagram in Figure 3, and the speed regulator is subordinate to the position regulator 13. In this case, the position regulator 13 indirectly adjusts the position of the position control shaft 1. In addition, in this case, the corresponding first actuation signal v* is the corresponding ideal speed target value v*. The speed regulator 14 can be constructed as a P regulator or a PI regulator, for example. Other designs are also feasible.

在间接调节的情况中,位置调节器13不将相应的第一致动信号v*直接输送至执行器12。确切说,位置调节器13将相应的第一致动信号v*首先输送至另外的节点15。此外,控制装置4输送至另外的节点15相应的速度实际值v。由此,控制装置4能够例如得出相应的速度实际值v,控制装置在微分器16中执行位置实际值x的微分(即得出位置实际值x的时间导数)。然而也给出了其他可行性,例如直接检测速度实际值v。在另外的节点15中,控制装置4形成了相应理想速度目标值v*和相应速度实际值v的差值。这样形成的差值被输送至速度调节器14。In the case of indirect regulation, the position regulator 13 does not directly transmit the corresponding first actuation signal v* to the actuator 12. More precisely, the position regulator 13 first transmits the corresponding first actuation signal v* to the further node 15. In addition, the control device 4 transmits the corresponding actual speed value v to the further node 15. As a result, the control device 4 can, for example, derive the corresponding actual speed value v, the control device performing differentiation of the actual position value x in the differentiator 16 (i.e. deriving the time derivative of the actual position value x). However, other possibilities are also provided, such as directly detecting the actual speed value v. In the further node 15, the control device 4 forms the difference between the corresponding ideal speed target value v* and the corresponding actual speed value v. The difference formed in this way is transmitted to the speed regulator 14.

速度调节器14根据相应的理想速度目标值v*和相应的速度实际值v的差值得出用于执行器12的相应第二致动信号I*。因此,速度调节器14根据相应的速度目标值v*调节轴1的速度v。The speed regulator 14 generates a corresponding second actuation signal I* for the actuator 12 according to the difference between the corresponding ideal speed target value v* and the corresponding speed actual value v. Therefore, the speed regulator 14 regulates the speed v of the shaft 1 according to the corresponding speed target value v*.

类似于位置调节器13的作用方式,速度调节器14能够直接或者间接地作用在执行器12上。例如,根据图3中的示意图可行的是,根据相应的第二致动信号I*直接实现执行器12的驱控,例如在电机的情况中实现变频器的驱控。在间接作用的情况中,例如可行的是,另外的调节器、特别是电流调节器附属于速度调节器14。然而,这在图3中未示出。The speed regulator 14 can act directly or indirectly on the actuator 12 in a similar manner to the position regulator 13. For example, according to the schematic diagram in FIG. 3 , it is possible to directly control the actuator 12 according to the corresponding second actuation signal I*, for example, to control the frequency converter in the case of an electric motor. In the case of indirect action, it is possible, for example, that another regulator, in particular a current regulator, is attached to the speed regulator 14. However, this is not shown in FIG. 3 .

根据图3中的示意图,相应的附加目标值δx*尤其包括至少一个第一分量δx1*。第一分量δx1*仅仅与位置差值有关。位置差值为相应的理想位置目标值x*与理想位置目标值x*的序列的相应的部段的第一理想位置目标值x*的差值。图4示出了这种关系。将位置差值的绝对值绘制在横坐标上,即为从方法的开始以当前的行进方向或者(等效于)从最近的已经实现的方向反转开始所走过的路径。将第一附加目标值δx1*的附属的绝对值绘制在坐标轴上。根据在图4中的示意图,随着位置差值的绝对值的增加,第一分量δx1*的绝对值单调上升。在第一区域中,即直至位置差值的绝对值达到预定的上极限时,随着位置差值的绝对值的增加,第一分量δx1*的绝对值严格单调上升。上极限自身具有比0要更大的值。According to the schematic diagram in FIG3 , the corresponding additional target value δx* in particular includes at least one first component δx1*. The first component δx1* is only related to the position difference. The position difference is the difference between the corresponding ideal position target value x* and the first ideal position target value x* of the corresponding section of the sequence of ideal position target values x*. FIG4 shows this relationship. The absolute value of the position difference is plotted on the abscissa, i.e., the path taken from the beginning of the method with the current direction of travel or (equivalently) from the most recent direction reversal that has been achieved. The attached absolute value of the first additional target value δx1* is plotted on the coordinate axis. According to the schematic diagram in FIG4 , as the absolute value of the position difference increases, the absolute value of the first component δx1* increases monotonically. In the first region, i.e., until the absolute value of the position difference reaches a predetermined upper limit, as the absolute value of the position difference increases, the absolute value of the first component δx1* increases strictly monotonically. The upper limit itself has a value greater than 0.

通常,第一分量δx1*的绝对值从较低的上极限起为恒定的。替代地,第一分量δx1*的绝对值能够从较低的上极限直至较高的上极限单调上升。在这种情况下,第一分量δx1*的绝对值从达到较高的上极限起为恒定的。Typically, the absolute value of the first component δx1* is constant from the lower upper limit. Alternatively, the absolute value of the first component δx1* can rise monotonically from the lower upper limit to the higher upper limit. In this case, the absolute value of the first component δx1* is constant from the higher upper limit.

在理想位置目标值x*的序列的部段内,第一分量δx1*统一的具有相同的符号。特别地,如果理想位置目标值x*单调上升,第一分量δx1*根据图5中的示意图始终为正数。相反地,如果理想位置目标值x*单调下降,相应的附加目标值x*根据图5中的示意图始终为负数。因此,在从理想位置目标值x*的序列的部段到理想位置目标值x*的序列的下一个部段的过渡时,第一分量δx1*变换它的符号。特别地,根据图5中的示意图,在理想位置目标值x*的序列的相应的部段的末尾实现了跳跃到第一分量δx1*上,该第一分量假设在下一个部段的开始处。这在图5中通过两个虚线示出的弯曲箭头表示。Within a segment of the sequence of ideal position target values x*, the first component δx1* uniformly has the same sign. In particular, if the ideal position target value x* increases monotonically, the first component δx1* is always positive according to the schematic diagram in FIG5 . On the contrary, if the ideal position target value x* decreases monotonically, the corresponding additional target value x* is always negative according to the schematic diagram in FIG5 . Therefore, at the transition from a segment of the sequence of ideal position target values x* to the next segment of the sequence of ideal position target values x*, the first component δx1* changes its sign. In particular, according to the schematic diagram in FIG5 , at the end of the corresponding segment of the sequence of ideal position target values x*, a jump to the first component δx1* is achieved, and the first component is assumed to be at the beginning of the next segment. This is represented in FIG5 by two curved arrows shown by dashed lines.

可行的是,第一分量δx1*的绝对值已经在理想位置目标值x*的序列的相应的部段的开头具有确定的、非零的绝对值。然而,优选地,第一分量δx1*在理想位置目标值x*的序列的相应的部段的开头根据图4和图5中的示意图具有值零。此外,根据图4和图5中的示意图,第一分量δx1*的绝对值假定为预定的最大值MAX,只要位置差值的绝对值达到了预定的极限。之后,第一分量δx1*在理想位置目标值的序列的相应的部段内不再继续提高,而是保持恒定。提及的预定的极限对应于(根据设计方案)较低上极限或者较高上极限。It is possible that the absolute value of the first component δx1* already has a certain, non-zero absolute value at the beginning of the corresponding section of the sequence of ideal position target values x*. However, preferably, the first component δx1* has the value zero at the beginning of the corresponding section of the sequence of ideal position target values x* according to the schematic diagrams in Figures 4 and 5. In addition, according to the schematic diagrams in Figures 4 and 5, the absolute value of the first component δx1* assumes a predetermined maximum value MAX as long as the absolute value of the position difference reaches a predetermined limit. After that, the first component δx1* no longer increases further within the corresponding section of the sequence of ideal position target values, but remains constant. The predetermined limit mentioned corresponds to (depending on the design) a lower upper limit or a higher upper limit.

在上述限制之下,不同方法是可行的。能够实现例如线性的、部分线性的或者连续衰减地增加到最大值MAX。得出相应的第一分量δx1*的方式和方法在本质上是次要的。例如,能够通过表格或者通过函数来限定功能变化。能够利用数值填写表格或者能够例如根据运行试验来执行函数的参数化。输入变量在表格中或者在函数中是从最近的方向反转起所编程的理想行进路径。输出变量为相应的第一分量δx1*。Different methods are possible within the above-mentioned restrictions. For example, a linear, partially linear or continuously decaying increase to a maximum value MAX can be achieved. The manner and method of obtaining the corresponding first component δx1* is essentially secondary. For example, the functional variation can be defined by means of a table or by means of a function. The table can be filled in with values or the parameterization of the function can be performed, for example, based on operating tests. The input variable in the table or in the function is the ideal travel path programmed from the most recent direction reversal. The output variable is the corresponding first component δx1*.

可行的是,附加目标值δx*仅包括第一分量δx1*。在这种情况下,立刻且显而易见地得出,随着第一分量δx1*在理想位置目标值x*的序列的部段的内部,如果理想位置目标值x*单调上升,相应的附加目标值δx*也为正数,并且如果理想位置目标值x*单调下降,反之相应的附加目标值为负数。然而优选地,附加目标值δx*包括(通常并且根据图3中的示意图除了第一分量δx1*,在特殊情况中替代地为)第二分量δx2*。第二分量δx2*与至少一个轴1的行进速度有关。特别地,第二分量δx2*能够根据图6中的示意图与至少一个轴1的行进速度成比例。然而在此,根据在图6中的示意图(类似于第一分量δx1*),如果理想位置目标值x*单调上升时,第二分量δx2*始终为正数,并且反之如果理想位置目标值x*单调下降时,第二分量始终为负数。行进速度能够根据是否行进速度能够由理想位置目标值x*或者由位置实际值x推导出或者直接检测到替代地为目标速度或者实际速度。It is possible that the additional target value δx* includes only the first component δx1*. In this case, it is immediately and obviously derived that, with the first component δx1* within the segment of the sequence of the ideal position target value x*, if the ideal position target value x* increases monotonically, the corresponding additional target value δx* is also positive, and if the ideal position target value x* decreases monotonically, the corresponding additional target value is negative. However, preferably, the additional target value δx* includes (usually and according to the schematic diagram in FIG3 in addition to the first component δx1*, in special cases instead of) a second component δx2*. The second component δx2* is related to the travel speed of at least one axis 1. In particular, the second component δx2* can be proportional to the travel speed of at least one axis 1 according to the schematic diagram in FIG6. However, here, according to the schematic diagram in FIG6 (similar to the first component δx1*), if the ideal position target value x* increases monotonically, the second component δx2* is always positive, and if the ideal position target value x* decreases monotonically, the second component is always negative. The travel speed can alternatively be a target speed or an actual speed, depending on whether the travel speed can be derived from the ideal position target value x* or from the position actual value x or can be directly detected.

根据本发明的设计方案能够以不同的方式和方法进行修改。随后,首先阐述两个设计方案,根据图7中的示意图优选地共同实现了这两个设计方案。然而,原则上这两个设计方案能够相互独立地被实现。然后,结合图8阐述了在根据图7的设计方案的基础上构造的另一个设计方案。然而,根据图8的附加的设计方案能够脱离根据图7的优选的设计方案来实现。The design according to the invention can be modified in different ways and methods. Subsequently, two designs are first explained, which are preferably implemented together according to the schematic diagram in FIG. 7. However, in principle, the two designs can be implemented independently of each other. Then, another design constructed on the basis of the design according to FIG. 7 is explained in conjunction with FIG. 8. However, the additional design according to FIG. 8 can be implemented without the preferred design according to FIG. 7.

根据图7中的示意图,控制装置4在另外的确定块17中根据结果位置目标值x*+δx*的序列得出相应的第一预控制信号δv*。控制装置4能够在另外的确定块17中例如执行结果位置目标值x*+δx*的微分,即得出它的时间上的导数。在任何情况中,在不考虑相应的位置实际值x的情况下实现得出第一预控制信号δv*。According to the schematic diagram in FIG7 , the control device 4 derives the corresponding first pre-control signal δv* from the sequence of the resulting position target values x*+δx* in the further determination block 17. The control device 4 can, for example, perform a differentiation of the resulting position target values x*+δx*, i.e. derive its temporal derivative, in the further determination block 17. In any case, the first pre-control signal δv* is derived without taking into account the corresponding position actual value x.

如果控制装置4得出第一预控制信号δv*,控制装置4通过将相应的第一预控制信号δv*添加在相应的理想速度目标值v*上来得出相应的结果速度目标值v*+δv*。在这种情况下,借助于速度调节器14实现了速度调节到结果速度目标值v*+δv*。相应的结果速度目标值v*+δv*虽然不再与相应的理想速度目标值v*相同,然而还一直与相应的理想速度目标值v*有关。特别地,区别仅在于相匹配的相应的第一预控制信号δv*。If the control device 4 determines the first pre-control signal δv*, the control device 4 determines the corresponding result speed target value v*+δv* by adding the corresponding first pre-control signal δv* to the corresponding ideal speed target value v*. In this case, the speed is regulated to the result speed target value v*+δv* by means of the speed regulator 14. The corresponding result speed target value v*+δv* is no longer the same as the corresponding ideal speed target value v*, but it is still related to the corresponding ideal speed target value v*. In particular, the difference lies only in the matching corresponding first pre-control signal δv*.

此外,控制装置4根据图7中的示意图根据结果位置目标值x*+δx*的序列得出相应的第二预控制信号δI1*。控制装置4能够例如在另外的确定块18中得出已经得出的相应的第一预控制信号δv*的再次的微分并且随后通过扩大在乘法器19中得出的中间信号来得出相应的第二预控制信号δI1*。然而,在不事先得出相应的第一预控制信号δv*的情况下,直接得出相应的第二预控制信号δI1*也是可行的。在任何情况中,在不考虑相应的位置实际值x的情况下也实现第二预控制信号δI1*的得出。In addition, the control device 4 derives the corresponding second pre-control signal δI1* according to the sequence of the result position target values x*+δx* according to the schematic diagram in FIG7 . The control device 4 can, for example, derive the differentiation of the corresponding first pre-control signal δv* that has been derived again in another determination block 18 and then derive the corresponding second pre-control signal δI1* by expanding the intermediate signal derived in the multiplier 19. However, it is also feasible to directly derive the corresponding second pre-control signal δI1* without deriving the corresponding first pre-control signal δv* in advance. In any case, the derivation of the second pre-control signal δI1* is also achieved without taking into account the corresponding position actual value x.

如果控制装置4得出第二预控制信号δI1*,控制装置4通过将相应的第二预控制信号δI1*添加在相应的第二致动信号I*上来得出相应的第三致动信号I*+δI1*。在这种情况中,速度调节器14不直接将相应的第二致动信号I*输送至执行器12。确切地说,事先得出相应的第三致动信号I*+δI1*。执行器12在这种情况中根据图7中的示意图根据相应的第三致动信号I*+δI1*来驱控。If the control device 4 determines the second pre-control signal δI1*, the control device 4 determines the corresponding third actuation signal I*+δI1* by adding the corresponding second pre-control signal δI1* to the corresponding second actuation signal I*. In this case, the speed regulator 14 does not directly supply the corresponding second actuation signal I* to the actuator 12. Rather, the corresponding third actuation signal I*+δI1* is determined in advance. In this case, the actuator 12 is driven according to the corresponding third actuation signal I*+δI1* according to the schematic diagram in FIG. 7.

此外,根据图8的设计方案,控制装置4在另外的确定块20中根据附加目标值δx*的序列得出相应的第三预控制信号δI2*。在不考虑其他变量的情况下实现第三预控制信号的得出。控制装置4将相应的第三预控制信号δI2*(根据图8中的示意图除了相应的第二预控制信号δI1*,但是原则上与此并不相关地)添加在相应的第二致动信号I*上。由此,控制装置4在根据图8的设计方案中得出相应的最终的致动信号,利用该致动信号来驱控执行器12。Furthermore, according to the design of FIG. 8 , the control device 4 derives a corresponding third pre-control signal δI2* in a further determination block 20 based on the sequence of additional target values δx*. The derivation of the third pre-control signal is achieved without taking into account other variables. The control device 4 adds the corresponding third pre-control signal δI2* (in addition to the corresponding second pre-control signal δI1* according to the schematic diagram in FIG. 8 , but in principle it is not relevant thereto) to the corresponding second actuation signal I*. As a result, the control device 4 derives a corresponding final actuation signal in the design according to FIG. 8 , which is used to drive the actuator 12.

到目前为止所阐述的、根据其得出相应的附加目标值δx*的相应的第一分量δx1*的位置差值对应于相应的理想位置目标值x*与相应的部段的第一理想位置目标值x*的差值。然而,替代地可行的是,位置差值对应于相应理想位置目标值x*与相应的位置实际值x的差值。在这种情况下,除了相应的理想位置目标值x*仅还必须将位置实际值x输送至确定块9。剩余的得出能够毫无变化地保留。图9在根据图8的设计方案的相应的修改中示出了这些。然而相应的修改在图3、图6和图7的设计方案中也是可行的。The position difference values of the respective first components δx1* from which the respective additional target values δx* are derived so far correspond to the difference between the respective ideal position target values x* and the first ideal position target values x* of the respective sections. However, it is alternatively possible that the position difference values correspond to the difference between the respective ideal position target values x* and the respective position actual values x. In this case, in addition to the respective ideal position target values x*, only the position actual values x must be conveyed to the determination block 9. The remaining derivations can be retained without any changes. FIG. 9 shows this in a corresponding modification of the design scheme according to FIG. 8. However, corresponding modifications are also possible in the designs of FIG. 3, FIG. 6 and FIG. 7.

因此,总的来说本发明涉及以下事实:Therefore, in general the present invention relates to the following facts:

机器的控制装置4预设控制命令C,该控制命令C确定理想位置目标值x*的序列用于机器的位置调节轴1。该序列具有依次连续的部段。在部段内,理想位置目标值x*单调上升或者单调下降。从部段到部段变换单调的方向。控制装置4实施位置调节器13并且根据理想位置目标值x*的序列,控制装置4将结果位置目标值x*+δx*和位置实际值x输送至位置调节器13。位置调节器13由此得出用于轴1的执行器12的致动信号v*,并且位置调节器由此调节相应的轴1的位置x。结果位置目标值x*+δx*对应于理想位置目标值x*和附加目标值δx*的总和。在部段内,如果理想位置目标值x*单调上升,附加目标值δx*为正数。如果理想位置目标值x*单调下降,附加目标值δx*为负数。附加目标值δx*包括第一分量δx1*,第一分量δx1*只与位置差值有关。位置差值是相应的理想位置目标值x*与相应的部段的第一理想位置目标值x*的差值或者相应的理想位置目标值x*与相应的位置实际值x的差值。附加目标值δx*的第一分量δx1*的绝对值随着位置差值的绝对值的增加在开始严格单调上升并且之后至少是单调的上升。The control device 4 of the machine presets a control command C, which determines a sequence of ideal position target values x* for the position control axis 1 of the machine. The sequence has consecutive sections. Within the section, the ideal position target value x* increases monotonically or decreases monotonically. The direction of monotony changes from section to section. The control device 4 implements the position regulator 13 and according to the sequence of ideal position target values x*, the control device 4 transmits the resulting position target value x*+δx* and the actual position value x to the position regulator 13. The position regulator 13 thus derives an actuation signal v* for the actuator 12 of the axis 1, and the position regulator thereby adjusts the position x of the corresponding axis 1. The resulting position target value x*+δx* corresponds to the sum of the ideal position target value x* and the additional target value δx*. Within the section, if the ideal position target value x* increases monotonically, the additional target value δx* is a positive number. If the ideal position target value x* decreases monotonically, the additional target value δx* is a negative number. The additional target value δx* includes a first component δx1*, which is only related to the position difference. The position difference is the difference between the corresponding ideal position target value x* and the first ideal position target value x* of the corresponding segment or the difference between the corresponding ideal position target value x* and the corresponding position actual value x. The absolute value of the first component δx1* of the additional target value δx* increases strictly monotonically at the beginning and at least monotonically thereafter as the absolute value of the position difference increases.

本发明具有许多优点。特别地,能够以有效率的方式来补偿变形相关的滞后误差和速度相关的滞后误差。此外,远离执行器12布置的另一个测量系统对于检测至少一个位置调节轴1的(实际的)位置不是必需的。The invention has numerous advantages. In particular, deformation-related hysteresis errors and speed-related hysteresis errors can be compensated in an efficient manner. Furthermore, a further measuring system arranged remote from the actuator 12 is not necessary for detecting the (actual) position of the at least one position-controlled axis 1 .

尽管通过优选的实施例在细节上详细地阐述并描述了本发明,但本发明并不被所公开的实例限制,并且本领域技术人员在不脱离本发明的保护范围内能够推导出其他变体方案。Although the present invention has been illustrated and described in detail by means of preferred embodiments, the present invention is not limited to the disclosed examples and a person skilled in the art can derive other variants without departing from the scope of protection of the present invention.

Claims (13)

1.一种用于机器的控制方法,所述机器具有至少一个位置调节轴(1),1. A control method for a machine having at least one position-controlled axis (1), -其中,所述机器的控制装置(4)预设控制命令(C)的序列,所述序列确定了用于所述至少一个位置调节轴(1)的理想位置目标值的序列,- wherein the control device (4) of the machine predetermines a sequence of control commands (C) which determines a sequence of ideal position target values for the at least one position-regulating axis (1), -其中,所述理想位置目标值的序列具有多个依次连续的部段,- wherein the sequence of the ideal position target values has a plurality of sequentially consecutive sections, -其中,在所述理想位置目标值的序列的相应的部段内,所述理想位置目标值单调上升或者单调下降,wherein, within a corresponding section of the sequence of the ideal position target values, the ideal position target values monotonically increase or monotonically decrease, -其中,从所述理想位置目标值的序列的部段到部段,直接依次连续的所述理想位置目标值的差值变换所述差值的符号,- wherein the signs of the differences of the ideal position target values are directly changed from segment to segment of the sequence of the ideal position target values, -其中,所述控制装置(4)对于所述至少一个位置调节轴(1)实施位置调节器(13),wherein the control device (4) implements a position controller (13) for the at least one position-regulating axis (1), -其中,所述控制装置(4)根据所述理想位置目标值的序列将结果位置目标值的序列和相应的位置实际值(x)输送至所述位置调节器(13),- wherein the control device (4) transmits a sequence of resultant position target values and corresponding position actual values (x) to the position regulator (13) according to the sequence of the ideal position target values, -其中,所述位置调节器(13)根据所述输送至所述位置调节器的相应的结果位置目标值和所述输送至所述位置调节器的相应的位置实际值得出用于所述至少一个位置调节轴(1)的执行器(12)的相应的第一致动信号并且由此根据相应的所述结果位置目标值直接或者间接地调节所述至少一个位置调节轴(1)的位置,- wherein the position regulator (13) generates a corresponding first actuation signal for the actuator (12) of the at least one position regulating shaft (1) according to the corresponding resulting position target value transmitted to the position regulator and the corresponding position actual value transmitted to the position regulator, and thereby directly or indirectly adjusts the position of the at least one position regulating shaft (1) according to the corresponding resulting position target value, -其中,通过将相应的附加目标值添加在相应的所述理想位置目标值上来得出相应的所述结果位置目标值,- wherein the corresponding result position target value is obtained by adding the corresponding additional target value to the corresponding ideal position target value, -其中,在理想位置目标值的序列的部段内,如果所述理想位置目标值单调上升则相应的所述附加目标值为正数,并且如果所述理想位置目标值单调下降,相应的所述附加目标值为负数,其特征在于,- wherein, within a segment of a sequence of ideal position target values, if the ideal position target value increases monotonically, the corresponding additional target value is a positive number, and if the ideal position target value decreases monotonically, the corresponding additional target value is a negative number, characterized in that, -所述附加目标值包括第一分量,所述第一分量仅与位置差值有关,- the additional target value comprises a first component, which is related only to the position difference, -所述位置差值是相应的所述理想位置目标值与相应的部段的第一理想位置目标值的差值或者是相应的所述理想位置目标值与相应的位置实际值的差值并且The position difference value is the difference between the corresponding ideal position target value and the first ideal position target value of the corresponding segment or the difference between the corresponding ideal position target value and the corresponding position actual value; and -所述附加目标值的所述第一分量的绝对值随着所述位置差值的绝对值的增加在开始时严格单调地并且之后至少单调地上升。The absolute value of the first component of the additional target value increases strictly monotonically at the beginning and at least monotonically thereafter with increasing absolute value of the position difference value. 2.根据权利要求1所述的控制方法,2. The control method according to claim 1, 其特征在于,It is characterized in that 只要所述位置差值的绝对值达到了极限,所述第一分量的绝对值假定为预设的最大值并且然后在所述理想位置目标值的序列的相应的部段内保持恒定。As soon as the absolute value of the position difference reaches a limit, the absolute value of the first component assumes a predefined maximum value and then remains constant within the corresponding section of the sequence of the ideal position target values. 3.根据权利要求1或者2所述的控制方法,3. The control method according to claim 1 or 2, 其特征在于,It is characterized in that 所述第一分量在所述理想位置目标值的序列的相应的部段的开始处具有值为零。The first component has the value zero at the beginning of a respective segment of the sequence of ideal position target values. 4.根据权利要求1或者2所述的控制方法,4. The control method according to claim 1 or 2, 其特征在于,It is characterized in that 所述附加目标值包括第二分量,所述第二分量与所述至少一个位置调节轴(1)的行进速度有关。The additional target value comprises a second component which is related to the travel speed of the at least one position regulating axis (1). 5.根据权利要求4所述的控制方法,其特征在于,所述第二分量与所述至少一个位置调节轴(1)的所述行进速度成比例。5. The control method according to claim 4, characterized in that the second component is proportional to the travel speed of the at least one position adjustment axis (1). 6.根据权利要求1或者2所述的控制方法,6. The control method according to claim 1 or 2, 其特征在于,It is characterized in that -所述控制装置(4)实施从属于所述位置调节器(13)的速度调节器(14),- the control device (4) implements a speed regulator (14) which is subordinate to the position regulator (13), -所述位置调节器(13)不直接将相应的所述第一致动信号输送至所述执行器(12),而是将相应的结果速度目标值和此外相应的速度实际值输送至速度调节器(14),其中,相应的所述结果速度目标值与相应的所述第一致动信号有关,the position controller (13) does not directly supply the respective first actuation signal to the actuator (12), but rather supplies the respective resulting speed target value and also the respective speed actual value to a speed controller (14), wherein the respective resulting speed target value is dependent on the respective first actuation signal, -所述速度调节器(14)根据相应的所述结果速度目标值和相应的所述速度实际值得出用于所述至少一个位置调节轴(1)的所述执行器(12)的相应的第二致动信号并且由此根据相应的所述结果速度目标值直接或者间接地调节所述至少一个位置调节轴(1)的速度。- The speed regulator (14) generates a corresponding second actuation signal for the actuator (12) of the at least one position adjustment shaft (1) based on the corresponding resulting speed target value and the corresponding actual speed value, and thereby directly or indirectly adjusts the speed of the at least one position adjustment shaft (1) based on the corresponding resulting speed target value. 7.根据权利要求6所述的控制方法,7. The control method according to claim 6, 其特征在于,It is characterized in that -所述控制装置(4)根据所述结果位置目标值的序列在不考虑所述相应的位置实际值的情况下得出相应的第一预控制信号并且- the control device (4) derives a corresponding first precontrol signal based on the sequence of resulting position target values without taking into account the corresponding position actual value and -所述控制装置(4)通过将所述第一预控制信号添加在相应的理想速度目标值上来得出相应的所述结果速度目标值。- The control device (4) obtains the corresponding result speed target value by adding the first pre-control signal to the corresponding ideal speed target value. 8.根据权利要求6所述的控制方法,8. The control method according to claim 6, 其特征在于,It is characterized in that -所述控制装置(4)根据所述结果位置目标值的序列在不考虑相应的所述位置实际值的情况下得出相应的第二预控制信号并且- the control device (4) derives a corresponding second precontrol signal based on the sequence of resulting position target values without taking into account the corresponding position actual value and -所述速度调节器(14)不直接将相应的所述第二致动信号输送至所述执行器(12),而是所述控制装置(4)通过将相应的所述第二预控制信号添加在相应的所述第二致动信号上来得出用于所述执行器(12)的相应的第三致动信号并且根据相应的所述第三致动信号或者根据由相应的所述第三致动信号导出的相应的第四致动信号驱控所述执行器(12)。- The speed regulator (14) does not directly transmit the corresponding second actuation signal to the actuator (12), but the control device (4) derives the corresponding third actuation signal for the actuator (12) by adding the corresponding second pre-control signal to the corresponding second actuation signal and drives the actuator (12) according to the corresponding third actuation signal or according to the corresponding fourth actuation signal derived from the corresponding third actuation signal. 9.根据权利要求8所述的控制方法,9. The control method according to claim 8, 其特征在于,It is characterized in that -所述控制装置(4)根据所述结果位置目标值的序列在不考虑相应的所述位置实际值的情况下得出相应第三预控制信号并且- the control device (4) derives a corresponding third precontrol signal based on the sequence of the resulting position target values without taking into account the corresponding position actual value and -所述控制装置(4)通过将相应的所述第三预控制信号添加在所述相应第三致动信号上来得出用于所述执行器(12)的所述相应的第四致动信号并且- the control device (4) derives the respective fourth actuation signal for the actuator (12) by adding the respective third pre-control signal to the respective third actuation signal and -利用所述相应的第四致动信号驱控所述执行器(12)。- actuating the actuator (12) using the corresponding fourth actuation signal. 10.根据权利要求6所述的控制方法,10. The control method according to claim 6, 其特征在于,It is characterized in that -所述控制装置(4)根据结果位置目标值的序列在不考虑所述相应的位置实际值的情况下得出相应的第三预控制信号并且- the control device (4) derives a corresponding third precontrol signal based on the sequence of resulting position target values without taking into account the corresponding position actual value and -所述控制装置通过将相应的所述第三预控制信号添加在相应的所述第二致动信号上来得出用于所述执行器(12)的相应的结果致动信号,利用所述结果致动信号驱控所述执行器(12)。The control device determines a corresponding resulting actuation signal for the actuator (12) by adding the corresponding third precontrol signal to the corresponding second actuation signal, and the actuator (12) is controlled by means of the resulting actuation signal. 11.一种计算机可读存储介质,其上存储有用于机器的控制装置(4)的控制程序,所述机器具有至少一个位置调节轴(1),其中,所述控制程序(5)包括机器编码(6),所述机器编码(6)能够由所述控制装置(4)直接处理,其中,通过所述控制装置(4)引起所述机器编码(6)的所述处理,使得所述控制装置(4)根据前述权利要求中任一项所述的控制方法来控制所述至少一个位置调节轴(1)。11. A computer-readable storage medium having stored thereon a control program for a control device (4) of a machine, the machine having at least one position adjustment axis (1), wherein the control program (5) includes a machine code (6), the machine code (6) being directly processable by the control device (4), wherein the processing of the machine code (6) is caused by the control device (4) so that the control device (4) controls the at least one position adjustment axis (1) according to the control method described in any one of the preceding claims. 12.一种机器的控制装置,所述控制装置具有至少一个位置调节轴(1),其中,所述控制装置利用根据权利要求11所述的计算机可读存储介质的控制程序(5)被编程为,使得所述控制装置在运行时根据权利要求1到10中任一项所述的控制方法来控制所述机器的所述至少一个位置调节轴(1)。12. A control device for a machine, the control device having at least one position adjustment axis (1), wherein the control device is programmed using a control program (5) of a computer-readable storage medium according to claim 11 so that the control device controls the at least one position adjustment axis (1) of the machine according to a control method according to any one of claims 1 to 10 when running. 13.一种机器,其中,所述机器具有至少一个位置调节轴(1),其中,所述机器具有根据权利要求12所述的控制装置(4)其中,所述控制装置(4)在运行时根据权利要求1到10中任一项所述的控制方法来控制所述机器的所述至少一个位置调节轴(1)。13. A machine, wherein the machine has at least one position-adjusting axis (1), wherein the machine has a control device (4) according to claim 12, wherein the control device (4) controls the at least one position-adjusting axis (1) of the machine according to a control method according to any one of claims 1 to 10 during operation.
CN201980083904.6A 2018-12-18 2019-09-20 Position adjustment control to compensate for spring-dependent position errors Active CN113196185B (en)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
EP18213565.7A EP3671372A1 (en) 2018-12-18 2018-12-18 Position-controlled control with compensation of elasticity-induced position errors
EP18213565.7 2018-12-18
PCT/EP2019/075291 WO2020126133A1 (en) 2018-12-18 2019-09-20 Position-controlled control with compensation of elasticity-induced position errors

Publications (2)

Publication Number Publication Date
CN113196185A CN113196185A (en) 2021-07-30
CN113196185B true CN113196185B (en) 2024-06-11

Family

ID=65011723

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201980083904.6A Active CN113196185B (en) 2018-12-18 2019-09-20 Position adjustment control to compensate for spring-dependent position errors

Country Status (4)

Country Link
US (1) US11747785B2 (en)
EP (2) EP3671372A1 (en)
CN (1) CN113196185B (en)
WO (1) WO2020126133A1 (en)

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102033508A (en) * 2010-12-01 2011-04-27 沈阳工业大学 Method for improving machining precision of contour of directly driven XY platform
CN102771043A (en) * 2010-02-25 2012-11-07 株式会社明电舍 Torque fluctuation suppression control device and torque fluctuation suppression control method for rotating electric machine
CN103916062A (en) * 2014-04-01 2014-07-09 合肥工业大学 Vector control type electric actuator based on DSP
DE102016002995B3 (en) * 2016-03-14 2017-03-02 Gebr. Heller Maschinenfabrik Gmbh Method for monitoring a drive system of a machine tool
EP3208669A1 (en) * 2016-02-19 2017-08-23 Siemens Aktiengesellschaft Speed-based compensation of position errors
CN108628355A (en) * 2017-03-15 2018-10-09 发那科株式会社 Servocontrol device and system, machine learning device and method

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0805383B1 (en) * 1996-04-30 1999-05-19 Samsung Electronics Co., Ltd. Apparatus for controlling speed of a rotary motor
JP3281561B2 (en) * 1996-12-25 2002-05-13 シャープ株式会社 Motor speed control device
JP5512954B2 (en) * 2008-10-31 2014-06-04 オークマ株式会社 Position control device for numerical control machine
EP3171235B1 (en) * 2015-11-19 2020-04-29 Omron Corporation Control device, control method, information processing program, and recording medium

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102771043A (en) * 2010-02-25 2012-11-07 株式会社明电舍 Torque fluctuation suppression control device and torque fluctuation suppression control method for rotating electric machine
CN102033508A (en) * 2010-12-01 2011-04-27 沈阳工业大学 Method for improving machining precision of contour of directly driven XY platform
CN103916062A (en) * 2014-04-01 2014-07-09 合肥工业大学 Vector control type electric actuator based on DSP
EP3208669A1 (en) * 2016-02-19 2017-08-23 Siemens Aktiengesellschaft Speed-based compensation of position errors
DE102016002995B3 (en) * 2016-03-14 2017-03-02 Gebr. Heller Maschinenfabrik Gmbh Method for monitoring a drive system of a machine tool
CN108628355A (en) * 2017-03-15 2018-10-09 发那科株式会社 Servocontrol device and system, machine learning device and method

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
带有摩擦前馈补偿的伺服控制器设计的研究;袭著燕;路长厚;潘伟;陈淑荣;;组合机床与自动化加工技术(第12期);全文 *

Also Published As

Publication number Publication date
EP3847507B1 (en) 2021-11-17
US11747785B2 (en) 2023-09-05
WO2020126133A1 (en) 2020-06-25
EP3671372A1 (en) 2020-06-24
US20220043418A1 (en) 2022-02-10
CN113196185A (en) 2021-07-30
EP3847507A1 (en) 2021-07-14

Similar Documents

Publication Publication Date Title
EP1959323B1 (en) Elimination of unintended velocity reversals in S-curve velocity profiles
US7902785B2 (en) Method and device for guiding the movement of a moveable machine element of a machine
KR101779323B1 (en) Method and device for controlling a manipulator
CN109085801B (en) Control device for motor
US20130320908A1 (en) Servo controller having function for correcting amount of expansion/contraction of ball screw
JP4891528B2 (en) Machining time calculation device
CN108073137B (en) numerical controller
JP2008225533A (en) Servo controller
US20140214193A1 (en) Machining program creating device numerical control device, machining system, machining program creating method, numerical control method, and machining program
CN109085802B (en) Control device for motor
US9459598B2 (en) Motor control device
JP3545006B2 (en) Two-degree-of-freedom controller and servo controller for electric motor
CN110941242B (en) Motor control device
US5986422A (en) Control mode changing over method for servo control system
CN109954955B (en) Robot system
WO2014167808A1 (en) Motor drive device
KR20150006790A (en) Motor control devicde
JP3135738B2 (en) Numerical control unit
CN116931508A (en) Multi-axis intelligent servo driving and controlling integrated control system based on motion model
CN112865750A (en) Numerical control system multiplying power change smooth control method and device based on FIR filter
CN113196185B (en) Position adjustment control to compensate for spring-dependent position errors
WO2020261649A1 (en) Parameter adjustment method
WO2020255312A1 (en) Operation adjustment device for robot, operation control system, and robot system
KR100842978B1 (en) Servo control method
EP3304228B1 (en) Robot system for synchronizing the movement of the robot arm

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant