US6020706A - Method of and apparatus for controlling a servomotor - Google Patents

Method of and apparatus for controlling a servomotor Download PDF

Info

Publication number
US6020706A
US6020706A US09/043,635 US4363598A US6020706A US 6020706 A US6020706 A US 6020706A US 4363598 A US4363598 A US 4363598A US 6020706 A US6020706 A US 6020706A
Authority
US
United States
Prior art keywords
movable part
servomotor
acceleration
motion command
command
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/043,635
Other languages
English (en)
Inventor
Yasusuke Iwashita
Hiroyuki Kawamura
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.)
Fanuc Corp
Original Assignee
Fanuc 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 Fanuc Corp filed Critical Fanuc Corp
Assigned to FANUC LTD. reassignment FANUC LTD. ASSIGNMENT OF ASSIGNORS INTEREST (SEE DOCUMENT FOR DETAILS). Assignors: IWASHITA, YASUSUKE, KAWAMURA, HIROYUKI
Application granted granted Critical
Publication of US6020706A publication Critical patent/US6020706A/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00—Programme-control systems
    • G05B19/02—Programme-control systems electric
    • G05B19/18—Numerical 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/19—Numerical 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
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/41—Servomotor, servo controller till figures
    • G05B2219/41024—High gain for low command speed, torque or position error equals or near zero
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/42—Servomotor, servo controller kind till VSS
    • G05B2219/42074—Position feedback and speed feedback, speed measured with tacho
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
    • Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
    • Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]

