Motor control apparatus for compensating reverse delay of motor

Abstract

A motor control apparatus includes an error calculation unit which calculates an error between a position of a movable unit and a position of a driven unit, a memory unit which memorizes the error in association with a torque command value as an initial error, and a compensation amountcompensation amount calculation unit which calculates a compensation amountcompensation amount for compensating an elastic deformation amount of an elastic factor between the movable unit and the driven unit. The compensation amountcompensation amount calculation unit calculates the compensation amountcompensation amount based on the initial error held by the memory unit, the torque command value held in association with the initial error, and a torque command value calculated by a torque command calculation unit when a motor rotates reversely.

Claims

1. A motor control apparatus including a movable unit driven by a motor and a driven unit driven by the movable unit, the motor control apparatus comprising: a torque command calculation unit configured to calculate a torque command value with respect to the motor; a first position detection unit configured to detect a position of the movable unit; a second position detection unit configured to detect a position of the driven unit; an error calculation unit configured to calculate an error between a first position detection value detected by the first position detection unit and a second position detection value detected by the second position detection unit; a memory unit configured to memorize the error calculated by the error calculation unit in association with the torque command value as an initial error; and a compensation amount calculation unit configured to calculate a compensation amount for compensating an elastic deformation amount of an elastic factor between the movable unit and the driven unit, wherein the compensation amount calculation unit calculates the compensation amount based on the initial error held by the memory unit, the torque command value held in association with the initial error, and a torque command value calculated by the torque command calculation unit when the motor rotates reversely.

2. The motor control apparatus according to claim 1, wherein the compensation amount calculation unit calculates a spring constant of the elastic factor from the initial error held by the memory unit and the torque command value held in association with the initial error, and calculates the compensation amount by subtracting a current error from a value obtained by dividing a torque command value calculated by the torque command calculation unit when the motor rotates reversely by the spring constant.

3. The motor control apparatus according to claim 1, wherein the memory unit memorizes the error and the torque command value as the initial error when the movable unit moves while accelerating or at a constant speed.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

(1) FIG. 1 is a functional block diagram of a motor control apparatus based on the present invention.

(2) FIG. 2 schematically illustrates a ball screw mechanism unit in FIG. 1.

(3) FIG. 3A is a partial schematic diagram illustrating when a movable unit moves to the left direction.

(4) FIG. 3B is a partial schematic diagram illustrating when the movable unit moves to the right direction.

(5) FIG. 4 is a flowchart illustrating operations of the motor control apparatus according to the present invention.

(6) FIG. 5 illustrates a relationship between a displacement of a spring and a force.

(7) FIG. 6A is a first drawing illustrating a backlash.

(8) FIG. 6B is a second drawing illustrating a backlash.

(9) FIG. 6C is a third drawing illustrating a backlash.

DETAILED DESCRIPTION

(10) Embodiments of the present invention will be described in detail below with reference to the attached drawings. Same components are denoted by the same reference numerals in the drawings. Scales of the drawings have been appropriately changed to facilitate understanding of the present invention.

(11) FIG. 1 is a functional block diagram of the motor control apparatus based on the present invention. As illustrated in FIG. 1, a nut 52 is screwed to a screw 51 of the ball screw mechanism unit mounted on an output axis of a motor M. The nut 52 is coupled to a table 54 via a coupling member 53. A position of the motor M is detected by a first position detector, such as an encoder 11, mounted on the motor M. The encoder 11 also detects a speed detection value DV based on a plurality of continuous positions of the motor M. A position of the table 54 is detected by a second position detector, such as a scale 12, arranged in parallel to the table 54.

(12) FIG. 2 schematically illustrates the ball screw mechanism unit in FIG. 1. In FIG. 2, the movable unit WA having an approximately U-shaped cross-section and an engagement member D engaging with the movable unit WA are mainly illustrated. A lower surface of the movable unit WA is coupled to a motor position member 63 indicating a position of the motor M via a first elastic deformation unit 61. The engagement member D is coupled to the table 54 via a second elastic deformation unit 62. In FIG. 2, the engagement member D, the second elastic deformation unit 62, and the table 54 correspond to the driven unit WB.

