Position control apparatus and position control method

• US 6,889,115 B2
• Filed: 03/29/2002
• Issued: 05/03/2005
• Est. Priority Date: 03/30/2001
• Status: Active Grant

• Current Assignee: Toshiba Kikai Kabushiki Kaisha
• Original Assignee: Toshiba Kikai Kabushiki Kaisha
• Inventors: Fujita, Jun, Hamamura, Minoru, Shiba, Kazuhiro
• Primary Examiner(s): Picard, Leo
• Assistant Examiner(s): Ortiz Rodriguez, Carlos R.
• Application Number:
  US10/108,866
• Publication Number:
  US 20020151988A1
• Time in Patent Office: 1,131 Days
• Field of Search: 700/186, 700/188, 700/193, 700/195
• US Class Current: 700/186
• CPC Class Codes: G05B 19/404 characterised by control arrangements for compensation, e.g. for backlash, overshoot, tool offset, tool wear, temperature, machine construction errors, load, inertia G05B19/19, G05B19/41 take precedence
• CPC Class Codes: G05B 2219/41041 Compensation pulses as function of direction movement
• CPC Class Codes: G05B 2219/41045 For several modes and feed speeds, a table, registers for several backlash

Abstract

A position control apparatus and method has been devised which provides for an improved means of suppressing tracking error from a variable position reference occurring when a control object positioned via a transmission mechanism with mechanical transmission error resumes movement from a state stopped at a target position. A selection between two alternative tracking error compensating means within the control apparatus is made based on whether the detected position of the control object changes in a period after the control object stops and before the variable position reference is input again to a control deviation generating unit.

Claims

1. A position control apparatus for positioning a control object connected with a motor via a transmission mechanism so as to track a variable position reference varying with time, comprising:

a reference generating means for generating said variable position reference;

a control deviation generating means for generating control deviation of the control object based on said variable position reference and a detected position of said control object;

a servo control means for generating a control quantity to make said control object track said variable position reference based on said control deviation and controlling the driving of said motor;

a tracking error compensating means having a first and second tracking error compensating means of different modes for compensating for said control deviation so as to suppress tracking error of said control object from said variable position reference caused by mechanical transmission error of said transmission mechanism;

a compensation selecting means for selecting one of said first and second tracking error compensating means based on whether the detected position of said control object changes during a period after said control object stops at a target position and before a next variable position reference is inputted to said control deviation generating means; and

a compensation determining means for determining a compensation amount required for said second tracking error compensating means to perform compensation based on the detected position of said control object and a detected rotational position of said motor when said second tracking error compensating means is selected by said compensation selecting means.

2. A position control apparatus as set forth in claim 1, wherein said compensation determining means holds first and second compensation amounts corresponding to directions of movement of said control object and determines said first and second compensation amounts in accordance with a direction of change of the detected position of said control object.

3. A position control apparatus as set forth in claim 2, wherein said second tracking error compensating means selects one of said first and second compensation amounts determined by said compensation determining means and compensates for said control deviation in accordance with a feed direction of said next variable position reference.

4. A position control apparatus for positioning a control object connected with a motor via a transmission mechanism so as to track a variable position reference varying with time, comprising:

a reference generating means for generating said variable position reference;

a control deviation generating means for generating control deviation of the control object based on said variable position reference and a detected position of said control object;

a servo control means for generating a control quantity to make said control object track said variable position reference based on said control deviation and controlling the driving of said motor;

a tracking error compensating means having first and second tracking error compensating means of different modes for correcting a detected rotational position of said motor to be used to generate said control deviation so as to suppress tracking error of said control object from said variable position reference caused by mechanical transmission error of said transmission mechanism;

a compensation selecting means for selecting one of said first and second tracking error compensating means based on whether the detected position of said control object changes during a period after said control object stops at a target position and before a next variable position reference is inputted to said control deviation generating means; and

a compensation determining means for determining a compensation amount which said second tracking error compensating means requires to perform compensation based on the detected position of said control object and a detected rotational position of said motor when said second tracking error compensating means is selected by said compensation selecting means.

5. A position control apparatus as set forth in claim 4, wherein said compensation determining means holds first and second compensation amounts corresponding to directions of movement of said control object and determines said first and second compensation amounts in accordance with a direction of change of the detected position of said control object.

