Motor control device and motor control method

By determining whether an over-action can be performed in the motor control device, and when necessary, the shaft is first driven in the reverse direction of gravity to the over-position and then to the target position in the target position, the axial gravity reverse direction rise stop in the prior art is solved. The problem of wasted thrust has achieved the effect of reducing the motor thrust demand.

CN112828649BActive Publication Date: 2024-12-06FANUC LTD
View PDF 12 Cites 0 Cited by

Patent Information

Application Number
CN202011321273.8
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Priority Date
2019-11-25
Filing Date
2020-11-23
Publication Date
2024-12-06
Estimated Expiration
2040-11-23

AI Technical Summary

Technical Problem

The existing motor control device requires a large thrust when the axial gravity rises and stops at the target position in the opposite direction, resulting in waste of thrust and it is difficult to reduce the thrust requirement when the shaft stops.

Method used

By determining whether the over-action can be performed, and when the over-action can be performed, first drive the axial gravity in the opposite direction to the over-position, and then drive to the target position in the direction of gravity to reduce the thrust demand of the motor.

Benefits of technology

The thrust required to stop the shaft is effectively reduced, especially when the gravity is rising to the target position, reducing the thrust requirement of the motor.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN112828649B_ABST
    Figure CN112828649B_ABST
Patent Text Reader

Abstract

The present invention relates to a control device for an electric motor and a control method for an electric motor, which can reduce the thrust required to stop a shaft. A control device for an electric motor drives a shaft affected by gravity, and the control device for the electric motor comprises: a judgment unit for judging whether an overrunning action beyond a target position of the shaft can be performed; and a drive control unit, when the judgment unit judges that the overrunning action can be performed and the shaft is driven in the opposite direction of gravity, the drive control unit controls the drive of the electric motor to perform the following actions: after driving the shaft in the opposite direction of gravity to an overrunning position beyond the target position, the shaft is driven again in the direction of gravity to stop the shaft at the target position.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to a control device of a motor and a control method of a motor. Background Art

[0002] The motor used in the machine tool drives the axis to perform machining operations such as positioning of tools and workpieces and cutting. For example, in the case of a feed axis that moves in the up-down direction installed in a vertical machining center, the motor for driving the feed axis drives the feed axis to move up or down at a constant speed, thereby causing the tool, table, workpiece, etc. connected to the feed axis to move up and down in the direction of gravity and stop at the target position.

[0003] When the shaft is driven so that the moving body moves up and down at a constant speed along the direction of gravity, the thrust (torque) required by the motor is [gravity] + [dynamic friction] when the moving body rises, and [gravity] - [dynamic friction] when the moving body descends. In addition, when the shaft drive stops, a thrust in the range of [gravity] ± [maximum static friction] is required so that the moving body does not fall due to gravity ([maximum static friction] > [dynamic friction]).

[0004] Prior art literature

[0005] Patent Literature

[0006] Patent Document 1: Japanese Patent Application Publication No. 2002-18664 Summary of the invention

[0007] Problem that the invention aims to solve

[0008] Generally, the control device of the motor controls the motor in such a way that the thrust command for driving the shaft is changed according to the size of the position deviation (the difference between the target position and the actual position), and when the shaft stops, the thrust command immediately before the stop is continued. Figure 7 As shown in FIG. 1 , when the moving body descends in the direction of gravity and stops at the target position, the thrust of the motor used to drive the shaft only needs to be equal to [gravity] minus [dynamic friction]. Figure 8 As shown, when the moving body rises in the opposite direction of gravity to stop at the target position, the thrust of the motor for driving the shaft needs to be a large thrust equal to [gravity] + [dynamic friction]. Therefore, compared with the case where the shaft is driven to descend in the direction of gravity and stop at the target position, the motor wastefully needs a large thrust when the shaft is driven to rise in the opposite direction of gravity to stop at the target position. Therefore, in the control of the motor, it is desirable to reduce the thrust required for stopping the shaft.

[0009] Solutions for solving problems