(13) FIG. 3A and FIG. 3B are partial schematic diagrams respectively illustrating when the movable unit moves to the left direction and the right direction. When the motor position member 63 moves to the left direction, the first elastic deformation unit 61 elastically deforms, so that the movable unit WA moves to the left direction slightly later than the motor position member 63.

(14) When the engagement member D engaged with the movable unit WA moves to the left direction, the second elastic deformation unit 62 elastically deforms, so that the table 54 moves to the left direction later than the engagement member D. As illustrated in FIG. 3B, it is basically the same as when the motor position member 63 moves to the right direction, and thus the descriptions thereof are omitted.

(15) As is understood from comparison between FIG. 1 and FIG. 2, the first position detector (encoder) 11 and the motor M in FIG. 1 correspond to a linear actuator 64 which also serves as a linear detector in FIG. 2. In addition, the screw 51 and the nut 52 in FIG. 1 correspond to the movable unit WA, the engagement member D, and the first elastic deformation unit 61 which is elastically deformable. Further, the coupling member 53 in FIG. 1 corresponds to the second elastic deformation unit 62 which is elastically deformable. In the following descriptions, the ball screw mechanism unit in FIG. 1 is described as replaced with the schematic ball screw mechanism unit illustrated in FIG. 2.

(16) With reference to FIG. 1, the motor control apparatus 10 based on the present invention mainly includes a position command calculation unit 20 which periodically calculates a position command value CP for the movable unit WA, a speed command calculation unit 24 which calculates a speed command value for the movable unit WA, and a torque command calculation unit 26 which calculates a torque command value of the motor M.

(17) The motor control apparatus 10 includes an error calculation unit 31 which calculates an error ΔP between a first position detection value DP1 detected by a first position detection unit 11 and a second position detection value DP2 detected by the second position detection unit 12.

(18) The motor control apparatus 10 includes a memory unit 33 which memorizes the error ΔP calculated by the error calculation unit 31 in association with the torque command value as an initial error. The memory unit 33 can memorize other elements such as a speed. Further, the motor control apparatus 10 includes a compensation amount calculation unit 34 which calculates a compensation amount for compensating an elastic deformation amount of an elastic factor between the movable unit WA and the driven unit WB. The elastic factor between the movable unit WA and the driven unit WB is an elastic factor integrated with the first elastic deformation unit 61 and the second elastic deformation unit 62.

(19) Specifically, the compensation amount calculation unit 34 calculates the compensation amount based on the initial error held by the memory unit 33, the torque command value held in association with the initial error, and the torque command value calculated by the torque command calculation unit 26 when the motor rotates reversely.

(20) FIG. 4 is a flowchart illustrating operations of the motor control apparatus according to the present invention. Contents illustrated in FIG. 4 are repeated for each predetermined control period. The operations of the motor control apparatus according to the present invention are described below with reference to FIG. 1 to FIG. 4.

(21) First, the position command calculation unit 20 calculates the position command value CP. In steps S11 and S12 in FIG. 4, the first position detection unit 11 and the second position detection unit 12 respectively detect the first position detection value DP1 of the movable unit WA and the second position detection value DP2 of the driven unit WB.

(22) As illustrated in FIG. 4, in step S13, the error calculation unit 31 calculates the error ΔP between the first position detection value DP1 and the second position detection value DP2. As is understood by referring to FIG. 3A and others, the error ΔP corresponds to an elongation amount of a spring when the first elastic deformation unit 61 and the second elastic deformation unit 62 are the elastic factors.

(23) Then, in step S14, it is determined whether the screw 51 is accelerated or performs uniform motion. In other words, it is determined whether the movable unit WA is accelerated or performs uniform motion. It can be determined from the speed command value. When the screw 51 is determined as accelerated or performing uniform motion, the processing proceeds to step S15. In step S15, the memory unit 33 memorizes the error calculated in step S13 in association with the torque command value at that time as the initial error.

(24) When the screw 51 is decelerated, a direction of a force generated by the motor is changed according to a magnitude relationship between a frictional force and a necessary deceleration force. Therefore, a direction of elastic deformation is not unique, and in some cases, the initial error is acquired in association with the torque command value in a state in which elastic deformation, namely both of the initial error and the torque command value scarcely occur. According to the present invention, since the error and the torque command value when the screw 51 is accelerated or performs uniform motion are adopted, at least the initial error corresponding to the frictional force acting on the machine is secured, and an effect of an error of the initial error and an error of the torque command value on the compensation amount is excluded.

