US6341244B1 - Method and control structure for controlling moments in numerically controlled elastic (and therefore oscillation-capable) multiple mass systems - Google Patents

Method and control structure for controlling moments in numerically controlled elastic (and therefore oscillation-capable) multiple mass systems Download PDF

Info

Publication number
US6341244B1
US6341244B1 US09/284,146 US28414699A US6341244B1 US 6341244 B1 US6341244 B1 US 6341244B1 US 28414699 A US28414699 A US 28414699A US 6341244 B1 US6341244 B1 US 6341244B1
Authority
US
United States
Prior art keywords
reference model
nominal
feed
rotation speed
axial
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.)
Expired - Fee Related
Application number
US09/284,146
Inventor
Wolfgang Papiernik
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 AG
Original Assignee
Siemens AG
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 AG filed Critical Siemens AG
Assigned to SIEMENS AKTIENGESELLSCHAFT reassignment SIEMENS AKTIENGESELLSCHAFT ASSIGNMENT OF ASSIGNORS INTEREST (SEE DOCUMENT FOR DETAILS). Assignors: PAPIERNIK, WOLFGANG
Application granted granted Critical
Publication of US6341244B1 publication Critical patent/US6341244B1/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Images

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/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
    • 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/41Numerical 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 interpolation, e.g. the computation of intermediate points between programmed end points to define the path to be followed and the rate of travel along that path
    • G05B19/4103Digital interpolation
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1628Programme controls characterised by the control loop
    • B25J9/1641Programme controls characterised by the control loop compensation for backlash, friction, compliance, elasticity in the joints
    • 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/39Robotics, robotics to robotics hand
    • G05B2219/39186Flexible joint
    • 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/41225Profile generator for reference and for feedforward torque
    • 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/41426Feedforward of torque
    • 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/41436Feedforward of speed and acceleration