[0010] A motor control device involved in one embodiment of the present invention is a motor control device that drives an axis affected by gravity, and the motor control device includes: a judgment unit, which is used to judge whether an overrunning action beyond a target position of the axis can be performed; and a drive control unit, when the judgment unit judges that the overrunning action can be performed and the axis is driven in the opposite direction of gravity, the drive control unit controls the drive of the motor to perform the following actions: after driving the axis in the opposite direction of gravity to an overrunning position beyond the target position, the axis is driven again in the direction of gravity to stop the axis at the target position.

[0011] A method for controlling an electric motor involved in one embodiment of the present invention is a method for controlling an electric motor that drives an axis affected by gravity. In the method for controlling the electric motor, it is determined whether an overrunning action beyond a target position of the axis can be performed. When it is determined that the overrunning action can be performed and the axis is driven in the opposite direction to gravity, the drive of the electric motor is controlled to perform the following actions: after the axis is driven in the opposite direction to gravity to an overrunning position beyond the target position, the axis is driven again in the direction of gravity to stop the axis at the target position.

[0012] Effects of the Invention

[0013] According to one embodiment, it is possible to provide a control device for an electric motor and a control method for an electric motor that can reduce a thrust force required to bring a shaft to a stopped state. BRIEF DESCRIPTION OF THE DRAWINGS

[0014] Figure 1 This is a schematic diagram showing a part of a machine tool to which a motor control device according to one embodiment of the present disclosure is applied.

[0015] Figure 2 This is a block diagram showing a configuration of a motor control device according to one embodiment of the present disclosure.

[0016] Figure 3 This is a schematic diagram for explaining the driving of a shaft controlled by the control device for the electric motor according to one embodiment of the present disclosure.

[0017] Figure 4 This is a flowchart for explaining drive control of a shaft by a control device for a motor according to one embodiment of the present disclosure.

[0018] Figure 5 This is a schematic diagram showing another part of a machine tool to which the motor control device according to one embodiment of the present disclosure is applied.

[0019] Figure 6 This is a schematic diagram showing still another part of a machine tool to which the motor control device according to one embodiment of the present disclosure is applied.

[0020] Figure 7 This is a graph showing the thrust of the motor when the shaft stops while descending in the direction of gravity from a stopped state.

[0021] Figure 8 This is a graph showing the thrust of the motor when the shaft stops while rising in the direction opposite to gravity from a stopped state.

[0022] Description of Reference Numerals

[0023] 1: machine tool; 10: motor; 20: feed axis; 30: control device; 31: determination unit; 32: drive control unit; 34: acceleration / deceleration time constant setting unit; 35: gain setting unit. DETAILED DESCRIPTION

[0024] Hereinafter, one embodiment of the present disclosure will be described with reference to the drawings.

[0025] Figure 1 This is a schematic diagram showing a part of a machine tool to which a motor control device according to one embodiment of the present disclosure is applied. Figure 2 1 is a block diagram showing the structure of a motor control device according to one embodiment of the present disclosure. Figure 1 As shown, the machine tool 1 includes a motor 10 , a feed axis 20 driven by the motor 10 , and a control device 30 that controls the drive of the motor 10 .

[0026] Figure 1 The motor 10 shown is composed of a linear motor, and drives a feed shaft 20 extending in a straight line along the gravity direction (Z axis). By driving the feed shaft 20 by the motor 10, a moving body 21 mounted on the feed shaft 20 is raised in the opposite direction of gravity (Z1 direction) or lowered in the gravity direction (Z2 direction) toward a target position. Therefore, the feed shaft 20 is an axis affected by gravity. The moving body 21 is, for example, a spindle with a tool used in the machine tool 1, a workpiece as a workpiece to be processed, a workbench for supporting the workpiece, etc.

[0027] like Figure 2As shown, the control device 30 controls the driving of the motor 10 based on the driving instruction sent from the numerical control device 40 composed of, for example, CNC (Computerized Numerical Control). As described above, the thrust of the motor required for driving the shaft is smaller when the shaft is driven to descend in the direction of gravity to stop at the target position than when the shaft is driven to ascend in the opposite direction of gravity to stop at the target position. Therefore, when the moving body 21 is raised in the opposite direction of gravity to stop at the target position, the control device 30 controls the driving of the motor 10 so that the feed shaft 20 descends in the direction of gravity to stop at the target position, thereby reducing the thrust of the motor 10.