Definitions

  • the present invention relates to a method of controlling a servomotor for driving a feed shaft of a machine tool, etc., and more specifically, to a servomotor control method for preventing an overshoot during a positional feedback control in which the position of a movable part driven by the feed shaft is detected by a position detector such as a scale detector.
  • the output torque of a servomotor is reduced by decreasing a value of an integrator in a velocity loop when a position deviation becomes close to "0" (i.e., a movable part of the machine comes close to a commanded position), to thereby reduce the overshoot.
  • the position of the movable part driven by the feed shaft is detected by a position detector such as a scale detector for performing a positional feedback control based on the detected position.
  • a mechanical system between the servomotor and the position detector such as a scale detector may have an insufficient rigidity. If so, then the servomotor will, due to the torsion of the mechanical system, advance too much by an amount corresponding to the torsion at the time when the position deviation has become close to "0" and the movable part has reached the commanded position. That is, when the rigidity of the mechanical system between the servomotor and the position detector is insufficient, the movable part is driven while the mechanical system is distorted.
  • the servomotor actually takes a position which makes the movable part to advance beyond the commanded target position by the amount corresponding to the torsion of the mechanical system.
  • the position deviation becomes "0" and the positioning is completed to stop the rotation of the servomotor, the torsion of the mechanical system is released gradually, causing the mechanical movable part to move further forward by the amount corresponding to the torsion of the mechanical system (in the same direction as it has been moving), thereby to overshoot the commanded target position.
  • the position deviation increases.
  • the servomotor moves in the opposite direction, so that the movable part is positioned at the commanded target position.
  • the movable part tends to overshoot the commanded position due to the torsion of the movable part.
  • An object of the present invention is to prevent an overshoot of a movable part of a machine or to reduce an overshooting amount when positional control is performed in a full-closed loop.
  • a servomotor control method of the present invention comprises the steps of: detecting a position of a movable part of a machine, which is driven by a servomotor through a mechanical system; controlling a position of the movable part using a motion command distributed from a numerical control device and the detected position of the movable part by a feedback control system including a position loop; and positioning the movable part so that torsion of the mechanical system between the servomotor and the movable part is released by reducing a torque command for the servomotor for a period immediately before termination of the motion command inputted to the position loop.
  • the torque command for the servomotor is reduced when an input to the acceleration/deceleration processing section becomes zero.
  • the acceleration/deceleration processing section is of a bell type composed of first and second acceleration/deceleration processing sections
  • the torque command for the servomotor is reduced when an output of the first acceleration/deceleration processing section becomes zero.
  • a signal indicating that it is time immediately before termination of the motion command is delivered at a predetermined time before the motion command terminates or when the remaining amount of the motion command becomes a predetermined value or smaller, and the torque command for the servomotor is reduced when the signal is delivered.
  • the value of an integrator in a velocity loop of the feedback control system is decreased and/or a torque limit value of a torque limit circuit for limiting the torque command is decreased.
  • an integral value for the present processing period of the position and velocity feedback control is obtained using a product of an integral value in the last processing period and a predetermined constant which is equal to or larger than 0 but smaller than 1. This means that the integration performed in the velocity loop is changed to an incomplete integration.
  • the predetermined constant is changed to a value which is larger than the predetermined value but smaller than 1, to thereby gradually increase the torque command.
  • FIG. 1 is a flowchart of processing to be performed in each period of position and velocity loop processing according to a first embodiment of the present invention
  • FIG. 2 is a flowchart of processing to be performed in each period of position and velocity loop processing according to a second embodiment of the present invention
  • FIG. 3 is a block diagram showing essential elements of a servo control system for performing a servomotor control method according to the first embodiment of the present invention
  • FIGS. 4a through 4d are diagrams showing relation among a motion command, outputs of acceleration/deceleration processing and an output of an integrator according to the first embodiment
  • FIG. 5 is a block diagram of control hardware for performing the present invention.
  • FIG. 6 is a graph showing a result of an experiment on positioning control according to a conventional method.
  • FIG. 7 is a graph showing a result of an experiment on positioning control according to the present invention.
  • FIG. 3 is a block diagram showing essential elements of a servo control system according to a first embodiment of the present invention.
  • a bell-type acceleration/deceleration process is composed of two linear acceleration/deceleration processing sections. That first and second acceleration/deceleration processing sections, is 9a and 9b are adopted for the acceleration/deceleration processing.
  • a motion command P0 distributed from a control device such as a CNC (computerized numerical control) device is inputted to the first acceleration/deceleration processing section 9a.
  • An output P1 of the first acceleration/deceleration processing section 9a is inputted to the second acceleration/deceleration processing section 9b to obtain an output P2 of the second processing section 9b.
  • the output P2 of the second acceleration/deceleration processing section 9b which serves as a motion command for a position loop processing, is inputted in an error counter 11 for addition. Meanwhile a position feedback value Pf from a detector, such as a scale attached to a movable part of the machine, is inputted to the error counter 11 for subtraction, whereby a position deviation is obtained.
  • the position deviation stored in the error counter 11 is multiplied by a position loop gain Kp to obtain a velocity command Vc, and a velocity feedback value Vf from a detector, such as a scale, is subtracted from the velocity command Vc to obtain a velocity deviation.
  • the product of a value obtained by integrating the velocity deviation by an integrator 10 and an integral gain k1 is added to the product of the velocity deviation and a proportional gain to obtain a torque command Tc, thereby executing PI (proportional-plus-integral) controlled velocity loop processing.
  • the torque command Tc obtained by the velocity loop process is delivered, through a torque limit circuit 12 and as a torque command Tc' not exceeding a predetermined value, to an electric current loop to perform a current loop process (not shown) to drive a servomotor and thereby drive the mechanical movable part.
  • the servo control process of the present embodiment is substantively the same as that of conventional systems.
  • the present embodiment differs from the conventional system in that the value in the integrator 10 is reduced for a period immediately before the motion command inputted to the error counter 11 becomes "0".
  • the integration to be performed in the integrator 10 is changed to incomplete integration, so that a coefficient of a smaller value can be used (from 0 to a value less than 1).
  • FIGS. 4a through 4d are time charts respectively showing states of the input and output of the first and second acceleration/deceleration processing sections 9a and 9b and a state of the integrator 10 in the positioning control.
  • the output P1 of the first acceleration/deceleration processing section 9a decreases linearly (see FIG. 4b).
  • the output P1 of the first acceleration/deceleration processing section 9a is inputted to the second acceleration/deceleration processing section 9b, and the output P2 of the second acceleration/deceleration processing section 9b decreases smoothly as shown in FIG. 4c.
  • the integrator 10 performs a normal integration while the output P1 of the first acceleration/deceleration processing section is not "0". However, when the output P1 becomes "0", the integrator 10 shifts to an incomplete integration so that an integral value close to "0" is outputted. When the output P2 of the second acceleration/deceleration processing section 9b becomes “0", the integrator 10 starts to slightly increase the coefficient of the incomplete integration, to thereby gradually increase the output (see FIG. 4d).
  • the output of the integrator 10 is set to a small value, to thereby decrease a value of the torque command Tc. Further, the torque command Tc is limited to a small value by the torque limit circuit 12.
  • the output torque of the servomotor is decreased so that the torsion of the mechanical system between the servomotor and the mechanical movable part is released.
  • the value of position deviation stored in the error counter 11 becomes nearly "0" to complete the positioning, the torsion of the mechanical system has almost been vanished, so that the mechanical movable part is positioned at a commanded position without overshooting.
  • FIG. 5 is a block diagram showing essential elements of a drive control system for a servomotor of a machine tool and the like for performing the present embodiment.
  • a computerized numerical control (CNC) device 1 provided as a control device for controlling a machine tool and the like, distributes a motion command to each feed shaft of the machine tool and the like according to an operation program and the like.
  • a shared RAM 2 is provided for mediating information between a processor of the CNC 1 and a processor of a digital servo circuit 3, delivers, on one hand, data such as a motion command written by the CNC 1 to the processor of the digital servo circuit 3.
  • the RAM 2 delivers alarm information and the like written by the processor of the digital servo circuit 3 to the host processor of the CNC 1.
  • the digital servo circuit 3 in the form of a digital signal processor (DSP), includes a processor, a ROM, a RAM, etc., and controls the servomotor of each feed shaft of the machine tool and the like.
  • Reference numeral 4 designates a servo amplifier in the form of a transistor inverter
  • reference numeral 5 designates a servomotor.
  • a position and velocity detector 8 To a mechanical movable part 7, which is driven by the servomotor 5 through a feed shaft 6, is attached a position and velocity detector 8, such as a scale and the like.
  • a signal from the position and velocity detector 8 (information of position Pf and velocity Vf) is fed back to the digital servo circuit 3. Since the structure of the control system shown in FIG. 5 is the same as that of conventional servo control systems which perform control in the full-closed loop mode, details are omitted.
  • FIG. 1 is a flowchart of processing to be performed by the processor of the digital servo circuit 3 in each period of position and velocity loop processing according to the present embodiment.
  • the processor of the digital servo circuit 3 reads the distributed motion command amount supplied from the CNC 1 through the shared RAM 2, obtains the command amount P0 in each period of position and velocity loop processing (Step S1), and performs a bell-type acceleration/deceleration processing similar to that of conventional cases. That is, the processing by the first acceleration/deceleration processing section is performed based on the motion command amount P0 to output the command amount P1, and then the processing by the second acceleration/deceleration processing section is performed using the command amount P1 to obtain the command amount P2 (Step S2). Then, it is determined whether or not each command amount P0, P1 and P2 is "0" (Steps S3 through S5).
  • Step S17 the torque limit value TL is set to a normal limit value (high-level value) TLH and a coefficient k3 of incomplete integration (described later) is set to a predetermined parameter value ⁇ . Then, the control proceeds to Step S7.
  • Step S7 "1" is added to a counter C.
  • the counter C is set to the countable maximum value at the time of its initialization, performed when the power is turned on, and is designed so that, when it counts to that maximum value, it keeps that value instead of counting up.
  • Step S9 a velocity feedback value Vf, supplied from the scale 8 is read (Step S9), and it is determined whether or not the counter C shows a value not exceeding a predetermined value C0 (Step S10).
  • the counter C is set to the maximum value, so that the value of the counter C is larger than the predetermined value C0. Therefore, the procedure proceeds from Step S10 to Step S12, and processing of the integrator 10 is performed.
  • a complete integration is performed in a manner that the velocity deviation, the value obtained by subtracting the velocity feedback value Vf read at Step S9 from the velocity command Vc obtained at Step S8, is multiplied by the integral gain k1, and the product is added to the integral value Sum, stored in the register. Then, the product of the velocity deviation (Vc-Vf) and the proportional gain k2 is added to the integral value Sum to obtain a torque command Tc (Step S13).
  • it is determined whether or not the torque command Tc exceeds the predetermined torque limit value TL (Step S14). If the torque command Tc does not exceed the torque limit value TL, the torque command Tc is delivered to the current loop (Step S16). If the torque command Tc exceeds the torque limit value TL, the value of torque command Tc is replaced by the torque limit value TL (Step S15) and delivered to the current loop, to bring the processing for the present period of position and velocity loop processing to an end.
  • Steps S1 through S5, S17, S7 through S10 and S12 through S16 is performed repeatedly in each period.
  • Step S17 After performing the processing of Steps S1 through S3.
  • the processing of Steps S7 through S10 and Steps S12 through 16 is then preformed as described above, to end the position and velocity loop processing for the present period.
  • Step S3 the procedure proceeds from Step S3 to Step S4 to determine whether or not the output P1 of the first acceleration/deceleration processing section is "0". If the output P1 is not "0", the processing of Step S17 and Step S7 and downward as described above is performed.
  • Step S4 the procedure proceeds from Step S4 to Step S5 to determine whether or not the command amount P2, which is the output of the second acceleration/deceleration processing section, is "0".
  • Step S6 Since the command amount P2 is at first not "0", the procedure proceeds from Step S5 to Step S6, where the counter C is reset to "0" and the coefficient k3 of incomplete integration is set to a predetermined parameter value ⁇ . Further, the torque limit value TL is set to a lower-level value TLL, which is so determined as to release and remove the torsion of the mechanical system which has occurred when positioning is completed.
  • the predetermined values TLL and TLH, to which the torque limit value TL is selectively set have the relation of TLL ⁇ TLH
  • the parameter values ⁇ and ⁇ , to which the coefficient k3 of incomplete integration is selectively set have the relation of 0 ⁇ 1.
  • Step S6 After the processing of Step S6 is performed, the processing of Step S7 and the subsequent steps is performed.
  • the set value in the counter C is determined to be less than the set value C0 at Step S10, so that the control proceeds to Step S11, and the incomplete integration is performed. That is, to obtain the integral value sum of the present period, the product of the velocity deviation (Vc-Vf) and the integral gain k1 is added to the product of the integral value Sum, which is stored in the register, and the coefficient k3, which is set to ⁇ at Step S6.
  • the parameter value ⁇ is predetermined to be among small values including "0".
  • the integral value Sum of the present period is [k1(Vc-Vf)], which is a very small value.
  • the integral value is very small in the section where the output P1 of the first acceleration/deceleration processing section is "0" and the output P2 of the second acceleration/deceleration processing section is not "0".
  • Step S13 the torque command Tc is obtained by the velocity loop processing based on the incomplete integration, so that it has a small value.
  • Step S10 the control proceeds from Step S10 to Step S11, where the incomplete integration is performed to obtain the torque command Tc.
  • the torque command Tc is limited to the value not exceeding the torque limit value TL, which is set to the low-level toque limit value TLL, the output torque of the servomotor is made small. Thereby, the torsion of the mechanical system, such as the feed shaft 6 which lies between the servomotor 5 and the mechanical movable part 7, is gradually canceled.
  • Step S5 when the commanded amount P2 from the second acceleration/deceleration processing section also becomes "0", the control proceeds from Step S5 to Step S17, where the torque limit value TL is set to a high-level normal value TLH, and the coefficient k3 of the incomplete integration is set to ⁇ (Step S17). Then, the processing of Step S7 and the following steps is performed in each period. In this case, since the processing of Step S6 is skipped, the counter C is counted up in each period, and while the value of the counter C does not exceed the predetermined value C0, the control proceeds from Step S10 to Step S11, where the incomplete integration is performed with the coefficient k3 set to ⁇ .
  • the torque command Tc takes a small value so that the output torque of the servomotor 5 is small. Therefore, the servomotor 5 can not follow up the motion command, causing the position deviation in the error counter 11 to increase. Therefore, the velocity command Vc corresponding to the position deviation is obtained at Step S8, and the velocity loop processing is performed based on the obtained velocity command Vc. Since the integration performed in that velocity loop processing is the incomplete integration in Step S11, the integral value Sum increases by a small amount, that is, increases gradually. As a result, the torque command value Tc also increases gradually, so that the position deviation stored in the error counter 11 diminishes gradually, and the mechanical movable part 7 moves to the designated target position.
  • Step S10 When the value of the counter C exceeds the predetermined value C0, the control proceeds from Step S10 to Step S12, where the normal, complete integration is performed. Thereafter, the processings of Steps S1 through S5, S17, S7 through S10, S12 and S13 through S16 are performed in each period to complete the positioning to the commanded position. When a new motion command is outputted from the CNC 1, the processing as described above is performed again.
  • the bell-type acceleration/deceleration processing is adopted as the acceleration/deceleration processing.
  • the point at which the output P1 of the first acceleration/deceleration processing section 9a becomes "0" and the output P2 of the second acceleration/deceleration processing section 9b is not "0" is made to be recognized to be the point slightly before the end of the motion command.
  • the coefficient k3 of the incomplete integration is changed to a smaller value (for example, "0"), and the torque limit value TL is also made smaller.
  • Step S2 In the case in which the bell-type acceleration/deceleration processing is not employed, but the normal acceleration/deceleration processing (having only one stage thereof) is performed, the output torque of the servomotor is diminished from the point at which the input of the acceleration/deceleration processing is "0" and the output thereof is not "0".
  • the output of the acceleration/deceleration processing becomes "0"
  • the incomplete integration with a little larger coefficient k3 is preformed until a time determined by the predetermined value C0 has passed. That is, in the flowchart of FIG. 1, acceleration/deceleration processing of only one stage is performed in Step S2, and, using the obtained output, for example, as P2, the control proceeds from Step S3 to Step S5 skipping Step S4.
  • the present invention is applicable either to the case in which the acceleration/deceleration processing is not performed or to the case in which the acceleration/deceleration processing is performed but the input and output thereof are not utilized.
  • An example of such cases is shown by the flowchart of FIG. 2. Since the example shown in FIG. 2 is the case in which the acceleration/deceleration processing is not performed, the processing of Step S2 in FIG. 1 is not included.
  • the processing of Step S1 in FIG. 1 corresponds to and is the same as the processing of Step T1 in FIG. 2.
  • the processings of Steps S3 through S5 in FIG. 1 correspond to the processing of Step T2 in FIG. 2, though they are different only with respect to this point.
  • Step S7 and downward in FIG. 1 corresponds to and is the same as the processing of Step T4 and downward in FIG. 2.
  • the CNC 1 sets a flag F to "1", at a predetermined number of periods before the distribution of the motion command is completed, and sets the flag F to "0" when the distribution is completed.
  • the CNC 1 reads the command velocity and the motion command amount from an operation program, the number of distribution periods through which the motion command amount is to be outputted is calculated.
  • the period in which the distribution of the motion command is completed can be known, and the period which is a predetermined number of periods before the period in which the distribution is completed can be also known.
  • the flag F is set up.
  • the point at which the flag F is to be set up can be determined based on the remainder of the motion command amount.
  • a reference value for remainder of the motion amount may be predetermined so that when the remainder of the motion command amount has become smaller than the reference value while the CNC outputs the motion command in each distribution period, the flag F is set up.
  • Step T1 The motion command P0 in the position and velocity loop processing period is obtained based on the motion command amount distributed by the CNC 1 (Step T1). Then, it is determined whether or not the flag F is set to "1" in the shared RAM (Step S2), and if the flag is not set to "1", the procedure proceeds to Step T14, where the torque limit value TL is set to the normal high-level value TLH, and the coefficient k3 of the incomplete integration is set to ⁇ , which is the same processing as in Step S17 in FIG. 1. Then the processing of Step T4 and subsequent steps, which are the same as the processing of Step S7 and subsequent steps in FIG. 1, is performed.
  • Step T2 when the processing progresses to a point, which is a predetermined number of periods before the period at which the distribution of the motion command is completed, the flag F is set to "1".
  • Step T3 the same processing as that of Step S6 in FIG. 1 is performed. That is, the counter C is reset to "0", the coefficient k3 of the incomplete integration is set to ⁇ , and the torque limit value TL is set to the low-level value TLL. Then, the processing of Step T4 and the subsequent steps is performed.
  • the incomplete integration at Step T10 is performed with such coefficient k3 of the incomplete integration that is set to a small parameter value ⁇ (for example, "0"), to thereby keep the integral value Sum at a small value.
  • the torque command Tc is limited to the low-level torque limit value TLL or under (Steps T11 and T12) to thereby drive the servomotor. Therefore, the output torque of the servomotor 5 is kept at a low level, whereby the torsion of the mechanical system (6) is canceled.
  • Step T14 When the distribution of the motion amount is completed, and the flag F is set to "0", the torque limit value TLH, is reset to the normal, high-level value TLH and the coefficient of the incomplete integration is set to ⁇ (Step T14).
  • the incomplete integration is performed with the coefficient k3 until the value of the counter C exceeds the predetermined value C0 (Step T8), so that the output torque of the servomotor 5 is increased gradually, avoiding a rapid increase in the output torque.
  • the normal complete integration is performed (Step T9) to position the mechanical movable part 7 at the commanded position.
  • the output torque of the servomotor is decreased by decreasing the integral value obtained by integration in the velocity loop and by also limiting the value of the torque command to a value smaller than the torque limit value.
  • the output torque of the servomotor may, however, be decreased either by decreasing the integral value or by decreasing torque limit value to a smaller value.
  • the torque limit value is reduced to a smaller value from the point, which is a predetermined time before the point at which the whole motion command has been inputted in the servo control system (servo circuit)(the whole motion command has been inputted in the error counter 11), until the point at which the input of the whole motion command is completed.
  • the torque limit value is increased to a little larger value or is increased gradually, before a predetermined time (predetermined value C0) has passed.
  • a predetermined time predetermined value C0
  • the torque limit value is reset to a normal large torque limit value.
  • FIGS. 6 and 7 show the result of an experiment performed for verifying the effect of the present invention.
  • FIG. 6 shows the result of an experiment wherein the positioning is performed not by applying the present invention but by a conventional method
  • FIG. 7 shows the result of an experiment wherein the positioning is performed by applying the first embodiment of the present invention.
  • the abscissa represents time
  • the ordinate represents the position of the mechanical movable part, wherein "0" represents the target position
  • the feed velocity is set to 10 mm/min.
  • the time constant of the acceleration/deceleration processing section is set to 64 ms, that of the first acceleration/deceleration processing section and that of second acceleration/deceleration processing section being 32 ms respectively.
  • overshooting of 0.6 mm or so occurs, while in the case of FIG. 7 where the present invention is applied, overshooting is only 0.2 mm or so, thereby indicating that overshooting can be reduced by the present invention.
  • the positioning is performed in a manner that the torsion of a mechanical system such as a feed shaft between the servomotor and the mechanical movable part can be reduced. Therefore, overshooting can be prevented or reduced.