Definitions

  • the present invention relates to a method and a control structure for torque feed-forward control of numerically controlled, elastic and thus oscillating multiple-mass systems such as machine tools, robots or the like.
  • An object of the present invention is thus to provide a method as well as a control structure for torque feed-forward control of numerically controlled, elastic and thus oscillating multiple-mass systems, which take account of the elastic behavior between the motor and the load performed, e.g., using a processing device.
  • this object is achieved by a method having the following method steps:
  • parameters for impressing nominal motion states are estimated from an at least 4th-order reference model for motion control in that, derived from this in each axis control loop,
  • a spring toque which causes oscillations and is associated with the most pronounced natural frequency of the multiple-mass system is likewise derived from the reference model and compensated for by applying disturbance variables to the feed-forward torque control path.
  • a first advantageous embodiment of the method according to the present invention provides that the acceleration can be preset by additional degrees of freedom in time with the interpolation. This is made possible by the following further method step:
  • a further advantageous embodiment of the method according to the present invention provides that only the derivative of the jerk has discontinuities in the profile. This is made possible by the following further method step:
  • the nominal values to be impressed are derived from profiles averaged over one interpolation interval.
  • a further advantageous embodiment of the method according to the present invention provides that averaging can be carried out with minimal computational complexity. This is achieved by the following further method steps:
  • the averaging of the motion is likewise carried out explicitly in that the individual contributions of all of the polynomials to the total integral of the motion are each added up and the difference between the sums is formed over one interpolation interval.
  • control structure which is particularly suitable for achieving the object of the present invention since it allows effective implementation with little complexity.
  • This control structure has the following elements:
  • an at least 4th-order reference model for motion control is provided for reference-variable generation of parameters for impressing nominal motion states, in which reference model, for each axis control loop,
  • a nominal position value path is provided for impressing axial nominal position angles in time with the interpolation
  • an advance rotation speed control path is provided for impressing axial nominal rotation speed values in time with the interpolation
  • 5.5 (e.g., an arrangement) is provided for applying disturbance variables to the feed-forward torque control path in order to compensate for a spring torque which causes oscillations and is associated with the most pronounced natural frequency of the multiple-mass system.
  • control structure of the present invention provides that only the derivative of the jerk has discontinuities in the profile.
  • the following further element is used for this purpose:
  • a fine interpolator is provided which interpolates the nominal values to be impressed from input variables averaged over one interpolation interval.
  • FIG. 1 shows a control structure with an feed-forward control for elastic drive systems.
  • FIG. 2 shows a schematic illustration of a discrepancy between a reference model and an axis mechanism in the elastic system.
  • FIG. 3 shows a schematic illustration of a torque required to impress motion states in the elastic system.
  • FIG. 4 shows a control structure with an feed-forward control for a rigid drive system.
  • FIG. 5 shows normalized Cartesian motion states of x-axis while moving over a circular path.
  • FIG. 6 shows normalized states of a 4th-order reference model during a positioning process.
  • FIG. 7 shows normalized states of the axis mechanism during a positioning process corresponding to FIG. 6 .
  • the term drive system shall refer to a system which includes an actuator, for example an electrical drive, coupling elements and the driven load, for example machine tool or robot axes and additional loads on these axes.
  • the drive system may have means for regulation and/or control.
  • the coefficients a v can be calculated from the boundary conditions
  • S start and S End designate the respective location and V Start and v End respectively denote the speed at the start and at the end of the present interpolation interval.
  • FIG. 4 show, a control structure for feed-forward control of rigid drive systems.
  • This control structure includes an axis control loop AR and a reference model F (both surrounded by dashed lines).
  • the axis control loop AR has a position regulator LR to which an axial nominal position angle ⁇ w sym is applied.
  • the position regulator LR is followed in the control path by a rotation speed regulator DR, which may be configured as a PI element.
  • While the nominal position angle ⁇ w sym is applied via a comparator V 1 , this is done with respect to the nominal rotation speed value n v via a further comparator V 2 which is connected between the output of the position regulator LR and the input of the rotation speed regulator DR and to which a rotation speed value n, which is defined on the output side, is also applied as a control value.
  • the rotation speed regulator DR is followed on the output side by a further comparator V 3 , to which a nominal acceleration value mv is applied.
  • a position angle ⁇ is produced on the output side in the axis control loop AR from the values impressed in the control path via an equivalent time constant T Ersi and two integrators T m , T ⁇ , and is fed back to V 1 .
  • the axial nominal position angle ⁇ w sym is applied via a nominal position value path LP, the nominal rotation speed value nv is applied via a feed-forward rotation speed control path DP, and the nominal acceleration value mv is applied via a feed-forward torque control path MP.
  • the corresponding nominal values are obtained from the reference model F via the feed-forward control paths.
  • This reference model F is supplied on the input side with a nominal acceleration value ⁇ umlaut over (s) ⁇ (t), from which the nominal acceleration value m v is obtained via equivalent time constants in time with the current regulator Torrent.
  • a nominal speed value is derived from the predetermined nominal acceleration value in the reference model F via an integrator I 2 and provides a feed-forward speed control value in time with the rotation speed regulator T Rotation speed taking account of constants k 2 and an equivalent time constant T Ersi .
  • a nominal position value is provided in the reference model F via a further integrator I 1 , from which value an axial nominal position angle ⁇ w sym is generated, in time with the position regulator T position via the elements described above for the feed-forward rotation speed control path DP.
  • the nominal position angle path LP and the feed-forward speed and/or rotation speed control path DP contain the symmetry elements of the equivalent time constants T Ersi .
  • Equations (2) and (3) can also be implemented only in time with the position regulator T position .
  • a ramp-function generator which is implemented in the feed-forward rotation speed control path for timing matching can then be applied additively.
  • FIG. 5 shows, as an example, a circular path, which is followed at a constant speed.
  • FIG. 5 shows the normalized cartesian motion states of the x-axis when fine interpolation is carried out using the 3rd-order polynomial.
  • the position is s(t)
  • the speed is ⁇ dot over (s) ⁇ (t)
  • the acceleration profile ⁇ dot over (s) ⁇ (t) is illustrated by a solid line.
  • the acceleration profile clearly shows the discontinuities at the interval boundaries.
  • the mechanism is in this case subjected to severe torque shocks, so that the described feed-forward acceleration control is unusable.
  • the second solution results in considerably less computational complexity in the kinematic transformation.
  • the axis mechanism A which is based on an elastic two-mass system, is in this case illustrated on the basis of a control path surrounded by dashed lines.
  • a torque value m is fed in on the input side, and a position angle ⁇ is present on the output side.
  • the rotation speed nL on the load side is fed back to a rotation speed n M on the drive side.
  • a spring torque m F is likewise negatively fed back to the input of the axis mechanism A, that is to say the torque value M.
  • the reference model F represents the two-store model with two integrators which has already been described with reference to the illustration according to FIG. 4 .
  • Nominal values are generated via this reference model F, via the nominal position value path LP, the feed-forward rotation speed control path DP and the feed-forward torque control path MP although, owing to the feedback paths in the axis mechanism A, these cannot be directly impressed into the axis control loop as in the control structure according to FIG. 4 .
  • the predetermined acceleration for example of a machine table of a machine tool, can now no longer be formed directly, but only after a delay, in the form of the spring torque m F .
  • this situation is suitably “corrected” according to the present invention in the fine interpolator.
  • FIG. 1 One possible embodiment is shown in FIG. 1 .
  • FIG. 1 shows a control structure according to the present invention with feed-forward control for elastic drive systems. This also includes the axis mechanism A of the elastic drive system, which has been explained above in conjunction with FIG. 2.
  • a reference model F derived in a corresponding manner shown in FIG. 3 for generating variables for motion control is shown, which comprises a chain of four successive integrators Il to I 4 , to the input side of which a derivative of the jerk (t)is applied and which provides a position value s(t) at the output of the last integrator I 1 .
  • the axis mechanism A now has connected upstream of it a control path for the drive system, whose main components are a position regulator LR, a rotation speed regulator DR which follows it and may be configured as a PI element, and followed by an equivalent time constant T Ersi .
  • the position angle ⁇ which is present on the output side of the axis mechanism A is negatively fed back as a control variable, via a comparator V 1 , to the input of the position regulator LR.
  • the motor rotation speed n M is negatively fed back as a control variable to a further comparator V 2 which is located between the output of the position regulator LR and the input of the rotation speed regulator DR.
  • a third comparator V 3 is arranged between the output of the rotation speed regulator DR and the input of the equivalent time constants T Ersi .
  • An axial nominal position angle ⁇ w sym is added on the input side via a nominal position value path LP to the position regulator LR, via the comparator V 1 .
  • a nominal rotation speed value n v is added to the output signal from the position regulator LR via a feed-forward rotation speed control path DP, via the comparator V 2 .
  • a nominal drive torque value mv which is provided via a feed-forward torque control path MP is added via the third comparator V 3 to the output signal from the rotation speed regulator DR.
  • the nominal variables provided via the corresponding feed-forward control paths LP, DP and MP are derived from the reference model F.
  • the axial nominal position angle ⁇ w sym is derived from the position value s(t), which is present at the output of the reference model F, in time with the position regulator T position and taking account of corresponding constants such as k 1 , which corresponds to the reciprocal of the spindle pitch, and other equivalent time constants T Ersi .
  • a rotation speed reference variable ⁇ haeck over (n) ⁇ L is obtained in time with the rotation speed T Rotation speed from the speed value ⁇ umlaut over (s) ⁇ (t) provided in the reference model F, and a rotation speed difference ⁇ haeck over (n) ⁇ , obtained from the jerk (t) in the reference model F, is added to it via an adder A 2 .
  • the sum value passes via a further equivalent time constant T Ersi as an axial nominal rotation speed value n v , to the comparator V 2 , where it is applied to the rotation speed regulator DR.
  • An axial nominal drive torque value m v is obtained in a similar manner from the reference model F in time with the current regulator T current .
  • the variable vis derived by weighting via the already indicated parameter k 1 from the derivative of the jerk (t), which parameter k 1 , to which is added, via a further adder A 1 , the spring torque ⁇ circumflex over (m) ⁇ F determined from the acceleration value ⁇ umlaut over (s) ⁇ (t) in the reference model F.
  • the axial nominal drive torque value m v is formed from the sum, weighted via the factor C 1 ⁇ 1 , and is added, via the comparator V 3 to the output of the rotation speed regulator DR.
  • the required torque m which is explained in conjunction with FIG. 3 is impressed into the axis mechanism A via the equivalent time constant T Ersi which as described above, follows the comparator V 3 .
  • the evaluation can be carried out by using equation (10).
  • the position ⁇ overscore (S ) ⁇ can also be averaged explicitly by, first of all, addition over the individual contributions I v of all the polynomials in the overall integral I tot of the movement:
  • FIGS. 6 and 7 show the application of the described method to an undamped two-mass system with a natural frequency of 92 Hz.
  • the example is based on the following data:
  • T M 20 msec
  • T L 60 msec
  • T F 200 ⁇ sec
  • T Ersi 200 ⁇ sec
  • T Ipo 8 msec
  • T position 1msec
  • FIG. 6 is a motion process with feedback since the mean value of the jerk ⁇ overscore () ⁇ varies in the form of a ramp.
  • the mean value of s correspondingly “jumps” in time with the interpolation and, as required, is constant within the interpolation intervals.
  • a comparison of the nominal table position ⁇ overscore (s) ⁇ with the actual load angle ⁇ in FIG. 7 shows—owing to the fact that the equivalent time constant T Ersi is negligibly small—no difference between the two normalized variables.