(25) Then, in step S16, it is determined whether the initial error and the torque command value are held, and when they are held, the processing proceeds to step S17. In step S17, the compensation amount calculation unit 34 calculates the compensation amount.

(26) FIG. 5 illustrates a relationship between a displacement of a spring and a force. In FIG. 5, an abscissa indicates a total displacement of the first elastic deformation unit 61 and the second elastic deformation unit 62. An ordinate in FIG. 5 indicates a force (torque). As illustrated in FIG. 5, the displacement and the force are in a linear relationship, and an inclination thereof represents a spring constant of the elastic factor integrated with the first elastic deformation unit 61 and the second elastic deformation unit 62.

(27) In step S16, the compensation amount calculation unit 34 calculates the spring constant by dividing the torque command value held in the memory unit 33 by the corresponding initial error. The memory unit 33 may memorize only the spring constant by calculating the spring constant in each predetermined period by dividing the torque command value by the initial error. In this case, a capacity of the memory unit 33 can be reduced.

(28) When the motor M rotates reversely, the compensation amount calculation unit 34 divides the torque command value at the reversing rotation by the spring constant. Needless to say, a reciprocal of the spring constant may be calculated in advance and multiplied by the torque command value. Thus, an appropriate compensation amount corresponding to torque at the reversing rotation can be acquired from a following equation (1).
Compensation amount=(initial error in first direction/corresponding torque command value in first direction)×(current torque command value)−)current error)  (1)

(29) In the equation (1), the term (initial error in first direction/corresponding torque command value in first direction) is a reciprocal of a spring constant of the above-described elastic factor. The first direction is, for example, the left direction indicated in FIG. 3A, however, it may be the right direction indicated in FIG. 3B.

(30) With reference to FIG. 1 again, a subtractor 21 subtracts the second position detection value DP2 detected by the second position detection unit 12 from the position command value CP calculated by the position command calculation unit 20. The compensation amount calculated by the compensation amount calculation unit 34 is added to the position command value CP by adder 22 and input to the speed command calculation unit 24. The speed command calculation unit 24 calculates a speed command value CV.

(31) The speed detection value DV detected by the first position detection unit 11 is subtracted from the speed command value CV by a subtractor 25 and input to the torque command calculation unit 26. The torque command value calculated by the torque command calculation unit 26 is input to the motor M to drive the motor M.

(32) According to the conventional technique, a compensation amount is calculated using a following equation (2).
Compensation amount=initial error in first direction−current error  (2)

(33) On the contrary, according to the present invention, the spring constant is calculated from the initial error in the first direction and corresponding torque. The compensation amount is calculated using the spring constant according to torque at the reversing rotation.

(34) As described above, according to the present invention, the compensation amount is calculated in consideration of elastic deformation, so that the compensation amount does not become too large. Thus, a workpiece is not excessively machined, and a notch is not formed on a surface of the workpiece. Therefore, the present invention can reduce a likelihood that it is determined as defective machining in the workpiece.

EFFECT OF THE INVENTION

(35) According to the first and the second aspects, the compensation amount is calculated in consideration of elastic deformation, so that the compensation amount does not become too large. Thus, a workpiece is not excessively machined, and a notch is not formed on a surface of the workpiece.

(36) According to the third aspect, a problem that a direction of a force generated by the motor is not uniquely fixed when decelerating can be eliminated. The force generated by the motor when decelerating can be acquired by subtracting frictional force acting on the machine from a force necessary for deceleration. In other words, according to the third aspect of the present invention, a problem that a direction of a force of the motor and a direction of elastic deformation (expansion or contraction) are changed in response to a magnitude relationship between the frictional force and the deceleration force is eliminated. Accordingly, a more accurate elastic deformation model can be provided, and a likelihood that a notch is formed on a surface of the workpiece can be further reduced.

(37) While the present invention has been described with reference to the exemplary embodiment, it will be obvious for a person skilled in the art that various modifications, omission, and addition can be made in addition to the above-described modifications without departing from the scope of the present disclosure.