The present invention relates to a positioning control device.
A servo motor and other motors have been used as a driving source for a positioning control of various industrial machines such as a conveyor machine, a semiconductor manufacturing device, an electronic-parts mounting device, and a robot. In order to reduce the running costs of an industrial machine, it is necessary to decrease the power consumption amount when the motor performs a positioning operation, that is, the integral power consumption.
In order to reduce the power consumption amount, it is a possible method to use devices such as a high-efficiency motor and a power-supply regenerative converter. However, there is a problem in that these devices are expensive. When the power consumption amount can be reduced by adjusting a positioning-control command value, then a reduction in power consumption amount can be achieved at low costs without introducing any additional device.
A technique has been disclosed, in which a positioning-control command value with a shorter positioning time and a greater power consumption amount, and a positioning-control command value with a longer positioning time and a less power consumption amount, are stored, and a user can select either of them (see, for example, Patent Literature 1).
Patent Literature 1: Japanese Patent Application Laid-open No. H5-325446
A positioning operation involves an accelerating operation and a decelerating operation in order to move a mechanical load from one position to another position. When performing an accelerating operation, a motor consumes power. In contrast, upon performing a decelerating operation, a motor enters a power-generating state, and generally regenerative power is produced. For example, a motor-driving device for driving a motor, such as a servo amplifier, often includes a regenerative resistance and a regenerative transistor. In the configuration as described above, when regenerative power is produced, a part of the regenerative power is consumed by the regenerative resistance. However, not all of the produced regenerative power is consumed by the regenerative resistance. A part of the regenerative power remains in the motor-driving device and is used for the next positioning operation. This regenerative power is an important factor in terms of the power consumption when the motor is running. However, the conventional technique does not take this regenerative power into account, and therefore there is a problem in that the reduction in power consumption is insufficient.
The present invention has been achieved to solve the above problems, and an objective of the present invention is to provide a positioning control device that reduces the power consumption during positioning operations.
In order to solve the problem and achieve the objective mentioned above, the present invention relates to a positioning control device that includes an amplifier that includes a converter to rectify and to output an AC power supply to bus-bars, a smoothing capacitor to smooth an output of the converter and to generate a bus voltage, a regenerative resistance and a regenerative transistor that are connected between the bus-bars, and an inverter to supply a drive current for driving a motor; and a command generation unit to generate a position command value for a positioning control of a mechanical load connected to the motor, the position command value being generated on the basis of a command pattern that is pattern information of a command velocity and command acceleration. The inverter is connected between the bus-bars, and supplies the drive current on the basis of the position command value, and the command generation unit acquires a regenerative-power-amount estimated value that is estimated from the command pattern before a start of a positioning operation and acquires an energy value that is storable in the smoothing capacitor, and on the basis of a result of a comparison between these values, decides whether to use the position command value that is on the basis of the command pattern in the positioning operation.
The positioning control device according to the present invention can reduce the power consumption when it controls the positioning of a mechanical load using a motor.
Exemplary embodiments of a positioning control device according to the present invention will be explained below in detail with reference to the accompanying drawings. The present invention is not limited to the embodiments.
The amplifier 7 receives a positioning-control command value 11, which is a command pattern from the command generation unit 10, and supplies a current 14 to the motor 1 so as to make it follow the command value. The amplifier 7 includes a servo control unit 12, a converter unit 22, a smoothing capacitor 23, a regenerative resistance 24, a regenerative transistor 25, and an inverter unit 26. The regenerative resistance 24 and the regenerative transistor 25 are connected between bus-bars in parallel to the smoothing capacitor 23. The regenerative transistor 25 is provided to energize the regenerative resistance 24.
The motor 1 is driven by the current 14 from the amplifier 7, and serves as a driving source of a positioning control. The encoder 2 connected to the motor 1 detects a position and a velocity of the motor 1, and it outputs detected information 13, i.e., motor position and velocity information. The ball screw 3 is connected to the motor 1 by the coupling 5. Rotational motion of the motor 1 is converted to translational motion by the ball screw 3, and therefore motion of the positioning head 4 fixed to the ball screw 3 is controlled.
In an example illustrated in
The AC power supply 21 supplies AC power to the amplifier 7. The amplifier 7 uses the supplied AC current so as to supply the current 14 to the motor 1 in the manner as described below. The converter unit 22, to which the AC power supply 21 is connected, rectifies AC power supplied from the AC power supply 21 and outputs the rectified AC power to the bus-bars. The converter unit 22 is configured from a diode stack, for example. The rectified AC power is converted to a DC power supply smoothed by the smoothing capacitor 23. This DC power supply generates a bus voltage between the bus-bars.
The regenerative transistor 25 turns ON when the bus voltage increases excessively during an operation of the motor 1 and causes the regenerative resistance 24 to consume regenerative power in order to decrease the bus voltage. The inverter unit 26 performs pulse width modulation (PWM). In accordance with a voltage command 15 described later, the inverter unit 26 supplies the motor 1 with the current 14 for driving the motor 1 so as to follow a command value.
The servo control unit 12 calculates the voltage command 15 such that the position of the motor 1 follows the position command signal 11 that is a positioning command value for a positioning control. The position of the motor 1 is given to the servo control unit 12 as detected motor information 13 output from the encoder 2. As a specific example of calculating the voltage command 15, a feedback control is configured on the basis of the position command 11 and the motor position 13. However, the calculation of the voltage command 15 is not limited thereto, and a feedforward control can also be used in combination with the feedback control. A servo amplifier and a general-purpose inverter are specific examples of the amplifier 7.
The command generation unit 10 generates and outputs the position command value 11 for a positioning control to the amplifier 7. The command generation unit 10 is a constituent element that has a primary function in the present embodiment. The command generation unit 10 generates a position command value on the basis of positioning-operation specification information such as a movement amount D during a positioning control, a movement time T that is a time from the start to the end of positioning, maximum acceleration Amax that is the maximum allowable acceleration during a positioning control, movable-portion inertia J and a capacitance C of the smoothing capacitor 23, reference command-pattern information described later, and a command start signal that specifies the time at which the poisoning is started.
The movable-portion inertia J is a total value of the inertia of a portion that is movable with rotations of the motor 1. In
Information regarding the movement amount D, the movement time T, and the maximum acceleration Amax can be stored such that they are registered in advance in the command generation unit 10 as a point table. These pieces of information can be given to the command generation unit 10 in such a manner that the command generation unit 10 receives them from the programmable logic controller simultaneously with the positioning start signal. Information regarding the movable-portion inertia J and the capacitance C of the smoothing capacitor 23 is stored in advance in the command generation unit 10.
At Step S101, the command generation unit 10 monitors whether it is a time to start a positioning control. Specifically, the command generation unit 10 monitors the time at which a positioning start signal is switched from OFF to ON. When the command generation unit 10 determines that it is not a time to start a positioning control (NO at Step S101), the command generation unit 10 continues the monitoring. When the command generation unit 10 determines that it is a time to start a positioning control (YES at Step S101), the process flow shifts to Step S102.
At Step S102, the command generation unit 10 obtains positioning-operation specification information and reference command-pattern information. The positioning-operation specification information is information needed to configure a positioning command value. The movement amount D, the movement time T, and the maximum acceleration Amax are specific examples of the positioning-operation specification information. The movement time indicates a time required for the mechanical load to start moving from a stopping state, then finish moving, and return to a stopping state. The maximum acceleration indicates an upper-limit value of an absolute value of the acceleration obtained by the mechanical load and the motor 1.
The reference command-pattern information is information that is required for performing a positioning operation and that designates the shape of a positioning command value. The reference command-pattern information includes a command pattern that is command-velocity and command-acceleration pattern information.
At Step S103, the command generation unit 10 calculates a regenerative-power-amount estimated value E1 that is estimated to be produced when a positioning operation is performed according to a pattern with a positioning command value following the reference command-pattern information by a preset movement amount for a preset movement time designated by the positioning-operation specification information. This is one of the specific calculation methods and, on the basis of the peak velocity vp of a velocity command calculated from the positioning specification information and the reference command-pattern information that are obtained at Step S102 and on the basis of the movable-portion inertia J of the mechanical load and the motor 1, the command generation unit 10 calculates E1 as follows.
[Expression 1]
E1=1/2·J·vp2 (1)
At Step S104, the command generation unit 10 calculates energy E2 that is storable in the smoothing capacitor 23. This is one of the specific calculation methods and, by using the capacitance C of the smoothing capacitor 23, a reference bus-voltage value V0 and a bus-voltage value Von at which the regenerative transistor 25 is ON, the command generation unit 10 calculates E2 as follows.
[Expression 2]
E2=1/2·C·Von2−1/2·C·V02 (2)
The reference bus-voltage value V0 indicates a steady voltage value that is output from a converter, i.e., a bus-voltage value when an AC power supply is connected to the amplifier 7, a voltage command is not given to an inverter, and a motor is not operated. In the case where a rectifying unit is a diode stack, a peak value of AC power-supply voltage, which is √2 times as high as an effective voltage of the AC power supply, corresponds to the reference bus-voltage value.
For example, at an AC power-supply voltage of AC 200 volts, 200×√2=283 volts, i.e., a peak value of the AC power supply, is approximately the reference bus voltage V0. This reference bus voltage V0, the capacitance C of the smoothing capacitor 23, and the bus-voltage value Von at which the regenerative transistor 25 is ON are also stored in advance in the command generation unit 10. Therefore, the command generation unit 10 can perform the calculation at Step S104.
At Step S105, the command generation unit 10 compares the regenerative-power-amount estimated value E1 calculated at Step S103 with the energy E2 that is storable in the smoothing capacitor 23 and calculated at Step S104. When the regenerative-power-amount estimated value E1 is equal to or less than the energy E2 that is storable in the smoothing capacitor 23 (YES at Step S105), the process flow shifts to Step S106. When the regenerative-power-amount estimated value E1 is not equal to or less than the energy E2 (NO at Step S105), the process flow shifts to Step S107.
At Step S106, a reference command pattern is selected as a positioning-control command pattern to be used as a positioning-control command value.
At Step S107, on the basis of given positioning-operation specification information, the command generation unit 10 selects a command pattern with the minimum peak velocity of the motor 1.
The acceleration time and the deceleration time are represented as T1, a constant-velocity time is represented as T2, and a constant velocity is represented as vp. Each of T1, T2, and vp is expressed as follows by using the movement amount D, the movement time T, and the maximum acceleration Amax.
When the process at Step S106 or Step S107 is finished, the process flow shifts to Step S108. At Step S108, the command generation unit 10 generates a positioning-control command value selected at Step S106 or Step S107 at a time interval, and it operates the motor to start a positioning operation in practice. The motor is not operated before shifting to Step S108. Upon selecting a positioning-control command value at Step S106 or S107, a positioning control is started in practice at Step S108.
In this manner, the positioning control device executes a positioning control according to the processes illustrated in the flowchart in
Next, effects of the present embodiment are described.
A bus voltage immediately before performing a positioning operation is a reference bus voltage when an initial positioning operation has not yet been performed since a supply of AC voltage from the AC power supply 23 to the amplifier 7, or when a sufficient amount of time has elapsed since the last positioning operation. Upon performing a positioning operation, the motor 1 displays a behavior in the following manner. The motor 1 performs an accelerating operation from a stopping state, that is, from the 0-velocity state, and thereafter maintains a constant velocity. When the position of the motor 1 comes near to a target distance, the motor 1 performs a decelerating operation and then stops.
At this time, the bus voltage is varied depending on whether the motor 1 is in an accelerating state where the motor 1 is working, or in a regenerative state where work is performed on the motor 1. When the motor 1 performs an accelerating operation, the motor 1 consumes power so as to give kinetic energy to the motor 1 and the mechanical load. Because the amplifier 7 consumes power to supply energy to the motor 1, the bus voltage displays a behavior such that it become lower than the reference bus-voltage value. When the bus voltage becomes equal to or lower than the reference bus voltage, the converter unit 22 supplies power such that the bus voltage becomes the reference bus-voltage value. In a case of a low friction of the mechanical load, the motor 1 does not need to generate greater torque during the time in which the motor 1 runs at a constant velocity. Therefore, work performed by the motor 1 is considered almost 0. Accordingly, the motor 1 hardly consumes power. Consequently, during the period in which the motor 1 is at a constant velocity, power is supplied from the converter unit 22, and thus the bus voltage returns to a value at around the reference bus voltage. When the motor performs a decelerating operation, kinetic energy of the motor 1 and the mechanical load is decreased, and thus regenerative power is produced. The decreased kinetic energy is converted to regenerative power, and therefore the bus voltage increases from the reference bus-voltage value.
As described above, when the bus voltage increases and reaches a regenerative-transistor ON voltage that is a preset voltage value, then the regenerative transistor 25 is ON, and regenerative power is consumed by the regenerative resistance 24. Therefore, the bus voltage decreases to lower than the regenerative-transistor ON voltage. However, as illustrated in
Assuming that this regenerative-power-amount estimated value E1 is all stored in the smoothing capacitor 23, regenerative power is not consumed by the regenerative resistance 24. How much energy can be stored in the smoothing capacitor 23 can be estimated by the expression (2). This is equivalent to the difference between energy (=1/2·C·Von2) stored in the smoothing capacitor 23 when the bus-voltage value is the regenerative-transistor ON voltage value, and energy (=1/2·C·V02) stored in the smoothing capacitor 23 when the bus-voltage value is the reference bus-voltage value. That is, the expression (2) expresses the amount of energy that can be stored when the bus voltage increases from the reference bus voltage to the regenerative-transistor ON voltage.
The regenerative-power-amount estimated value E1 to be produced during the present positioning operation, which is calculated by the expression (1), is compared with the energy value E2 that is storable in the smoothing capacitor 23, which is calculated by the expression (2). When E1 is smaller than E2, the regenerative power amount to be produced during a positioning operation is not consumed by the regenerative resistance 24 during the present positioning operation, but is all stored in the smoothing capacitor 23. It is possible to reuse the regenerative power amount stored in the smoothing capacitor 23 during the next positioning operation. The power amount required for a positioning operation is made up of a power amount for a motor output and a power amount for power loss. In a case of using a high-efficiency motor 1 such as a servo motor, power for a motor output is more dominant than power loss. Power for a motor output is converted to kinetic energy for the motor 1 and the mechanical load mainly during an accelerating operation.
At Step S105 in
Meanwhile, at Step S105 in
In the command pattern illustrated by the expression (3), the motor 1 performs an accelerating operation always at the maximum acceleration Amax in order to move the mechanical load by the preset movement amount D for the preset movement time T, then maintains the accelerating operation for the preset constant-velocity time, and thereafter performs a decelerating operation always at maximum acceleration −Amax. Assuming that an upper-limit value of the acceleration is not set, a command pattern, in which the velocity is lowest among the command patterns in which the mechanical load moves by the movement amount D for the movement time T, is a command pattern in which the mechanical load moves at a velocity D/T from the time 0, that is at the start, to the time T. In this command pattern, the acceleration time and the deceleration time are both 0. However, in the command pattern as described above, the acceleration is infinite. Therefore, when an upper-limit value of the acceleration is set, it is impossible to implement this command pattern.
Therefore, in order to perform positioning by the preset movement amount D for the preset movement time T so as to minimize the peak velocity, while the absolute value of the acceleration is made equal to or less than Amax, it is necessary to perform an accelerating operation for a shortest time as possible, and to perform a decelerating operation for a shortest time as possible. That is, it is an operation to perform an accelerating operation and a decelerating operation at the maximum acceleration Amax. This command pattern is illustrated by the expression (3). In this command pattern, the peak velocity is minimized when an upper-limit value of the acceleration is set.
In the present embodiment, there has been described the example, in which when the energy amount E2 that is storable in the smoothing capacitor 23 is calculated, the calculation expression (2) is used to calculate the energy amount E2 on the basis of information regarding the capacitance C of the smoothing capacitor 23, the bus-voltage value Von at which the regenerative transistor 25 is ON, and the reference bus voltage V0. Therefore, assuming that there is no change in the amplifier 7, a calculation value derived from the expression (2) remains unchanged. Accordingly, the energy amount that is storable in the smoothing capacitor 23, which is associated with the amplifier 7, is calculated in advance by using the expression (2). This calculated value can be stored in the command generation unit 10 in order that the command generation unit 10 obtains this value so as to process.
In the first embodiment, there has been described the example in which the expression (2) is used to calculate the regenerative power amount that is storable in the smoothing capacitor 23. The calculation method is not limited thereto. In a second embodiment of the present invention, an example of calculating the regenerative power amount using an expression other than the expression (2) is described.
The flowchart in
[Expression 5]
E2=(1/2·C·Von2−1/2·C·V02)·G (5)
When the process at Step S104b is finished, the process flow shifts to the processes at Step S105 and the subsequent steps. In
Also in the present embodiment, before performing a positioning operation in practice, the command generation unit 10 calculates the regenerative-power-amount estimated value E1 when the motor 1 operates in a reference command pattern, and selects a positioning-control command value according to a result of the comparison between this regenerative-power-amount estimated value E1 and the energy value E2 to be stored in the smoothing capacitor 23. This operation is the same as in the first embodiment, and therefore an effect of decreasing the power consumption amount during a positioning operation can be obtained.
Effects, which cannot be obtained from the first embodiment but from the present embodiment, are described. The second embodiment is different from the first embodiment in that the energy amount, storable in the smoothing capacitor 23, is calculated using the expression (5) instead of the expression (2). Between the expression (5) and the expression (2), the energy amount E2 is different with a factor of the correction coefficient G. Because the correction coefficient G is greater than 1, the amount of energy to be stored in the smoothing capacitor 23 is calculated to be greater in the present embodiment than a value calculated by the expression (2). What this means physically is described with reference to
As illustrated in
As illustrated in
For example, it is considerable to measure a bus-voltage value immediately before the start of a decelerating operation when a positioning operation is performed in advance, and to decide the correction coefficient G as a ratio between an energy value that is storable in the smoothing capacitor 23 that is calculated from the measured bus-voltage value and an energy value that is storable in the smoothing capacitor 23 which is calculated by the expression (2). The energy value that is storable in the smoothing capacitor 23 and that is calculated from the bus-voltage value is a value calculated by substituting the bus-voltage value immediately before the start of a decelerating operation for the reference bus voltage.
In the present embodiment, before the positioning starts, the regenerative power amount to be produced during the present positioning operation and the amount of energy that is storable in the smoothing capacitor 23 are calculated. According to a result of the comparison between these amounts, positioning command patterns are selectively used. Because this operation is the same as in the first embodiment, the present invention has same effects to those in the first embodiment. Further, according to the present embodiment, as compared to the first embodiment, the amount of energy to be stored in the smoothing capacitor 23 is estimated more accurately. This makes it possible to select a command value that is more advantageous to reduce the consumption power amount during a positioning operation.
In the first and second embodiments, there has been described the example in which the regenerative power amount that is storable in the smoothing capacitor 23 is calculated on the basis of the reference bus voltage V0. However, it is possible to calculate the energy E2 that is storable in the smoothing capacitor 23 without using the reference bus voltage V0. In a third embodiment of the present invention, such a case is described.
The flowchart in
[Expression 6]
E2=1/2·C·Von2−1/2·C·Vdc2 (6)
The expression (6) is different from the expression (2) in that the reference bus voltage V0 is replaced with the bus voltage Vdc. As described in the second embodiment, the expression (6) can be further multiplied by the correction coefficient G (>1) to calculate the energy amount E2 that is storable in the smoothing capacitor 23. That is, the energy amount E2 can be calculated by the following expression (7).
[Expression 7]
E2=(1/2·C·Von2−1/2·C·Vdc2)·G (7)
When the process at Step S104c is finished, the processes at Step S105 and the subsequent steps are performed. At Step S105 and the subsequent steps, the processes at Step S105 and the subsequent steps described in the first embodiment are performed. According to the processes in
Also in the present embodiment, before performing a positioning operation in practice, the command generation unit 10 calculates the regenerative-power-amount estimated value E1 when the motor 1 operates in a reference command pattern, and selects a positioning-control command value according to a result of the comparison between this regenerative-power-amount estimated value E1 and the energy value E2 to be stored in the smoothing capacitor 23. This operation is the same as in the first embodiment, and therefore the effect of decreasing the power consumption amount during a positioning operation can be obtained.
Effects, which can be obtained not from the first or second embodiment, but from the present embodiment, are described.
As described in the first and second embodiments, upon performing a positioning operation, the motor 1 consumes power during an accelerating operation and during a constant-velocity operation. Therefore, the value of bus voltage is smaller than the reference bus voltage V0. During this period, the converter unit 22 in the amplifier 7 supplies power to the inverter unit 26. On the other hand, during a decelerating operation, the motor 1 is in a regenerative state. From the start of a decelerating operation, kinetic energy of the mechanical load and the motor 1 is stored in the smoothing capacitor 23. As a result, the bus voltage increases. In a positioning control, the motor 1 reaches a certain velocity from a stopping state, and thereafter enters back into a stopping state. Therefore, the kinetic energy is 0 when the positioning starts, that is, when starting an accelerating operation, and when the positioning ends, that is, when finishing a decelerating operation. However, in a state where the bus voltage is lower than the reference bus voltage V0 during an accelerating operation, the inverter unit 26 receives a power supply from the converter unit 22. Therefore, the bus voltage when finishing a positioning operation is generally greater than a bus voltage during starting the positioning operation. In a case of intermittently performing a positioning operation, a certain positioning operation, that is, a positioning operation X in
In the flowchart in
As expressed by the expression (7), the energy value E2 is multiplied by the correction coefficient G, for example, when the following is taken into account. That is, before starting a positioning operation, it is necessary to decide whether to perform a positioning operation in a reference command pattern. Therefore, as bus-voltage actual-measurement data, the bus voltage Vdc when starting a positioning operation is only obtained. However, the amount of energy to be stored in the smoothing capacitor 23 actually depends on the bus voltage when starting a decelerating operation. Therefore, due to a decrease in bus voltage caused by an accelerating operation from the time of starting a positioning operation during the time of starting a decelerating operation, the amount of energy to be stored in the smoothing capacitor 23 is increased. Accordingly, taking into account this increase, the energy value E2 is multiplied by the correction coefficient G.
This makes it possible to more accurately determine whether the regenerative power amount to be produced during a positioning operation is consumed by the regenerative resistance 24. Therefore, based on given positioning-operation specifications, it is possible to appropriately select whether to perform a positioning operation in a reference command pattern, or to perform a positioning operation in a command pattern with the minimum peak velocity, so that it becomes more advantageous to reduce the power consumption amount. Accordingly, an effect can be obtained, in which it is possible to select a command value that is more advantageous to reduce the power consumption amount during a positioning operation.
In the first, second, and third embodiments, reference command-pattern information is input to acquire the regenerative-power-amount estimated value E1 that is estimated when a command value for the present positioning operation is generated according to the reference command pattern. By selecting a command value on the basis of a result of the comparison between the regenerative-power-amount estimated value E1 and the energy amount E2 that is storable in the smoothing capacitor 23, the positioning control device executes a positioning control. In a fourth embodiment of the present invention, a configuration is described, in which a certain command value can be used as a reference command pattern in order to further reduce the power consumption amount during a positioning control.
At Step S102b, the movement amount D, the movement time T, and the maximum acceleration Amax are input as positioning-operation specification information.
Thereafter, at Step S102c, the reference command pattern is defined as a command pattern in which the acceleration is gradually decreased from the time of starting acceleration, and the deceleration is gradually increased from the time of starting deceleration; or as a command pattern in which from the time of starting acceleration, the acceleration is maintained at the constant acceleration, which is the maximum acceleration, for a preset period, and thereafter the acceleration is gradually decreased, and after shifting to deceleration, the deceleration is gradually increased, and thereafter maintained at the constant deceleration, which is the maximum deceleration, for a preset period. The maximum deceleration is negative maximum acceleration.
Where Ap represents the acceleration when starting an accelerating operation, and the deceleration when finishing a decelerating operation, and by using the movement amount D and the movement time T, Ap is expressed as follows.
The peak velocity vp upon positioning in a command pattern according to the acceleration that can be expressed by the expression (8) can be calculated as a value obtained by integrating the expression (8) with respect to the time 0 to the time T/2. Therefore, the following expression holds.
[Expression 10]
vp=A
p
·T/4 (10)
The command pattern, in which the acceleration is gradually decreased with the start of an accelerating operation and the deceleration is increased with the start of deceleration, is not limited to the expression (8). The expression (8) shows a gradual linear decrease in the acceleration with the start of an accelerating operation, and a linear increase in the deceleration with the time of starting deceleration. However, the command pattern is not necessarily limited to a linear acceleration/deceleration pattern, and can be a pattern with a trigonometric function curve with respect to the time “t”, such as a cosine (cos) curve, or a pattern with a high-order-polynomial curve with respect to the time “t”.
A command pattern illustrated in
Where the following expression holds.
The peak velocity vp upon positioning in a command pattern according to the acceleration that can be expressed by the expression (11) can be calculated as a value obtained by integrating the expression (11) with respect to the time 0 to the time T/2. Therefore, the following expression holds.
The command pattern, in which from the time of starting acceleration, the acceleration is maintained at the constant acceleration, that is the maximum acceleration, for a preset period, and thereafter the acceleration is gradually decreased, and after shifting to deceleration, the deceleration is gradually increased, and thereafter maintained at the constant deceleration, that is the maximum deceleration, for a preset period, is not limited to the expression (11). The expression (11) shows a gradual linear decrease in the acceleration, or a gradual linear decrease in the acceleration with the start of a decelerating operation, and shows a linear increase in the deceleration with the time of starting deceleration. However, the command pattern is not necessarily limited to a linear acceleration/deceleration pattern, and can be a pattern with a trigonometric function curve with respect to the time “t”, such as a cosine curve, or a pattern with a high-order-polynomial curve with respect to the time “t”.
At Step S103 and the subsequent steps, processes identical to those in
Next, effects of the present embodiment are described. In the present embodiment, identically to the first, second, and third embodiments, the regenerative power amount to be produced during the present positioning operation is estimated before the positioning start, and this estimated value E1 is compared with the energy value E2 that is storable in the smoothing capacitor 23. When the regenerative-power-amount estimated value E1 is greater than the energy value E2, a command pattern with the minimum peak velocity under given positioning conditions is selected. Therefore, an effect is obtained, which minimizes the regenerative power amount that cannot be reused, and is consumed by the regenerative resistance 24, and decreases the power consumption amount during a positioning operation.
As a reference command pattern, a typical command pattern, illustrated by the expression (8) in
That is, according to the present embodiment, when the regenerative-power-amount estimated value E1 to be produced during a positioning operation is determined to be equal to or less than the energy amount E2 that is storable in the smoothing capacitor 23 at Step S105 in
The power consumption amount required during a positioning operation is made up of a power amount for an output of the motor 1 and a power amount for power loss. During an accelerating operation, the output of the motor 1 is converted to kinetic energy for the motor 1 and the mechanical load. Further, during a decelerating operation, this kinetic energy is converted to the regenerative power amount as described in the first, second, and third embodiments. When the regenerative power amount to be produced during a positioning operation is all stored in the smoothing capacitor 23 (YES at Step S105), the process flow shifts from Step S105 to Step S106 in
Meanwhile, performing a positioning operation involves an accelerating operation and a decelerating operation. In order for the motor 1 to perform an accelerating operation and a decelerating operation, it is necessary for the motor 1 to generate torque. In order to generate torque, it is necessary to flow a current through the motor 1. When a current flows through the motor 1, power loss occurs. Therefore, when the process flow shifts to Step S106, the command pattern is configured to minimize the power loss. This makes it possible to further decrease the power consumption amount during a positioning operation.
A major factor of the power loss is copper loss caused by a current that flows through a motor winding resistance. By using a current I(t) that flows through the motor 1 during a positioning operation, the copper loss caused in the motor winding resistance during a positioning operation is expressed as follows.
[Expression 14]
R∫
0
T
I(t)2dt (14)
Further, where a(t) represents the motor acceleration, the following expression of motion of the motor 1 and the mechanical load holds.
[Expression 15]
J·a(t)=Kt·I(t) (15)
(J: inertia of a movable portion of the motor and the mechanical load, a(t): motor acceleration, Kt: motor torque constant) Therefore, there is a proportional relation between the current and the acceleration. A command pattern, in which the mechanical load moves by a present movement amount D for a present movement time T, and the above expression (14) is minimized, is expressed by the expression (8). This command pattern has characteristics that the acceleration is gradually decreased from the time of starting acceleration, and the deceleration that is the negative acceleration is gradually increased from the time of starting deceleration. Due to this behavior, an effect of decreasing copper loss can be obtained.
This effect is described using three command patterns illustrated in
[Expression 16]
(α·T/4+(α/2)·T/4+(α/2)·T/4+α·T/4)/T=24/7·D/T2 (16)
In contrast to the command pattern in
The command patterns illustrated in
At this time, a winding resistance R of the motor 1 is used to calculate L1, L2, and L3 as follows.
That is, when positioning is performed by the identical movement amount D for the identical movement time T, the most effective command pattern in decreasing copper loss is the command pattern as illustrated in
There is a case where when the command pattern as typically illustrated by the expression (8) is used, in which the acceleration is gradually decreased from the time of starting acceleration, and the deceleration is gradually increased from the time of starting deceleration, the acceleration during a positioning operation may exceed the maximum acceleration Amax. In that case, the command pattern as illustrated by the expression (11) is used, in which during starting acceleration, the acceleration is maintained at the maximum acceleration for a certain time, and thereafter decreased gradually, and from the time of starting deceleration, the deceleration is gradually increased, and thereafter is maintained at the maximum acceleration for a certain time. In the command pattern as described above, when a mechanical load moves for the identical movement time T, greater acceleration is employed in the initial period of an accelerating operation, and therefore a higher velocity can be obtained immediately after the positioning start. Also, the greater deceleration is employed in the final period of a decelerating operation, and therefore a relatively higher velocity can be obtained until immediately before the stop of deceleration when the velocity reaches 0. This can be achieved while the maximum value of the acceleration is made equal to or less than the maximum acceleration Amax.
In the first to fourth embodiments described above, an exemplary case has been described, in which a rotary motor is used as the motor 1, and the ball screw 3 converts rotational motion to transitional motion to control positioning of the mechanical load. However, the present invention can also be applied to the case where a motor such as a linear motor that generates power in a linear direction is used to control positioning of a mechanical load.
In
Furthermore, the invention of the present application is not limited to the above embodiments, and when the present invention is carried out, the invention can be variously modified without departing from the scope thereof. In the above embodiments, inventions of various stages are included, and various inventions can be extracted by appropriately combining a plurality of constituent elements disclosed herein. For example, even when some constituent elements are removed from all the constituent elements described in the embodiments, as far as the problems mentioned in the section of Solution to Problem can be solved and effects mentioned in the section of Advantageous Effects of Invention are obtained, the configuration from which some constituent elements have been removed can be extracted as an invention. In addition, constituent elements mentioned in different embodiments can be appropriately combined.
As described above, the positioning control device according to the present invention is useful to reduce the power consumption amount when controlling the positioning of a mechanical load using a motor, and is suitable particularly for a positioning control device that includes an amplifier provided with a smoothing capacitor.
1 motor, 2 encoder, 3 ball screw, 4 positioning head, 5 coupling, 6 motor control device, 7 amplifier, 10 command generation unit, 13 detected information, 14 current, 15 voltage command, 21 AC power supply, 22 converter unit, 23 smoothing capacitor, 24 regenerative resistance, 25 regenerative transistor, 26 inverter unit, 27 bus-voltage detecting circuit, 28 detected bus-voltage value 28 (Vdc).
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2014/067021 | 6/26/2014 | WO | 00 |