Landscapes

  • Engineering & Computer Science (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Computing Systems (AREA)
  • Theoretical Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Feedback Control In General (AREA)
  • Numerical Control (AREA)
  • Springs (AREA)

Abstract

A control capability is provided for feed-forward torque control of numerically controlled, elastic and thus oscillating multiple-mass systems, which capability takes account of the elastic behavior between a drive and the load connected to it. This is achieved essentially in that a spring torque which causes oscillations and is associated with the most pronounced natural frequency of the multiple-mass system is derived from a reference model and is compensated for by applying disturbance compensation variables to a feed-forward torque control path.

Description

FIELD OF THE INVENTION
The present invention relates to a method and a control structure for torque feed-forward control of numerically controlled, elastic and thus oscillating multiple-mass systems such as machine tools, robots or the like.
BACKGROUND INFORMATION
Drive systems in which there is no rigid link between a motor and a load, for example the table of a machine tool, represent elastic and thus oscillating multiple-mass systems.
Conventionally, the methods for feed-forward control of the speed, acceleration and/or torque of such drive systems are based on the existence of a rigid link between the motor and the load. Such methods thus operate only subject to severe limitations in the case of elastic systems and have a high error component.
No suitable methods for feed-forward control of elastic systems have yet been described.
SUMMARY OF THE INVENTION
An object of the present invention is thus to provide a method as well as a control structure for torque feed-forward control of numerically controlled, elastic and thus oscillating multiple-mass systems, which take account of the elastic behavior between the motor and the load performed, e.g., using a processing device.
According to the present invention, this object is achieved by a method having the following method steps:
1.1 for reference-variable generation, parameters for impressing nominal motion states are estimated from an at least 4th-order reference model for motion control in that, derived from this in each axis control loop,
1.2 an axial nominal position angle is impressed via a nominal position value path in time with the interpolation,
1.3 an axial nominal rotation speed value is impressed via an advance rotation speed control path in time with the interpolation, and
1.4 an axial nominal drive torque value is impressed via an advance torque control path in time with the interpolation, in which case,
1.5 a spring toque which causes oscillations and is associated with the most pronounced natural frequency of the multiple-mass system is likewise derived from the reference model and compensated for by applying disturbance variables to the feed-forward torque control path.
A first advantageous embodiment of the method according to the present invention provides that the acceleration can be preset by additional degrees of freedom in time with the interpolation. This is made possible by the following further method step:
2.61 5th or higher order polynomials are used for fine interpolation in the reference model.
A further advantageous embodiment of the method according to the present invention provides that only the derivative of the jerk has discontinuities in the profile. This is made possible by the following further method step:
3.1 in the course of fine interpolation, the nominal values to be impressed are derived from profiles averaged over one interpolation interval.
A further advantageous embodiment of the method according to the present invention provides that averaging can be carried out with minimal computational complexity. This is achieved by the following further method steps:
4.1 the integrals required for averaging of the derivatives from the motion are transferred directly from the reference model,
4.2 the averaging of the motion is likewise carried out explicitly in that the individual contributions of all of the polynomials to the total integral of the motion are each added up and the difference between the sums is formed over one interpolation interval.
Furthermore, a control structure is proposed which is particularly suitable for achieving the object of the present invention since it allows effective implementation with little complexity. This control structure has the following elements:
5.1 an at least 4th-order reference model for motion control is provided for reference-variable generation of parameters for impressing nominal motion states, in which reference model, for each axis control loop,
5.2 a nominal position value path is provided for impressing axial nominal position angles in time with the interpolation,
5.3 an advance rotation speed control path is provided for impressing axial nominal rotation speed values in time with the interpolation, and
5.4 a feed-forward torque control path is provided for impressing axial nominal drive torque values in time with the interpolation, in which case
5.5 (e.g., an arrangement) is provided for applying disturbance variables to the feed-forward torque control path in order to compensate for a spring torque which causes oscillations and is associated with the most pronounced natural frequency of the multiple-mass system.
An advantageous embodiment of the control structure of the present invention provides that only the derivative of the jerk has discontinuities in the profile. The following further element is used for this purpose:
6.1 a fine interpolator is provided which interpolates the nominal values to be impressed from input variables averaged over one interpolation interval.
BRIEF DESCRIPTION OF THE DRAWINGS
FIG. 1 shows a control structure with an feed-forward control for elastic drive systems.
FIG. 2 shows a schematic illustration of a discrepancy between a reference model and an axis mechanism in the elastic system.
FIG. 3 shows a schematic illustration of a torque required to impress motion states in the elastic system.
FIG. 4 shows a control structure with an feed-forward control for a rigid drive system.
FIG. 5 shows normalized Cartesian motion states of x-axis while moving over a circular path.
FIG. 6 shows normalized states of a 4th-order reference model during a positioning process.
FIG. 7 shows normalized states of the axis mechanism during a positioning process corresponding to FIG. 6.
DETAILED DESCRIPTION
For the purposes of the present invention, the term drive system shall refer to a system which includes an actuator, for example an electrical drive, coupling elements and the driven load, for example machine tool or robot axes and additional loads on these axes. The drive system may have means for regulation and/or control.
Methods for feed-forward control of rigid drive systems which are also used in elastic drive systems are based on the assumption that the natural oscillations of the mechanical system are well damped, so that a virtually rigid system is formed which can be described by two integrators connected in series. The interpolator requires nominal axial position and speed values in the axis control loops in time with the interpolation, which are initially still finely interpolated before being processed further. 3rd-order polynomials are used for this purpose:
Poly(t)=a0+a1·t+a2·t2+a3·t3, tε[0,TIpo]  (1)
The coefficients av can be calculated from the boundary conditions
Poly(0)=sStart, Poly(TIpo)=sEnd, Poly(0)=vStart, {dot over (P)}oly(TIpo)=vEnd
Sstart and SEnd designate the respective location and VStart and vEnd respectively denote the speed at the start and at the end of the present interpolation interval.
The time derivatives
v(t)={dot over (P)}oly(t)=a1+2a2·t+3a3·t2  (2)
a(t)={umlaut over (P)}oly(t)=2a2+6a3·t  (3)
are used for feed-forward control. In the case of rigid drive systems, this results in a control structure as is shown by way of example in FIG. 4.
FIG. 4 show, a control structure for feed-forward control of rigid drive systems. This control structure includes an axis control loop AR and a reference model F (both surrounded by dashed lines). The axis control loop AR has a position regulator LR to which an axial nominal position angle φwsym is applied. The position regulator LR is followed in the control path by a rotation speed regulator DR, which may be configured as a PI element. While the nominal position angle φwsym is applied via a comparator V1, this is done with respect to the nominal rotation speed value nv via a further comparator V2 which is connected between the output of the position regulator LR and the input of the rotation speed regulator DR and to which a rotation speed value n, which is defined on the output side, is also applied as a control value. The rotation speed regulator DR is followed on the output side by a further comparator V3, to which a nominal acceleration value mv is applied. A position angle φ is produced on the output side in the axis control loop AR from the values impressed in the control path via an equivalent time constant TErsi and two integrators Tm, Tφ, and is fed back to V1. The axial nominal position angle φwsym is applied via a nominal position value path LP, the nominal rotation speed value nv is applied via a feed-forward rotation speed control path DP, and the nominal acceleration value mv is applied via a feed-forward torque control path MP. The corresponding nominal values are obtained from the reference model F via the feed-forward control paths. This reference model F is supplied on the input side with a nominal acceleration value {umlaut over (s)}(t), from which the nominal acceleration value mv is obtained via equivalent time constants in time with the current regulator Torrent. A nominal speed value is derived from the predetermined nominal acceleration value in the reference model F via an integrator I2 and provides a feed-forward speed control value in time with the rotation speed regulator TRotation speed taking account of constants k2 and an equivalent time constant TErsi. Finally, a nominal position value is provided in the reference model F via a further integrator I1, from which value an axial nominal position angle φwsym is generated, in time with the position regulator Tposition via the elements described above for the feed-forward rotation speed control path DP.
The following evaluations are required for implementation:
Equation 3 in time with the current regulator
Equation 2 in time with the rotation speed regulator
Equation 1 in time with the position regulator
In addition to the above-described equations, the nominal position angle path LP and the feed-forward speed and/or rotation speed control path DP contain the symmetry elements of the equivalent time constants TErsi.
Equations (2) and (3) can also be implemented only in time with the position regulator Tposition. A ramp-function generator which is implemented in the feed-forward rotation speed control path for timing matching can then be applied additively.
When 3rd-degree polynomials are used, it is impossible to prevent the following problem in extreme cases:
Although the profile of the acceleration is continuous within each interpolation interval, it can, however, jump at the interval boundaries if high centrifugal forces occur (even in the case of jerk-limited motion control and C2-continuous path presetting). FIG. 5 shows, as an example, a circular path, which is followed at a constant speed.
The illustration of FIG. 5 shows the normalized cartesian motion states of the x-axis when fine interpolation is carried out using the 3rd-order polynomial. On the basis of the dotted profile, the position is s(t), on the basis of the dashed profile the speed is {dot over (s)}(t), and the acceleration profile {dot over (s)}(t)is illustrated by a solid line. The acceleration profile clearly shows the discontinuities at the interval boundaries.
The mechanism is in this case subjected to severe torque shocks, so that the described feed-forward acceleration control is unusable.
There are two possible alternatives to overcome this: 1. Use 5th-order polynomials instead of 3rd-order. This results in two additional degrees of freedom, as a result of which the acceleration can also be predetermined explicitly in the interpolation grid. 2. Retain 3rd-order polynomials, additionally using averaging of all the states over one interpolation cycle. The averaging will be discussed in more detail below.
As an advantage over the 1st solution, the second solution results in considerably less computational complexity in the kinematic transformation.
The description above is based on the mechanism being sufficiently stiff that it can virtually be regarded as a rigid single-mass system. However, as a rule, an oscillating multiple mass structure is present, having a number of natural frequencies. One of the natural frequencies is often considerably more pronounced than all the others, so that the system can be described with sufficient accuracy as a spring two-mass system. The following descriptions are based on this.
As an initial matter, it is necessary to remember that, in this case, there is a discrepancy between the two-store model of motion control and the mechanism which actually exists. This situation is shown in FIG. 2.
The axis mechanism A, which is based on an elastic two-mass system, is in this case illustrated on the basis of a control path surrounded by dashed lines. A torque value m is fed in on the input side, and a position angle φ is present on the output side. On the basis of the spring two-mass system, the rotation speed nL on the load side is fed back to a rotation speed nM on the drive side. A spring torque mF is likewise negatively fed back to the input of the axis mechanism A, that is to say the torque value M. The reference model F represents the two-store model with two integrators which has already been described with reference to the illustration according to FIG. 4. Nominal values are generated via this reference model F, via the nominal position value path LP, the feed-forward rotation speed control path DP and the feed-forward torque control path MP although, owing to the feedback paths in the axis mechanism A, these cannot be directly impressed into the axis control loop as in the control structure according to FIG. 4.
The predetermined acceleration, for example of a machine table of a machine tool, can now no longer be formed directly, but only after a delay, in the form of the spring torque mF. In order to avoid overloading the drives, this situation is suitably “corrected” according to the present invention in the fine interpolator.
On the basis of the four existing stores TM, TF, TL, Tφ, of the axis mechanism A, it can, initially, be seen that, in contrast to the situation with a rigid system, no direct access is possible here to the second position derivative, but only to the fourth position derivative (TErsi is set to be approximately equal to zero). The calculation gives: ϕ _ = 1 T M T L T F T ϕ c 1 · m - ω 0 2 T L T ϕ c 2 · m F ; ω 0 = T M + T L T M T L T F . ( 4 )
Figure US06341244-20020122-M00001
This can be used to calculate the drive torque which is required in order to impress a specific value of : ϕ _ = c 1 · m - c 2 · m F = ! ϕ _ w m = ! ( ϕ _ w + c 2 · m F ) · c 1 - 1 ( 5 )
Figure US06341244-20020122-M00002
Using this control variable, the overall system behaves like a quadruple integrator chain which—because the elasticities are apparently no longer present—can be appropriately controlled in feed-forward via a fourth-order reference model F. This relationship is shown as a schematic illustration of the torque required to impress the motion states in the case of elastic systems show in FIG. 3.
The schematic illustration of the axis mechanism A (surrounded by dashed lines) has applied to its input side a nominal value m obtained in accordance with equation (5). The situation shown in equation (5) is for this purpose likewise shown in a schematic element which is surrounded by dashed lines and which, in contrast, shows the relationship of the equation. This sum arrangement is identical to the reference model F illustrated underneath, as is symbolized in the illustration by three horizontal dashes (the identity character).
The spring torque required in accordance with equation (5) for feed-forward control does not need to be measured but, in the same way as the other states required for feed-forward control and for symmetry, can be obtained from the reference model F since, in the undisturbed case, the path behaves identically to the model. This offers the advantage that the feed-forward control remains completely separate from the closed control loop and the disturbance response thus cannot be adversely affected by, for example, inaccuracies in the model parameters. This thus results in the equations (6), which can be derived directly from FIG. 3. In order to indicate that these are variables taken from the reference model F, they are also denoted by “{circumflex over ( )}” in the corresponding illustrations in the FIG: m ^ = T ϕ · T L · ϕ ¨ w n ^ L = T ϕ · ϕ . w Δ n ^ = T ϕ · T L · T F · ϕ w } n ^ M = n ^ L + Δ n ^ = T ϕ · ϕ . w + T ϕ · T L · T F · ϕ w ( 6 )
Figure US06341244-20020122-M00003
Knowledge of these equations allows the control structure for feed-forward control for elastic multiple-mass systems to be stated completely. One possible embodiment is shown in FIG. 1.
FIG. 1 shows a control structure according to the present invention with feed-forward control for elastic drive systems. This also includes the axis mechanism A of the elastic drive system, which has been explained above in conjunction with FIG. 2. A reference model F derived in a corresponding manner shown in FIG. 3 for generating variables for motion control is shown, which comprises a chain of four successive integrators Il to I4, to the input side of which a derivative of the jerk (t)is applied and which provides a position value s(t) at the output of the last integrator I1. The axis mechanism A now has connected upstream of it a control path for the drive system, whose main components are a position regulator LR, a rotation speed regulator DR which follows it and may be configured as a PI element, and followed by an equivalent time constant TErsi. The position angle φ which is present on the output side of the axis mechanism A is negatively fed back as a control variable, via a comparator V1, to the input of the position regulator LR. The motor rotation speed nM is negatively fed back as a control variable to a further comparator V2 which is located between the output of the position regulator LR and the input of the rotation speed regulator DR. A third comparator V3 is arranged between the output of the rotation speed regulator DR and the input of the equivalent time constants TErsi.
An axial nominal position angle φwsym is added on the input side via a nominal position value path LP to the position regulator LR, via the comparator V1. A nominal rotation speed value nv is added to the output signal from the position regulator LR via a feed-forward rotation speed control path DP, via the comparator V2. A nominal drive torque value mv which is provided via a feed-forward torque control path MP is added via the third comparator V3 to the output signal from the rotation speed regulator DR. The nominal variables provided via the corresponding feed-forward control paths LP, DP and MP are derived from the reference model F. The axial nominal position angle φwsym is derived from the position value s(t), which is present at the output of the reference model F, in time with the position regulator Tposition and taking account of corresponding constants such as k1, which corresponds to the reciprocal of the spindle pitch, and other equivalent time constants TErsi.
In order to obtain the nominal rotation speed value nv, a rotation speed reference variable {haeck over (n)}L is obtained in time with the rotation speed TRotation speed from the speed value {umlaut over (s)}(t) provided in the reference model F, and a rotation speed difference Δ{haeck over (n)}, obtained from the jerk (t) in the reference model F, is added to it via an adder A2. The sum value passes via a further equivalent time constant TErsi as an axial nominal rotation speed value nv, to the comparator V2, where it is applied to the rotation speed regulator DR.
An axial nominal drive torque value mv is obtained in a similar manner from the reference model F in time with the current regulator Tcurrent. The variable vis derived by weighting via the already indicated parameter k1 from the derivative of the jerk (t), which parameter k1, to which is added, via a further adder A1, the spring torque {circumflex over (m)}F determined from the acceleration value {umlaut over (s)}(t) in the reference model F. The axial nominal drive torque value mv is formed from the sum, weighted via the factor C1 −1, and is added, via the comparator V3 to the output of the rotation speed regulator DR. The required torque m, which is explained in conjunction with FIG. 3 is impressed into the axis mechanism A via the equivalent time constant TErsi which as described above, follows the comparator V3.
It can be seen from the control structure in FIG. 1 that the motion control now has to operate with the derivative of the jerk as an input variable in order to “match” it to the path (once again assuming TErsi≈0). Furthermore, the path has to be C3-continuous in order to ensure that the profile of the jerk can have no jumps. However, for complexity reasons, the two requirements cannot be achieved economically, for which reason the following approach is taken.
It is presupposed that the motion control is fed back, but the path is C2-continuous and the axial motion, speed and acceleration nominal values are transferred to the axis control loops in time with the interpolation. These control loops now use 5th-order polynomials for fine interpolation:
s(t)=Poly(t)=a0+a1·t+a2·t2+a3·t3+a4·t4+a5·t5  (7)
{dot over (s)}(t) ={dot over (P)}oly(t)=a1+2a2·t+3a3·t2+4a4·t3+5a5·t4  (8)
{umlaut over (s)}(t)={umlaut over (P)}oly(t)=2a26a3·t+12a4·t2+20a5·t3  (9)
(t)=oly(t)=6a3+24a4·t60a5·t2  (10)
(t)=oly(t)=24a4+120a5·t  (11)
Since the profile of will always have jumps, profiles averaged over one interpolation interval are used, instead of instantaneous values. These profiles can be calculated explicitly without any additional complexity, since the integrals required for averaging are already available anyway on the basis of equations (7)-(11). Thus, for example: s ¨¨ _ ( t ) = t - T lpo t s ¨¨ ( t ) t = s ¨¨ ( t ) - s ¨¨ ( t - T lpo ) ;
Figure US06341244-20020122-M00004
The evaluation can be carried out by using equation (10).
Correspondingly, it can be said that: s _ ( t ) = s ¨ ( t ) - s ¨ ( t - T lpo ) ; s ¨ _ ( t ) = s . ( t ) - s . ( t - T lpo ) ; s . _ ( t ) = s ( t ) - s ( t - T lpo ) . ( 12 )
Figure US06341244-20020122-M00005
The position {overscore (S )} can also be averaged explicitly by, first of all, addition over the individual contributions Iv of all the polynomials in the overall integral Itot of the movement:
Itot=ΣIv, where
I v ( t ) := v · T lpo v · T lpo + t s ( t ) t = 0 t Poly v ( t ) t = a 0 v t + a 1 v 2 t 2 + a 2 v 3 t 3 + a 3 v 4 t 4 + a 4 v 5 t 5 + a 5 v 6 t 6 ;
Figure US06341244-20020122-M00006
 tε[0,TIpo]