[0028] Therefore, the control device 30 includes a determination unit 31, a drive control unit 32, a position detection unit 33, an acceleration / deceleration time constant setting unit 34, and a gain setting unit 35. The configuration of the control device 30 can be generally realized by a servo control device for the motor 10. Figure 2 The control device 30 shown is described as a device in which the components are collectively arranged, but there is no particular limitation on the arrangement location of the components of the control device 30. Some or all of the functions of the control device 30 may be implemented by the numerical controller 40 or other external devices.

[0029] The determination unit 31 analyzes the drive command of the motor 10 based on the machining program sent from the numerical control device 40. The drive command of the motor 10 includes information on the target position (the target position to which the movable body 21 is to be moved) when driving the feed shaft 20 of the machine tool 1, information on the moving direction (Z1 direction or Z2 direction) to the target position, information on the purpose of the driving action of the feed shaft 20 (positioning action, cutting action, etc.), etc. The determination unit 31 analyzes the drive command to determine whether the driving direction of the feed shaft 20 for moving the movable body 21 to the target position is the opposite direction of gravity and whether an overrun action can be performed when driving the feed shaft 20.

[0030] The overrunning action of the feed shaft 20 is an action of driving the feed shaft 20 to move the moving body 21 to the target position again after moving to the overrunning position beyond the target position. The overrunning action is applied to the driving direction of the feed shaft 20 to the target position, including the direction opposite to the gravity ( Figure 1 Therefore, in the case of Figure 1 In the case of the feed axis 20 shown, the overrun position is a position that rises a predetermined distance in the opposite direction of gravity (Z1 direction) relative to the target position. Therefore, in the overrun action, the moving body 21 that rises to the overrun position and then stops descends from the overrun position to the target position and then stops at the target position.

[0031] There is no problem with the overrunning action when the drive of the feed shaft 20 is used for the positioning action of the movable body 21. However, since the overrunning action is an action that exceeds the target position, when the drive of the feed shaft 20 is used for the cutting action of cutting the workpiece, the overrunning action may affect the processing quality. Therefore, when the result of the analysis of the drive instruction determines that the driving direction of the feed shaft 20 to the target position is the opposite direction of gravity, the judgment unit 31 determines whether the overrunning action can be performed according to the purpose of the driving action of the feed shaft 20 in the driving instruction of the motor 10. Specifically, when the drive of the feed shaft 20 is used for the positioning action in the machine tool 1, the judgment unit 31 determines that the overrunning action can be performed, and when the drive of the feed shaft 20 is used for the cutting action in the machine tool 1, the judgment unit 31 determines that the overrunning action cannot be performed.

[0032] When the determination unit 31 determines that the driving direction of the feed shaft 20 to the target position is the opposite direction of gravity and that an overrunning action can be performed when driving the feed shaft 20, the determination unit 31 outputs the determination result to the drive control unit 32, the acceleration / deceleration time constant setting unit 34 and the gain setting unit 35 respectively.

[0033] The drive control unit 32 analyzes the drive command of the motor 10 sent from the numerical controller 40. The drive control unit 32 determines the target position (target coordinate) when driving the feed shaft 20 based on the analysis result and the position information of the feed shaft 20 sent from the position detection unit 33 described later. Then, the drive control unit 32 can create a target position command based on the target position. When the feed shaft 20 is driven to move the moving body 21 to the target position in a normal operation, the target position command is output to the motor 10.

[0034] In addition, the drive control unit 32 determines the excess position (exceeding coordinate) to which the feed shaft 20 is to be driven when a judgment result is input from the judgment unit 31 that the driving direction of the feed shaft 20 to the target position is the opposite direction of gravity and that an excess action can be performed when the feed shaft 20 is driven. Then, the drive control unit 32 can generate an excess position instruction based on the excess position. When the feed shaft 20 is driven so that the moving body 21 rises from the target position to the excess position and then descends to the target position, the excess position instruction is output to the motor 10. The excess position can be set to a position that is a predetermined fixed distance away from the target position, or it can be set to a position that is different each time relative to the target position, for example, depending on the type, weight, moving distance, and moving speed of the moving body 21.

[0035] The over-position instruction includes a first thrust instruction for driving the feed shaft 20 to raise the moving body 21 from the current position to the over-position and a second thrust instruction for driving the feed shaft 20 to lower the moving body 21 from the over-position to the target position. As described above, the thrust of the motor 10 driving the feed shaft 20 to lower the moving body 21 in the direction of gravity is smaller than that of driving the feed shaft 20 to raise the moving body 21 in the opposite direction of gravity. Therefore, the magnitude of the thrust of the motor 10 is in the relationship of the first thrust instruction > the second thrust instruction.

[0036] like Figure 2 As shown, the position detection unit 33 detects the position of the feed shaft 20 (which is also the position of the moving body 21) based on the position detection signal output from the position detector 11 such as an encoder provided on the motor 10. The position information of the feed shaft 20 detected by the position detection unit 33 is output to the drive control unit 32 described above.

[0037] The acceleration / deceleration time constant setting unit 34 sets the acceleration / deceleration time constant associated with the acceleration / deceleration of the motor 10 when driving the feed shaft 20. At least two time constants, large and small, are set in the acceleration / deceleration time constant setting unit 34. The acceleration / deceleration time constant setting unit 34 selects any one of the at least two time constants and outputs it to the drive control unit 32. Specifically, when performing an overrun action, the acceleration / deceleration time constant setting unit 34 changes the time constant output to the drive control unit 32 to a larger time constant. Since the overrun action is an action that immediately descends to the target position without maintaining a stopped state after temporarily stopping at the overrun position, the impact on the feed shaft 20 and the moving body 21 may become larger. When the acceleration / deceleration time constant is changed to a larger value, the acceleration and deceleration when driving the feed shaft 20 become slower. Therefore, the impact on the feed shaft 20 and the moving body 21 is reduced during the overrun action.

[0038] The gain setting unit 35 sets the gain when driving the feed shaft 20. During the overrun action, the thrust of the motor 10 is changed from [gravity] + [dynamic friction] to [gravity] - [dynamic friction], so when the dynamic friction torque is large, the thrust of the motor 10 that changes during the overrun action also becomes larger. On the other hand, there is a tendency for the position deviation to become smaller during the overrun action, so when the thrust of the motor 10 is changed according to the position deviation, the change of the thrust sometimes takes time. Therefore, when performing the overrun action, the gain setting unit 35 functions to increase the gain output to the drive control unit 32. By increasing the gain, the change time of the thrust of the motor 10 is shortened, and the time to drive the feed shaft 20 from the overrun position to the target position is also shortened.

[0039] The type of gain changed by the gain setting unit 35 may be either the position loop gain or the speed loop gain, or may be both the position loop gain and the speed loop gain.

[0040] Next, refer to Figure 3 and Figure 4 A specific method of controlling the electric motor 10 by the control device 30 will be described. Figure 3 This is a schematic diagram for explaining the driving of the feed shaft 20 controlled by the control device 30 . Figure 4 2 is a flowchart for explaining the drive control of the feed shaft 20 by the control device 30. Figure 3 As shown in FIG. 1 , the feed shaft 20 is driven to move the movable body 21 stopped at the current position upward in the Z1 direction which is the opposite direction of gravity until it moves to the target position.

[0041] First, the control device 30 analyzes the drive command based on the machining program sent from the numerical controller 40 in the drive control unit 32 (S1). Then, the drive control unit 32 determines the target position when driving the feed axis 20 based on the analysis result and the position information of the feed axis 20 sent from the position detection unit 33, and generates a target position command (S2).

[0042] The drive command from the numerical control device 40 is also sent to the determination unit 31 (see Figure 2 ). The control device 30 determines in the judgment unit 31 whether the movement of the moving body 21 to the target position is in the opposite direction of gravity according to the drive instruction (S3). If the movement is in the opposite direction of gravity (step S3: "Yes"), the control device 30 further determines in the judgment unit 31 whether an overtaking action can be performed according to the drive instruction (S4).

[0043] In step S4, when the drive of the feed shaft 20 is a drive for positioning action and it is determined that the overrun action can be performed (step S4: "Yes"), the control device 30 determines the overrun position based on the target position in the drive control unit 32. Then, the control device 30 generates an overrun position command including a first thrust command and a second thrust command based on the overrun position (S5). Thereafter, the control device 30 changes the set time constant to a larger time constant in the acceleration / deceleration time constant setting unit 34, and changes the gain in the gain setting unit 35 in a manner that increases the set gain (S6).

[0044] Next, the control device 30 first applies a current corresponding to the first thrust command of the overshoot position command to the motor 10 to drive the feed shaft 20. Thus, the feed shaft 20 is driven to move the moving body 21 upward from the current position in the Z1 direction, which is the opposite direction of gravity, to the overshoot position (S7).

[0045] After the moving body 21 rises to the overrun position, the control device 30 applies a current corresponding to the second thrust command of the overrun position command to the motor 10 to drive the feed shaft 20. Thus, the feed shaft 20 is driven to lower the moving body 21 from the overrun position to the Z2 direction as the gravity direction to the target position (S8).

[0046] When the moving body 21 is lowered from the overrunning position to the target position in step S8, the feed shaft 20 keeps the moving body 21 in a stopped state at the target position. At this time, the thrust of the motor 10 for keeping the feed shaft 20 in a stopped state is as follows: Figure 7 As shown in FIG. 1 , a small thrust equal to [gravity] minus [dynamic friction] is generated. Therefore, the thrust required by the motor 10 is reduced compared to the case where the vehicle is driven from the current position to the target position in a normal operation.

[0047] In addition, if it is determined in step S3 that the movement to the target position is not in the opposite direction of gravity (step S3: No), or if it is determined in step S4 that the overrunning action cannot be performed (step S4: No), the process is transferred to step S9. In step S9, the control device 30 applies a current corresponding to the normal thrust command to the motor 10. Thus, the control device 30 drives the feed shaft 20 so that the moving body 21 rises from the current position to the target position in a normal action.

[0048] In the flowchart described above, when the movement to the target position is in the opposite direction of gravity and an overrunning action can be performed, the control device 30 must control the motor 10 to perform the overrunning action. However, when the feed shaft 20 remains stopped at the target position for a short time, the thrust of the motor 10 is sufficient, so the control device 30 sometimes does not need to control the motor 10 to perform the overrunning action. The stop time of the feed shaft 20 can be determined by analyzing the drive instructions based on the machining program sent from the numerical control device 40. Therefore, for example, Figure 4 A step for determining whether the stop time of the feed shaft 20 is shorter than the time set as a threshold value is added between any two steps of step S2 and step S3, between step S3 and step S4, or between step S4 and step S5. In this case, when it is determined that the stop time of the feed shaft 20 is shorter than the time set as the threshold value, the control device 30 controls the motor 10 to transfer to the processing of step S9 without performing the overrun action, so as to drive the feed shaft 20 in a normal action.

[0049] The axis driven by the motor 10 may be any axis affected by gravity, and is not limited to Figure 1 The feed axis 20 of the linear motor shown. For example, Figure 5As shown, the shaft may be formed of a ball screw 20A connected to the drive shaft of the motor 10. The ball screw 20A extends in the direction along the gravity. The moving body 21 is screwed to the ball screw 20A and is driven by the motor 10 to move up and down.

[0050] In addition, the axis may not be an axis that is driven linearly along the direction of gravity. Figure 6 As shown, it can also be the drive shaft 20B of the motor 10. In this case, the drive shaft 20B is arranged in a direction intersecting the direction of gravity (for example, the horizontal direction). A disk-shaped panel 22 is mounted on the drive shaft 20B, and a workpiece W as a moving body is supported eccentrically on the surface of the panel 22. For example, when the drive shaft 20B of the motor 10 is driven in the counterclockwise direction, the workpiece W1 represented by a single-point dashed line on the upper side of the panel 22 moves in the Z20 direction along the gravity direction to the position (target position) of the workpiece W represented by the solid line. However, when the drive shaft 20B is driven in the clockwise direction, the workpiece W2 represented by a single-point dashed line on the lower side of the panel 22 moves in the Z10 direction along the opposite direction of gravity to the position (target position) of the workpiece W represented by the solid line. Therefore, when the control device 30 drives the drive shaft 20B to move the workpiece W2 to the position of the workpiece W, it can reduce the thrust of the motor 10 by performing the above-mentioned overrunning action.

[0051] Furthermore, the overrunning action can be performed as long as the action is performed in such a way that the object finally stops at the target position, and is not limited to the case where the object moves to the overrunning position. Figure 6 As shown, the overrunning operation may be an operation in which the workpiece W1 located on the upper side of the panel 22 is moved in the clockwise direction and finally stops at the position of the workpiece W as the target position.

Claims

1. A control device for an electric motor, the electric motor driving an axis affected by gravity, the control device for the electric motor comprising: a judgment unit for judging whether an overrunning action beyond the target position of the shaft can be performed, wherein the overrunning action is an action of driving the shaft in the opposite direction of gravity to the overrunning position beyond the target position without keeping the shaft stopped and immediately driving the shaft again in the gravity direction until the shaft is driven to the target position; a drive control unit, which controls the drive of the motor to perform the overrunning action and stops the shaft at the target position when the determination unit determines that the overrunning action can be performed and the shaft is driven in the direction opposite to gravity; as well as an acceleration / deceleration time constant setting unit for setting an acceleration / deceleration time constant when driving the axis, wherein, when the overrun action is performed, the acceleration / deceleration time constant setting unit changes the acceleration / deceleration time constant in such a way that the acceleration / deceleration time constant becomes larger, The determination unit determines a stop time for the axis to stop at the target position based on a drive instruction based on a machining program sent from a numerical control device, and determines that the overrunning action cannot be performed if the stop time is shorter than a preset threshold time.

2. The control device for the electric motor according to claim 1, characterized in that: The axis is used for positioning and cutting actions in the machine tool. When the axis is driven for the positioning operation, the determination unit determines that the overrunning operation is possible, and when the axis is driven for the cutting operation, the determination unit determines that the overrunning operation is not possible.

3. The control device for the electric motor according to claim 1 or 2, characterized in that: further comprising a gain setting unit for setting a gain when driving the axis, When the exceeding operation is performed, the gain setting unit changes the gain so as to increase the gain.

4. A method for controlling an electric motor, the electric motor driving an axis affected by gravity, wherein: determining whether an overrunning action beyond the target position of the axis can be performed, wherein the overrunning action is an action of driving the axis in the gravity direction again immediately without keeping the axis stopped until the axis is driven to the target position after the axis is driven in the reverse direction of gravity to the overrunning position beyond the target position, and When it is determined that the overrunning action is possible and the shaft is driven in the direction opposite to gravity, the driving of the motor is controlled to perform the overrunning action to stop the shaft at the target position. in, When the overrunning action is performed, the acceleration / deceleration time constant when driving the axis is changed so that the acceleration / deceleration time constant becomes larger. A stop time for the axis to stop at the target position is determined based on a drive command based on a machining program sent from a numerical controller, and when the stop time is shorter than a preset threshold time, it is determined that the overrunning operation cannot be performed.

5. The method for controlling a motor according to claim 4, characterized in that: The axis is used for positioning and cutting actions in the machine tool. When the axis is driven for the positioning operation, it is determined that the overrunning operation is possible, and when the axis is driven for the cutting operation, it is determined that the overrunning operation is not possible.

6. The method for controlling a motor according to claim 4 or 5, characterized in that: When the overrunning operation is performed, the gain when driving the axis is changed so as to be increased.

Citation Information

Patent Citations

  • Moving device of machine tool, and control method for it

    JP2002018664A

  • Feed apparatus

    CN102452012A

  • Numerical control device and control method

    CN106475833A

  • Controller for motor

    CN109088570A

  • Feed controller

    JP1994250713A