6. A position control apparatus as set forth in claim 5, wherein said second tracking error compensating means selects one of said first and second compensation amounts determined by said compensation determining means and corrects the detected rotational position of said motor to be used to generate said control deviation in accordance with a feed direction of said next variable position reference.

7. A position control apparatus for positioning a control object connected with a motor via a transmission mechanism so as to track a variable position reference varying with time, comprising:

a reference generating means for generating said variable position reference;

a control deviation generating means for generating control deviation of the control object based on said variable position reference and a detected position of said control object;

a servo control means for generating a control quantity to make said control object track said variable position reference based on said control deviation and controlling the driving of said motor;

a tracking error compensating means having a first and second tracking error compensating means of different modes for compensating for said control deviation so as to suppress tracking error of said control object from said variable position reference caused by mechanical transmission error of said transmission mechanism;

a compensation selecting means for selecting one of said first and second tracking error compensating means based on whether the detected position of said control object changes during a period after said control object stops at a target position and before a next variable position reference is inputted to said control deviation generating means; and

a compensation determining means for determining a compensation amount required for said second tracking error compensating means to perform compensation based on the detected position of said control object and a detected rotational position of said motor when said second tracking error compensating means is selected by said compensation selecting means;

wherein said first tracking error compensating means compensates for said control deviation so as to suppress said tracking error during a period after said next variable position reference is inputted and before said control object starts to move again;

wherein said second tracking error compensating means compensates for said control deviation so as to suppress said tracking error with a predetermined compensation amount in accordance with a feed direction of said variable position reference after said next variable position reference is inputted; and

wherein said compensation selecting means selects said first tracking error compensating means when the detected position of said control object does not change during a period after said control object stops at a target position and before said next variable position reference is inputted to said control deviation generating means and selects said second tracking error compensating means when the detected position of said control object changes during said period.

8. A position control apparatus as set forth in claim 7, wherein said compensation determining means holds first and second compensation amounts corresponding to directions of movement of said control object and determines said first and second compensation amounts in accordance with a direction of change of the detected position of said control object.

9. A position control apparatus as set forth in claim 8, wherein said second tracking error compensating means selects one of said first and second compensating amounts determined by said compensation determining means and compensates for said control deviation in accordance with a feed direction of said next variable position reference.

10. A position control apparatus for positioning a control object connected with a motor via a transmission mechanism so as to track a variable position reference varying with time, comprising:

a reference generating means for generating said variable position reference;

a control deviation generating means for generating control deviation of the control object based on said variable position reference and a detected position of said control object;

a servo control means for generating a control quantity to make said control object track said variable position reference based on said control deviation and controlling the driving of said motor;

a tracking error compensating means having first and second tracking error compensating means of different modes for correcting a detected rotational position of said motor to be used to generate said control deviation so as to suppress tracking error of said control object from said variable position reference caused by mechanical transmission error of said transmission mechanism;

a compensation selecting means for selecting one of said first and second tracking error compensating means based on whether the detected position of said control object changes during a period after said control object stops at a target position and before a next variable position reference is inputted to said control deviation generating means; and

a compensation determining means for determining a compensation amount which said second tracking error compensating means requires to perform compensation based on the detected position of said control object and a detected rotational position of said motor when said second tracking error compensating means is selected by said compensation selecting means;

wherein said first compensating means corrects the detected rotational position of said motor generating said control deviation so as to suppress said tracking error during a period after said next variable position reference is inputted and before said control object starts to move again;

wherein said second tracking error compensating means corrects the detected rotational position of said motor to be used to generate said control deviation so as to suppress said tracking error with a predetermined compensation amount in accordance with a feed direction of said variable position reference after said next variable position reference is inputted; and

wherein said compensation selecting means selects said first tracking error compensating means when the detected position of said control object does not changes during a period after said control object stops at a target position and before said next variable position reference is inputted to said control deviation generating means and selects said second tracking error compensating means when the detected position of said control object changes during said period.

11. A position control apparatus as set forth in claim 10, wherein said compensation determining means holds first and second compensation amounts corresponding to directions of movement of said control object and determines said first and second compensation amounts in accordance with a direction of change of the detected position of said control object.

12. A position control apparatus as set forth in claim 11, wherein said second tracking error compensating means selects one of said first and second compensation amounts determined by said compensation determining means and corrects the detected rotational position of said motor to be used to generate said control deviation in accordance with a feed direction of said next variable position reference.