The mean value thus becomes:
{overscore (s)}(t)=Itot(t)−Itot(t−Tipo)  (13).
The illustrations in FIGS. 6 and 7 show the application of the described method to an undamped two-mass system with a natural frequency of 92 Hz. The example is based on the following data:
TM=20 msec, TL=60 msec, TF=200μsec, TErsi=200μsec, TIpo=8 msec, Tposition=1msec, TRotation speed=TCurrent=62.5 μsec.
First of all, it can be seen from FIG. 6 that is a motion process with feedback since the mean value of the jerk {overscore ()} varies in the form of a ramp. The mean value of s correspondingly “jumps” in time with the interpolation and, as required, is constant within the interpolation intervals. A comparison of the nominal table position {overscore (s)} with the actual load angle φ in FIG. 7 shows—owing to the fact that the equivalent time constant TErsi is negligibly small—no difference between the two normalized variables. Likewise, the normalized profiles of the nominal table speed {overscore ({dot over (s)})} and the load rotation speed nL as well as the table acceleratio and the torque mF are virtually identical, as required. The feed-forward control torque mv varies, as expected, in the same way as the derivative of the jerk only at the transitions between the interpolation intervals.
All the features mentioned in the above description and illustrated in the figures are intended to be regarded as being covered by the invention provided the known prior art allows this, in their own right or in combination.
The above description of the embodiments according to the present invention is provided for the purpose of illustration. These embodiments are not exhausted. The present invention is also not limited to the precise form stated, but numerous modifications and variations are possible in the context of the technical teaching described above. One preferred embodiment has been described in order to illustrate the fundamental details of the present invention and practical applications in order to make it possible for a person skilled in the art to implement the present invention. A multiplicity of other embodiments as well as further modifications are feasible for specific application areas.