Landscapes

  • Engineering & Computer Science (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position Or Direction (AREA)
  • Control Of Electric Motors In General (AREA)
US09/043,635 1996-07-24 1997-07-24 Method of and apparatus for controlling a servomotor Expired - Fee Related US6020706A (en)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
JP21416296A JP3628119B2 (ja) 1996-07-24 1996-07-24 サーボモータの制御方法
JP8-214162 1996-07-24
PCT/JP1997/002572 WO1998003900A1 (fr) 1996-07-24 1997-07-24 Procede de commande d'un servomoteur

Publications (1)

Publication Number Publication Date
US6020706A true US6020706A (en) 2000-02-01

Family

ID=16651270

Family Applications (1)

Application Number Title Priority Date Filing Date
US09/043,635 Expired - Fee Related US6020706A (en) 1996-07-24 1997-07-24 Method of and apparatus for controlling a servomotor

Country Status (5)

Country Link
US (1) US6020706A (fr)
EP (1) EP0852347B1 (fr)
JP (1) JP3628119B2 (fr)
DE (1) DE69736799T2 (fr)
WO (1) WO1998003900A1 (fr)

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20040135536A1 (en) * 2003-01-07 2004-07-15 Fanuc Ltd. Controller
US20070141152A1 (en) * 2004-03-31 2007-06-21 Lintec Corporation Orally administered pharmaceutical composition
US20070202171A1 (en) * 2004-03-17 2007-08-30 Lintec Corporation Method Of Producing A Pharmaceutical Composition
EP1505463A3 (fr) * 2003-08-06 2009-01-07 Yamazaki Mazak Corporation Appareil de commande de position et méthode de commande de position pour des machines-outiles
EP2149829A1 (fr) 2008-07-30 2010-02-03 Neopost Technologies Contrôle de vitesse de servomoteur
US20100112015A1 (en) * 2001-04-24 2010-05-06 Lintec Corporation Orally administered agent and an orally administered agent/supporting substrate complex
US20100171458A1 (en) * 2006-09-28 2010-07-08 Mitsubishi Electric Corporation Servo controller
CN111095775A (zh) * 2017-09-14 2020-05-01 昕芙旎雅有限公司 同步电动机的控制装置及控制方法

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6429207B1 (en) 1997-11-21 2002-08-06 Nps Pharmaceuticals, Inc. Metabotropic glutamate receptor antagonists and their use for treating central nervous system diseases

Citations (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS576579A (en) * 1980-06-14 1982-01-13 Fuji Electric Co Ltd Controlling device for stopping at regular position
JPS579277A (en) * 1980-06-17 1982-01-18 Fuji Electric Co Ltd Constant position stop controlling device
JPS63123107A (ja) * 1986-11-12 1988-05-26 Fanuc Ltd 位置制御方式
JPS63273115A (ja) * 1987-04-30 1988-11-10 Fanuc Ltd サ−ボ制御回路
US4829219A (en) * 1986-11-20 1989-05-09 Unimation Inc. Multiaxis robot having improved motion control through variable acceleration/deceleration profiling
JPH01244512A (ja) * 1988-03-26 1989-09-28 Omron Tateisi Electron Co 可動体の位置決め制御方法
JPH0212507A (ja) * 1988-06-30 1990-01-17 Fanuc Ltd 速度制御装置
US4925312A (en) * 1988-03-21 1990-05-15 Staubli International Ag Robot control system having adaptive feedforward torque control for improved accuracy
US4994978A (en) * 1987-06-17 1991-02-19 Fanuc Ltd. Acceleration/deceleration control apparatus
JPH0392911A (ja) * 1989-09-06 1991-04-18 Fanuc Ltd スライディングモード制御によるロボット制御方法
JPH04184512A (ja) * 1990-11-20 1992-07-01 Fanuc Ltd サーボモータの制御方式
JPH04233608A (ja) * 1990-12-28 1992-08-21 Fanuc Ltd サーボモータの制御方法
US5221884A (en) * 1989-12-11 1993-06-22 Mitsubishi Denki K.K. Numerical control apparatus
US5589748A (en) * 1993-03-10 1996-12-31 Mitsubishi Denki Kabushiki Kaisha Position control system and position control method thereof
US5691615A (en) * 1992-07-17 1997-11-25 Fanuc Ltd. Adaptive PI control method

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5745602A (en) * 1980-09-01 1982-03-15 Fanuc Ltd Control system for industrial robot
JPS59189401A (ja) * 1983-04-13 1984-10-27 Fanuc Ltd 位置制御装置
JP2820820B2 (ja) * 1991-11-12 1998-11-05 ファナック株式会社 サーボモータの制御装置

Patent Citations (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS576579A (en) * 1980-06-14 1982-01-13 Fuji Electric Co Ltd Controlling device for stopping at regular position
JPS579277A (en) * 1980-06-17 1982-01-18 Fuji Electric Co Ltd Constant position stop controlling device
US4887015A (en) * 1986-11-12 1989-12-12 Fanuc Ltd. Position control system
JPS63123107A (ja) * 1986-11-12 1988-05-26 Fanuc Ltd 位置制御方式
US4829219A (en) * 1986-11-20 1989-05-09 Unimation Inc. Multiaxis robot having improved motion control through variable acceleration/deceleration profiling
US4914370A (en) * 1987-04-30 1990-04-03 Fanuc Ltd. Servo-control circuit
JPS63273115A (ja) * 1987-04-30 1988-11-10 Fanuc Ltd サ−ボ制御回路
US4994978A (en) * 1987-06-17 1991-02-19 Fanuc Ltd. Acceleration/deceleration control apparatus
US4925312A (en) * 1988-03-21 1990-05-15 Staubli International Ag Robot control system having adaptive feedforward torque control for improved accuracy
JPH01244512A (ja) * 1988-03-26 1989-09-28 Omron Tateisi Electron Co 可動体の位置決め制御方法
JPH0212507A (ja) * 1988-06-30 1990-01-17 Fanuc Ltd 速度制御装置
JPH0392911A (ja) * 1989-09-06 1991-04-18 Fanuc Ltd スライディングモード制御によるロボット制御方法
US5221884A (en) * 1989-12-11 1993-06-22 Mitsubishi Denki K.K. Numerical control apparatus
JPH04184512A (ja) * 1990-11-20 1992-07-01 Fanuc Ltd サーボモータの制御方式
JPH04233608A (ja) * 1990-12-28 1992-08-21 Fanuc Ltd サーボモータの制御方法
US5691615A (en) * 1992-07-17 1997-11-25 Fanuc Ltd. Adaptive PI control method
US5589748A (en) * 1993-03-10 1996-12-31 Mitsubishi Denki Kabushiki Kaisha Position control system and position control method thereof

Cited By (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20100112015A1 (en) * 2001-04-24 2010-05-06 Lintec Corporation Orally administered agent and an orally administered agent/supporting substrate complex
US8268333B2 (en) 2001-04-24 2012-09-18 Lintec Corporation Orally administered agent and an orally administered agent/supporting substrate complex
US20040135536A1 (en) * 2003-01-07 2004-07-15 Fanuc Ltd. Controller
US7030585B2 (en) * 2003-01-07 2006-04-18 Fanuc Ltd Controller
EP1505463A3 (fr) * 2003-08-06 2009-01-07 Yamazaki Mazak Corporation Appareil de commande de position et méthode de commande de position pour des machines-outiles
US20070202171A1 (en) * 2004-03-17 2007-08-30 Lintec Corporation Method Of Producing A Pharmaceutical Composition
US20070141152A1 (en) * 2004-03-31 2007-06-21 Lintec Corporation Orally administered pharmaceutical composition
US20100171458A1 (en) * 2006-09-28 2010-07-08 Mitsubishi Electric Corporation Servo controller
EP2149829A1 (fr) 2008-07-30 2010-02-03 Neopost Technologies Contrôle de vitesse de servomoteur
CN111095775A (zh) * 2017-09-14 2020-05-01 昕芙旎雅有限公司 同步电动机的控制装置及控制方法
CN111095775B (zh) * 2017-09-14 2023-04-21 昕芙旎雅有限公司 同步电动机的控制装置及控制方法

Also Published As

Publication number Publication date
DE69736799D1 (de) 2006-11-23
WO1998003900A1 (fr) 1998-01-29
EP0852347A4 (fr) 2000-11-29
DE69736799T2 (de) 2007-01-18
EP0852347B1 (fr) 2006-10-11
EP0852347A1 (fr) 1998-07-08
JPH1039932A (ja) 1998-02-13
JP3628119B2 (ja) 2005-03-09

Similar Documents

Publication Publication Date Title
EP0417312B1 (fr) Unite de commande a action directe pour servomoteurs
EP0089156B1 (fr) Méthode et dispositif pour la commande de l'accélération et de la décélération
EP1967924A1 (fr) Dispositif pour commander de manière synchrone plusieurs servo-moteurs
JP3129622B2 (ja) フルクローズド・ループ方式における象限突起補正方法
EP0922562B1 (fr) Procede d'asservissement de couple moteur pour presse et presse
EP0224589B1 (fr) Unite de commande d'entrainement pour une machine de moulage a injection entrainee par des servo-moteurs
US5986422A (en) Control mode changing over method for servo control system
US6020706A (en) Method of and apparatus for controlling a servomotor
JP2833730B2 (ja) 位置制御装置
US20050085939A1 (en) Numerical controller
GB2342468A (en) Synchronization control device for servomotors
EP0661615A1 (fr) Procede permettant la regulation souple d'un servomecanisme
EP0510212B1 (fr) Procede de commande de l'action directe d'un servomoteur
US4797835A (en) Model follower control apparatus
EP0378690A1 (fr) Dispositif de detection d'un ecart de position excessif dans un servosysteme
EP0583478B1 (fr) Procede de commande de servomoteurs
EP0604663A1 (fr) Procede d'estimation d'une inertie et d'un couple perturbateur et procede de detection d'une charge anormale
US6122998A (en) Force control method for a bar feeder of a lathe
EP0313662A1 (fr) Circuit de servocommande
EP0372082B1 (fr) Procede de retour au point d'origine
JPH06131050A (ja) サーボモータで駆動される可動部の衝突検出方法
JP3259736B2 (ja) 数値制御ネジ切り装置
JPH10105247A (ja) サーボモータのオーバーシュート防止方法
EP0556412B1 (fr) Procede de commande de l'avance directe d'un servomoteur
JP3541857B2 (ja) オーバーシュートレスオートチューニング方法

Legal Events

Date Code Title Description
AS Assignment

Owner name: FANUC LTD., JAPAN

Free format text: ASSIGNMENT OF ASSIGNORS INTEREST;ASSIGNORS:IWASHITA, YASUSUKE;KAWAMURA, HIROYUKI;REEL/FRAME:009377/0034

Effective date: 19980318

FEPP Fee payment procedure

Free format text: PAYER NUMBER DE-ASSIGNED (ORIGINAL EVENT CODE: RMPN); ENTITY STATUS OF PATENT OWNER: LARGE ENTITY

Free format text: PAYOR NUMBER ASSIGNED (ORIGINAL EVENT CODE: ASPN); ENTITY STATUS OF PATENT OWNER: LARGE ENTITY

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: 20120201