Claims (8)

What is claimed is:
1. A method for a feed-forward torque control of an elastic and oscillating multiple-mass system, comprising the steps of:
estimating parameters for controlling nominal motion states from an at least 4th-order reference model for controlling a motion of the multiple-mass system;
deriving, from the reference model for each axis control loop of the multiple-mass system, an axial nominal position angle, the axial nominal position angle being impressed via a nominal position value path in an interpolation cycle;
deriving, from the reference model in each axis control loop of the multiple-mass system, an axial nominal rotation speed value, the axial nominal rotation speed value being impressed via an feed-forward rotation speed control path in the interpolation cycle;
deriving, from the reference model in each axis control loop of the multiple-mass system, an axial nominal drive torque value, the axial nominal drive torque value being impressed via an feed-forward torque control path in the interpolation cycle; and
deriving from the reference model a spring torque, the spring torque causing oscillations and being associated with a most pronounced natural frequency of the multiple-mass system, the spring torque being compensated for by applying disturbance variables to the feed-forward torque control path.
2. The method according to claim 1, wherein the at least 4th-order reference model includes an at least 5th-order reference model for fine interpolation.
3. The method according to claim 1, further comprising the step of:
deriving the axial nominal position angle, the axial nominal rotation speed value, and the axial nominal drive torque value from derivatives averaged over one interpolation interval.
4. The method according to claim 3, further comprising the steps of:
transferring integrals required for averaging the derivatives directly from the reference model;
summing individual contributions of all polynomials to a total integral of the motion of the multiple-mass system; and
forming a difference between the sums over one interpolation interval.
5. The method according to claim 3, wherein the multiple-mass system includes at least one of a numerically controlled machine tool and a robot.
6. A control structure for a feed-forward torque control of an elastic and oscillating multiple-mass system, comprising:
an at least 4th-order reference model for a motion control, the reference model for generating parameters for impressing nominal motion states;
a nominal position path for impressing axial nominal position angles in an interpolation cycle, the nominal position angles being derived as a function of the reference model;
a feed-forward rotation speed control path for impressing axial nominal rotation speed values in the interpolation cycle, the axial nominal rotation speed values being derived as a function of the reference model;
a feed-forward torque control path for impressing axial nominal drive torque values in the interpolation cycle, the axial nominal drive torque values being derived as a function of the reference model; and
an arrangement for applying disturbance compensations values to the feed-forward torque control path, the disturbance values compensating for a spring torque which causes oscillations and is associated with a most pronounced natural frequency of the multiple-mass system.
7. The control structure according to claim 6, further comprising:
a fine interpolator interpolating the axial nominal position angles, the axial nominal rotation speed values, and the axial nominal drive torque values from input values averaged over one interpolation interval.
8. The control structure according to claim 6, wherein the multiple-mass system includes at least one of a numerically controlled machine tool and a robot.
US09/284,146 1996-10-08 1996-10-08 Method and control structure for controlling moments in numerically controlled elastic (and therefore oscillation-capable) multiple mass systems Expired - Fee Related US6341244B1 (en)

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/DE1996/001925 WO1998015880A1 (en) 1996-10-08 1996-10-08 Method and control structure for controlling moments in numerically controlled elastic (and therefore oscillation-capable) multiple mass systems

Publications (1)

Publication Number Publication Date
US6341244B1 true US6341244B1 (en) 2002-01-22

Family

ID=6918398

Family Applications (1)

Application Number Title Priority Date Filing Date
US09/284,146 Expired - Fee Related US6341244B1 (en) 1996-10-08 1996-10-08 Method and control structure for controlling moments in numerically controlled elastic (and therefore oscillation-capable) multiple mass systems

Country Status (6)

Country Link
US (1) US6341244B1 (en)
EP (1) EP0931283B1 (en)
KR (1) KR20000048977A (en)
AT (1) ATE199787T1 (en)
DE (1) DE59606606D1 (en)
WO (1) WO1998015880A1 (en)

Cited By (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6611122B2 (en) * 2001-02-02 2003-08-26 Siemens Aktiengesellschaft Method of control and control structure for the movement control, pre-control and fine interpolation of objects in a speed controller clock which is faster than the position controller clock
US6677721B2 (en) * 2001-02-02 2004-01-13 Siemens Aktiengesellschaft Method of control and control structure for the movement control, pre-control and fine interpolation of objects in a speed controller clock which is faster than the position controller clock
US6774598B1 (en) 1999-09-08 2004-08-10 Dr. Johannes Heidenhain Gmbh Method and circuitry for producing nominal position values for a closed loop position control of a numerically continuous-path controlled machine
US20050092817A1 (en) * 2003-10-31 2005-05-05 Baumann John A. Clamping apparatus and methods for manufacturing
US20060138975A1 (en) * 2004-12-07 2006-06-29 Lim Eul G Mobile system and driving method thereof
US20060254038A1 (en) * 2005-05-11 2006-11-16 The Boeing Company Systems and methods for verifying a pre-programmed materials processing path
EP1785792A1 (en) * 2005-11-11 2007-05-16 C.C.M. Beheer B.V. Method and system for control of a compliant system
US20150367511A1 (en) * 2013-02-15 2015-12-24 Kabushiki Kaisha Kobe Seiko Sho (Kobe Steel, Ltd.) Elastic deformation compensation control device for articulated robot
US10022866B2 (en) * 2014-06-02 2018-07-17 Kobe Steel, Ltd. Robot control device
US11334027B2 (en) * 2018-11-19 2022-05-17 B&R Industrial Automation GmbH Method and oscillation controller for compensating for oscillations of an oscillatable technical system

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102005032336B4 (en) * 2005-07-08 2008-09-04 Fachhochschule Aschaffenburg Method for influencing a control or for controlling a movement device and control or control component of a movement device
AT507257B1 (en) * 2008-09-10 2011-08-15 Engel Austria Gmbh HANDLING PART FOR INJECTION MOLDING MACHINE WITH ACTIVE CUSHIONING
KR102527293B1 (en) * 2016-11-08 2023-05-02 한국전기연구원 Apparatus and method for moving axis of based on variable impedance
DE102022129291A1 (en) 2022-11-07 2024-05-08 Arburg Gmbh + Co Kg Method for moving at least one end effector

Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4734847A (en) 1985-12-16 1988-03-29 Hunter L Wayne Microstepping motor controller circuit
EP0289151A2 (en) 1987-05-01 1988-11-02 General Motors Corporation Motion control apparatus having adaptive feedforward path tracking
US4925312A (en) * 1988-03-21 1990-05-15 Staubli International Ag Robot control system having adaptive feedforward torque control for improved accuracy
EP0406784A2 (en) 1989-07-05 1991-01-09 Advanced Data Processing Adp S.R.L. Electronic polynomial interpolation device for numeric controls of machine tools, particularly milling machines for the machining of dies, and machine comprising said device
EP0446362A1 (en) 1989-09-30 1991-09-18 Fanuc Ltd. Sliding mode control method
US5144211A (en) * 1989-01-31 1992-09-01 Staubli International Ag Multiaxis robot controller having workpoint torque control
WO1992015068A1 (en) 1991-02-15 1992-09-03 Incontrol, Inc. Computer control system for generating geometric designs
EP0604672A1 (en) 1992-12-23 1994-07-06 Siemens Aktiengesellschaft Method for feed-forward torque control of numerically controlled coupled drive systems
US5761444A (en) * 1995-09-05 1998-06-02 Intel Corporation Method and apparatus for dynamically deferring transactions
US6025679A (en) * 1998-05-06 2000-02-15 Raymond G. Harper Lighting space controller
US6041172A (en) * 1997-11-26 2000-03-21 Voyan Technology Multiple scale signal processing and control system

Patent Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4734847A (en) 1985-12-16 1988-03-29 Hunter L Wayne Microstepping motor controller circuit
EP0289151A2 (en) 1987-05-01 1988-11-02 General Motors Corporation Motion control apparatus having adaptive feedforward path tracking
US4925312A (en) * 1988-03-21 1990-05-15 Staubli International Ag Robot control system having adaptive feedforward torque control for improved accuracy
US5144211A (en) * 1989-01-31 1992-09-01 Staubli International Ag Multiaxis robot controller having workpoint torque control
EP0406784A2 (en) 1989-07-05 1991-01-09 Advanced Data Processing Adp S.R.L. Electronic polynomial interpolation device for numeric controls of machine tools, particularly milling machines for the machining of dies, and machine comprising said device
EP0446362A1 (en) 1989-09-30 1991-09-18 Fanuc Ltd. Sliding mode control method
WO1992015068A1 (en) 1991-02-15 1992-09-03 Incontrol, Inc. Computer control system for generating geometric designs
EP0604672A1 (en) 1992-12-23 1994-07-06 Siemens Aktiengesellschaft Method for feed-forward torque control of numerically controlled coupled drive systems
US5761444A (en) * 1995-09-05 1998-06-02 Intel Corporation Method and apparatus for dynamically deferring transactions
US6041172A (en) * 1997-11-26 2000-03-21 Voyan Technology Multiple scale signal processing and control system
US6025679A (en) * 1998-05-06 2000-02-15 Raymond G. Harper Lighting space controller

Cited By (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6774598B1 (en) 1999-09-08 2004-08-10 Dr. Johannes Heidenhain Gmbh Method and circuitry for producing nominal position values for a closed loop position control of a numerically continuous-path controlled machine
US6677721B2 (en) * 2001-02-02 2004-01-13 Siemens Aktiengesellschaft Method of control and control structure for the movement control, pre-control and fine interpolation of objects in a speed controller clock which is faster than the position controller clock
US6611122B2 (en) * 2001-02-02 2003-08-26 Siemens Aktiengesellschaft Method of control and control structure for the movement control, pre-control and fine interpolation of objects in a speed controller clock which is faster than the position controller clock
US20050092817A1 (en) * 2003-10-31 2005-05-05 Baumann John A. Clamping apparatus and methods for manufacturing
US7404512B2 (en) 2003-10-31 2008-07-29 The Boeing Company Clamping apparatus and methods for manufacturing
US20060138975A1 (en) * 2004-12-07 2006-06-29 Lim Eul G Mobile system and driving method thereof
US7112939B2 (en) * 2004-12-07 2006-09-26 Electronics And Telecommunications Research Institute Mobile system and driving method thereof
US7356897B2 (en) 2005-05-11 2008-04-15 The Boeing Company Systems and methods for verifying a pre-programmed materials processing path
US20060254038A1 (en) * 2005-05-11 2006-11-16 The Boeing Company Systems and methods for verifying a pre-programmed materials processing path
WO2007054185A1 (en) * 2005-11-11 2007-05-18 C.C.M. Beheer B.V. Method and system for control of a compliant system
EP1785792A1 (en) * 2005-11-11 2007-05-16 C.C.M. Beheer B.V. Method and system for control of a compliant system
US20080288114A1 (en) * 2005-11-11 2008-11-20 C.C.M. Beheer B.V. Method and System for Control of a Compliant System
US20150367511A1 (en) * 2013-02-15 2015-12-24 Kabushiki Kaisha Kobe Seiko Sho (Kobe Steel, Ltd.) Elastic deformation compensation control device for articulated robot
EP2957395A4 (en) * 2013-02-15 2016-11-02 Kobe Steel Ltd Control device for compensation of elastic deformation of articulated robot
US9597800B2 (en) * 2013-02-15 2017-03-21 Kobe Steel, Ltd. Elastic deformation compensation control device for articulated robot
US10022866B2 (en) * 2014-06-02 2018-07-17 Kobe Steel, Ltd. Robot control device
US11334027B2 (en) * 2018-11-19 2022-05-17 B&R Industrial Automation GmbH Method and oscillation controller for compensating for oscillations of an oscillatable technical system

Also Published As

Publication number Publication date
DE59606606D1 (en) 2001-04-19
EP0931283B1 (en) 2001-03-14
KR20000048977A (en) 2000-07-25
WO1998015880A1 (en) 1998-04-16
ATE199787T1 (en) 2001-03-15
EP0931283A1 (en) 1999-07-28

Similar Documents

Publication Publication Date Title
US6341244B1 (en) Method and control structure for controlling moments in numerically controlled elastic (and therefore oscillation-capable) multiple mass systems
EP0280324B1 (en) Nonlinear control unit for a multi-degree-of freedom manipulator
Feliu et al. Modeling and control of single-link flexible arms with lumped masses
US5049796A (en) Robust high-performance control for robotic manipulators
Kamnik et al. Application of model reference adaptive control to industrial robot impedance control
EP0289151B1 (en) Motion control apparatus having adaptive feedforward path tracking
Grotjahn et al. Model-based feedforward control in industrial robotics
EP0321579A1 (en) Articulated robot controller
KR101688344B1 (en) Weaving control device of multi-joint robot
Wells et al. Feedforward and feedback control of a flexible robotic arm
EP1023973B1 (en) Robot control method and device
JP4639417B2 (en) Robot control device
JPS61248104A (en) Manipulator controlling device
Tourassis Principles and design of model-based robot controllers
JPS60263206A (en) Control device of manipulator
JP2003340755A (en) Gain setting method in controller for servo motor, method for verifying effectiveness of the controller, and robot control method
JPH0392911A (en) Robot control method for sliding mode control
JPH08234801A (en) Apparatus and method for control for motor-driven joint arm
JPH07121239A (en) Control method for robot device
Liu A comparison of controller design and simulation for an industrial manipulator
JP4119011B2 (en) Control device
Murphy et al. Experimental evaluation of two forms of manipulator adaptive control
JP3582541B2 (en) Positioning control method by sliding mode control
Goor A new approach to robot control
Hamad Modelling and feed-forward control of robot arms with flexible joints and flexible links

Legal Events

Date Code Title Description
AS Assignment

Owner name: SIEMENS AKTIENGESELLSCHAFT, GERMANY

Free format text: ASSIGNMENT OF ASSIGNORS INTEREST;ASSIGNOR:PAPIERNIK, WOLFGANG;REEL/FRAME:010006/0872

Effective date: 19990204

FPAY Fee payment

Year of fee payment: 4

FPAY Fee payment

Year of fee payment: 8

REMI Maintenance fee reminder mailed
LAPS Lapse for failure to pay maintenance fees
STCH Information on status: patent discontinuation

Free format text: PATENT EXPIRED DUE TO NONPAYMENT OF MAINTENANCE FEES UNDER 37 CFR 1.362

FP Lapsed due to failure to pay maintenance fee

Effective date: 20140122