WO2015198455A1 - 位置決め制御装置 - Google Patents

位置決め制御装置 Download PDF

Info

Publication number
WO2015198455A1
WO2015198455A1 PCT/JP2014/067021 JP2014067021W WO2015198455A1 WO 2015198455 A1 WO2015198455 A1 WO 2015198455A1 JP 2014067021 W JP2014067021 W JP 2014067021W WO 2015198455 A1 WO2015198455 A1 WO 2015198455A1
Authority
WO
WIPO (PCT)
Prior art keywords
command
acceleration
value
positioning
deceleration
Prior art date
Application number
PCT/JP2014/067021
Other languages
English (en)
French (fr)
Inventor
浩一郎 上田
貴弘 丸下
Original Assignee
三菱電機株式会社
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 三菱電機株式会社 filed Critical 三菱電機株式会社
Priority to DE112014001613.6T priority Critical patent/DE112014001613B4/de
Priority to US14/781,348 priority patent/US9535426B2/en
Priority to KR1020157029765A priority patent/KR101611148B1/ko
Priority to CN201480021861.6A priority patent/CN105393450B/zh
Priority to PCT/JP2014/067021 priority patent/WO2015198455A1/ja
Priority to JP2015524521A priority patent/JP5805353B1/ja
Priority to TW104111203A priority patent/TWI559670B/zh
Publication of WO2015198455A1 publication Critical patent/WO2015198455A1/ja

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00—Programme-control systems
    • G05B19/02—Programme-control systems electric
    • G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
    • G05B19/19—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D13/00—Control of linear speed; Control of angular speed; Control of acceleration or deceleration, e.g. of a prime mover
    • G05D13/66—Governor units providing for co-operation with control dependent upon a variable other than speed
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B11/00—Automatic controllers
    • G05B11/01—Automatic controllers electric
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D3/00—Control of position or direction
    • G05D3/12—Control of position or direction using feedback
    • G05D3/20—Control of position or direction using feedback using a digital comparing device
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/34—Director, elements to supervisory
    • G05B2219/34314—Slow down, limit speed for energy saving

Definitions

  • the present invention relates to a positioning control device.
  • Motors including servo motors are used as drive sources for positioning control in various industrial machines such as transport machines, semiconductor manufacturing equipment, electronic component mounting machines, and robots.
  • industrial machines such as transport machines, semiconductor manufacturing equipment, electronic component mounting machines, and robots.
  • it is necessary to reduce the amount of power consumed when the motor performs a positioning operation, that is, the integrated power.
  • a positioning control command value with a short positioning time but large power consumption and a positioning control command value with a long positioning time but low power consumption are stored so that the user can select them.
  • the technology is disclosed (for example, refer to Patent Document 1).
  • ⁇ Positioning operation involves acceleration and deceleration operations to move the mechanical load from one position to another.
  • the motor consumes electric power.
  • the motor is in a power generation state and regenerative power is generally generated.
  • a motor driving device for driving a motor such as a servo amplifier, is often provided with a regenerative resistor and a regenerative transistor.
  • regenerative power is generated, part of it is consumed by the regenerative resistor, but not all generated regenerative power is consumed by the regenerative resistor, and some remains in the motor drive device. And used for the next positioning operation.
  • This regenerative power is an important factor in considering the amount of power consumed when the motor is driven, and the conventional technology does not consider this regenerative power, so there is a problem that the reduction of the power consumption is not sufficient.
  • the present invention has been made in view of the above, and an object of the present invention is to obtain a positioning control device that reduces power consumption during positioning operation.
  • the present invention includes a converter that rectifies an AC power supply and outputs between buses, a smoothing capacitor that smoothes the output of the converter and generates a bus voltage, Based on a regenerative resistor and regenerative transistor connected between the buses, an amplifier unit having an inverter that supplies a drive current for driving the motor, and a command pattern that is pattern information of command speed and command acceleration, the motor is connected to the motor.
  • a command generation unit that generates a position command value for positioning control of the mechanical load, wherein the inverter is connected between the buses, and the drive current is generated based on the position command value.
  • the command generation unit supplies the predicted value of the regenerative electric power predicted from the command pattern and the smoothing capacitor before starting the positioning operation. Seeking and storable energy value, based on both of the comparison results, the position command value based on the instruction pattern and determining whether to use in the positioning operation.
  • the positioning control device has an effect of reducing power consumption when positioning control of a mechanical load using a motor.
  • FIG. 1 is a block diagram showing the overall configuration of the positioning control apparatus according to the first embodiment of the present invention.
  • FIG. 2 is a flowchart illustrating a processing procedure of the command generation unit according to the first embodiment of the present invention.
  • FIG. 3 is a diagram illustrating an example of a command speed and a command acceleration defined by the reference command pattern according to the first embodiment of the present invention.
  • FIG. 4 is a diagram illustrating an example of a command speed and a command acceleration defined by another reference command pattern according to the first embodiment of the present invention.
  • FIG. 5 is a diagram illustrating an example of a command speed and a command acceleration defined by still another reference command pattern according to the first embodiment of the present invention.
  • FIG. 1 is a block diagram showing the overall configuration of the positioning control apparatus according to the first embodiment of the present invention.
  • FIG. 2 is a flowchart illustrating a processing procedure of the command generation unit according to the first embodiment of the present invention.
  • FIG. 3 is a diagram illustrating an example of a
  • FIG. 6 is a diagram illustrating waveforms of a command speed and a command acceleration that minimize the peak speed of the motor according to the first embodiment of the present invention.
  • FIG. 7 is a diagram illustrating a typical example of the relationship between the motor speed and the bus voltage of the amplifier unit when the positioning operation according to the first embodiment of the present invention is performed.
  • FIG. 8 is a block diagram showing the overall configuration of the positioning control apparatus according to the second embodiment of the present invention.
  • FIG. 9 is a flowchart illustrating a processing procedure of the command generation unit according to the second embodiment of the present invention.
  • FIG. 10 is a diagram showing the relationship between the speed and the bus voltage when a positioning operation without a constant speed operation is performed in the second embodiment of the present invention.
  • FIG. 11 is a diagram showing the relationship between the speed and the bus voltage when the positioning operation is performed when the friction of the mechanical load is relatively large in the second embodiment of the present invention.
  • FIG. 12 is a block diagram showing the overall configuration of the positioning control apparatus according to the third embodiment of the present invention.
  • FIG. 13 is a flowchart showing the process sequence of the instruction
  • FIG. 14 is a diagram illustrating a relationship between the motor speed and the bus voltage when the positioning operation according to the third embodiment of the present invention is intermittently performed a plurality of times.
  • FIG. 15 is a block diagram showing the overall configuration of the positioning control apparatus according to the fourth embodiment of the present invention.
  • FIG. 16 is a flowchart illustrating a processing procedure of the command generation unit according to the fourth embodiment of the present invention.
  • FIG. 17 is a diagram illustrating an example of a command pattern in which the acceleration gradually decreases during the acceleration operation according to the fourth embodiment of the present invention, and the deceleration gradually increases at the start of deceleration.
  • FIG. 18 shows that at the start of acceleration according to the fourth embodiment of the present invention, the acceleration is maintained at a constant acceleration for a predetermined period. Thereafter, the acceleration gradually decreases, and after the deceleration starts, the deceleration gradually increases, and then decreases. It is a figure which shows the example of the command pattern which maintains constant deceleration for the period for which the speed was predetermined.
  • FIG. 17 is a diagram illustrating an example of a command pattern in which the acceleration gradually decreases during the acceleration operation according to the fourth embodiment of the present invention, and the deceleration gradually increases at the start of deceleration.
  • FIG. 18 shows that at the start of
  • FIG. 19 is a diagram showing a command pattern in which the acceleration according to the fourth embodiment of the present invention gradually decreases at the start of acceleration and the deceleration gradually increases at the start of deceleration.
  • FIG. 20 is a diagram illustrating a command pattern in which the acceleration according to the fourth embodiment of the present invention gradually increases at the start of acceleration and the deceleration gradually decreases at the start of deceleration.
  • FIG. 21 is a diagram showing a command pattern in which the acceleration according to the fourth embodiment of the present invention is constant during the acceleration operation and during the deceleration operation.
  • FIG. 1 is a block diagram showing the overall configuration of the positioning control apparatus according to the first embodiment of the present invention.
  • FIG. 1 shows a motor 1, an encoder 2, a ball screw 3, a positioning head 4, a coupling 5, an amplifier unit 7, a command generation unit 10, and an AC power supply 21.
  • the ball screw 3, the positioning head 4, the coupling 5, and the like are mechanical loads connected to the motor 1.
  • the amplifier unit 7 receives a positioning control command value 11 that is a command pattern from the command generation unit 10 and supplies a current 14 to the motor 1 so as to follow the command value.
  • the amplifier unit 7 includes a servo control unit 12, a converter unit 22, a smoothing capacitor 23, a regenerative resistor 24, a regenerative transistor 25, and an inverter unit 26.
  • the regenerative resistor 24 and the regenerative transistor 25 are connected between the buses so as to be in parallel with the smoothing capacitor 23.
  • the regenerative transistor 25 is installed to energize the regenerative resistor 24.
  • the motor 1 is driven by the current 14 from the amplifier unit 7 and serves as a driving source for positioning control.
  • the encoder 2 connected to the motor 1 detects the position and speed of the motor 1 and outputs detection information 13, that is, motor position and speed information.
  • the ball screw 3 is connected to the motor 1 by a coupling 5. The rotational movement of the motor 1 is converted into a translational movement by the ball screw 3, and the movement of the positioning head 4 fixed to the ball screw 3 is controlled.
  • the ball screw 3, the positioning head 4 and the coupling 5 constitute a mechanical load.
  • FIG. 1 shows an example in which the mechanical load is positioned and controlled using the ball screw 3, the present invention is not limited to this, and other mechanisms such as a timing belt and a rack and pinion may be used. Alternatively, a mechanical load positioning control may be realized by combining a plurality of these mechanisms.
  • the AC power supply 21 supplies AC power to the amplifier unit 7.
  • the amplifier unit 7 supplies the current 14 to the motor 1 based on the supplied AC power as follows.
  • Converter unit 22 to which AC power supply 21 is connected rectifies AC power supplied from AC power supply 21 and outputs it between the buses.
  • the converter unit 22 is realized by, for example, a diode stack.
  • the rectified AC power becomes a DC power source smoothed by the smoothing capacitor 23, thereby generating a bus voltage between the buses.
  • the regenerative transistor 25 is turned on (ON) when the bus voltage rises excessively while the motor 1 is operating, causes the regenerative power to be consumed by the regenerative resistor 24, and reduces the bus voltage.
  • the inverter unit 26 performs pulse width modulation (PWM) and supplies the motor 1 with a current 14 for driving the motor 1 so as to follow the command value based on a voltage command 15 described later. To do.
  • PWM pulse width modulation
  • Servo control unit 12 calculates voltage command 15 so that the position of motor 1 follows position command signal 11 which is a positioning command value for positioning control.
  • the position of the motor 1 is given to the servo control unit 12 as motor detection information 13 output from the encoder 2.
  • a specific example of calculating the voltage command 15 includes configuring feedback control based on the position command 11 and the motor position 13, but is not limited to this, and feedforward control may be used in combination.
  • Specific examples of the amplifier unit 7 include a servo amplifier and a general-purpose inverter.
  • the command generation unit 10 generates a position command value 11 for positioning control and outputs the position command value 11 to the amplifier unit 7 and is a component that plays a central role in the present embodiment.
  • the command generation unit 10 performs positioning operations such as a movement amount D during positioning control, a movement time T that is a time from the start to the end of positioning, and a maximum acceleration A max that is the maximum acceleration allowed during the positioning control.
  • a position command value is generated based on the specification information, the movable part inertia J, the capacitance C of the smoothing capacitor 23, reference command pattern information to be described later, and a command start signal that defines the timing for starting positioning.
  • the movable part inertia J is the total value of the inertias of the parts that move as the motor 1 rotates.
  • the sum of the rotor partial inertia of the motor 1 and the inertia of the positioning head 4, the ball screw 3, and the coupling 5 is obtained.
  • a specific example of the command start signal includes ON and OFF (OFF), and an example in which generation of a position command value is started at the moment of switching from OFF to ON is given.
  • a logic controller or the like generates a command start signal, which is given to the command generation unit 10.
  • the information of the movement amount D, the movement time T, and the maximum acceleration A max may be stored in the form of being registered in advance in the command generation unit 10 as a point table, and these information are also programmable at the same time as the positioning start signal. It may be given in the form of receiving simultaneously from the logic controller. Information on the movable part inertia J and the capacitance C of the smoothing capacitor 23 is assumed to be stored in advance in the command generation unit 10.
  • FIG. 2 is a flowchart showing a processing procedure of the command generation unit 10 that plays a central role in the first embodiment of the present invention. The process flow of FIG. 2 will be described below.
  • step S101 it is monitored whether or not it is time to start positioning control. Specifically, the timing at which the positioning start signal is switched from OFF to ON is monitored. If it is determined that it is not time to start positioning control (step S101: No), the monitoring is continued. If it is determined that positioning should be started (step S101: Yes), the process proceeds to step S102.
  • step S102 positioning operation specification information and reference command pattern information are acquired.
  • the positioning operation specification information is information necessary for constructing a positioning command value, and specific examples include a movement amount D, a movement time T, and a maximum acceleration A max .
  • the movement time represents the time required for the mechanical load to start moving from the stopped state, end the movement, and return to the stopped state.
  • the maximum acceleration is the absolute value of the acceleration that the mechanical load or the motor 1 can take. Represents the upper limit.
  • the reference command pattern information is information necessary for performing a positioning operation, and is information for designating the shape of the positioning command value.
  • the reference command pattern information includes command patterns that are command speed and command acceleration pattern information.
  • FIG. 3 is a diagram illustrating an example of a command speed and a command acceleration defined by the reference command pattern according to the first embodiment of the present invention.
  • a specific example of the reference command pattern information is information that the command pattern is a symmetrical triangle if the command pattern used for positioning control is, for example, a command value in which the shape of the command speed is a symmetrical triangle as shown in FIG. It is.
  • a positioning control command value such as 2 can be uniquely defined.
  • the command speed which is a speed pattern represents the differentiation of the position command value
  • the command acceleration which is the acceleration pattern represents a signal obtained by differentiating the command speed. Shall point to. A signal obtained by integrating the command speed once is a command value for positioning control.
  • FIG. 4 is a diagram illustrating an example of command speed and command acceleration defined by another reference command pattern according to the first embodiment of the present invention.
  • Another example of reference command pattern information is that if the command value used for positioning control is a command value in which the shape of the command speed is an asymmetric triangle as shown in FIG. 4, for example, the command pattern is an asymmetric triangle.
  • Information and acceleration a during acceleration operation is that if the command value used for positioning control is a command value in which the shape of the command speed is an asymmetric triangle as shown in FIG. 4, for example, the command pattern is an asymmetric triangle.
  • peak speed vp 2 ⁇ D / T
  • the deceleration represents the absolute value of the acceleration during the deceleration operation.
  • FIG. 5 is a diagram showing an example of command speed and command acceleration defined by still another reference command pattern according to the first embodiment of the present invention.
  • Still another example of the reference command pattern information may include command pattern information with S-curve acceleration / deceleration as shown in FIG.
  • the reference command pattern information is not limited to the above-described example, and is information that prescribes a command value that realizes positioning control to perform the acceleration operation from the stop state and to return to the stop state by performing the deceleration operation. It doesn't matter what it is.
  • step S103 the regenerative power that is specified in the positioning operation specification information and is predicted to be generated when the positioning operation is performed in accordance with the position command value pattern according to the reference command pattern information for a predetermined movement amount for a predetermined movement time.
  • An amount prediction value E1 is calculated.
  • One specific calculation method is based on the peak speed vp of the speed command calculated from the positioning specification information and the reference command pattern information acquired in step S102, the mechanical load, and the movable part inertia J of the motor 1. ,
  • step S104 energy E2 that can be stored in the smoothing capacitor 23 is calculated.
  • One specific calculation method is to use the capacitance C of the smoothing capacitor 23, the bus voltage value Von at which the regenerative transistor 25 is turned on, and the reference bus voltage value V0.
  • the reference bus voltage value V0 is a steady voltage value output by the converter, that is, a bus when the AC power source is connected to the amplifier unit 7, no voltage command is given to the inverter, and the motor is not operated. It shall refer to the voltage value.
  • the rectifier is a diode stack
  • the peak value of the AC power supply voltage that is ⁇ 2 times the effective voltage of the AC power supply corresponds to the reference bus voltage value.
  • the 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 turned on are also stored in the command generation unit 10 in advance, so that the calculation in step S104 can be performed.
  • step S105 the predicted regenerated electric energy E1 calculated in step S103 is compared with the energy E2 that can be stored in the smoothing capacitor 23 calculated in step S104. If the predicted regenerative electric energy E1 is equal to or less than the energy E2 that can be stored in the smoothing capacitor 23 (step S105: Yes), the process proceeds to step S106, otherwise (step S105: No), the process proceeds to step S107. To do.
  • step S106 a reference command pattern is selected as a positioning control command pattern as a positioning control command value.
  • a command pattern that minimizes the peak speed of the motor 1 is selected based on the information of the given positioning operation specification.
  • FIG. 6 is a diagram illustrating waveforms of a command speed and a command acceleration that minimize the peak speed of the motor 1 according to the first embodiment of the present invention.
  • the positioning operation specification is the movement amount D
  • the movement time T and the upper limit value of the absolute value of acceleration is the maximum acceleration A max
  • the acceleration operation and the deceleration operation always have an absolute value as shown in FIG.
  • a speed pattern and an acceleration pattern to be performed at the maximum acceleration A max are selected.
  • the acceleration time and the deceleration time are T 1
  • the constant speed time is T 2
  • the constant speed is vp, which are expressed as follows using the movement amount D, the movement time T, and the maximum acceleration A max , respectively.
  • step S108 the positioning control command value selected in step S106 or S107 is generated every time, the motor is operated, and the positioning operation is actually started.
  • the motor is not operated before entering step S108, and the positioning control is actually started in step S108 after the command value for positioning control is selected in step S106 or S107.
  • the flowchart of FIG. 2 is a flowchart illustrating a process related to one positioning operation. If the positioning operation is intermittently performed a plurality of times, when the current positioning operation is completed, the process returns to step S101 again, and the same processing is repeated for the next positioning operation.
  • FIG. 7 is a diagram illustrating a typical example of the relationship between the motor speed and the bus voltage of the amplifier unit when the positioning operation according to the first embodiment of the present invention is performed.
  • the speed linearly increases in the acceleration operation and the speed linearly decreases in the deceleration operation, but the acceleration operation and the deceleration operation are performed.
  • patterns other than linear acceleration / deceleration such as S-shaped commands.
  • the motor speed since the motor speed is controlled by the amplifier unit 7 so as to follow the command speed, that is, the speed pattern, the motor speed can be regarded as substantially the same as the command speed, that is, the speed pattern.
  • the bus voltage immediately before the positioning operation is the reference bus if the time before the positioning operation for the first time after the AC voltage is supplied from the AC power supply 23 to the amplifier unit 7 or if the time between the previous positioning operation is sufficiently large. Take the voltage.
  • the motor 1 performs the acceleration operation from the stopped state, that is, the state of the speed 0, and then maintains a constant speed, and when the position of the motor 1 approaches the target distance, the motor 1 performs the deceleration operation and stops. Take.
  • the bus voltage fluctuates depending on whether the motor 1 is in the powering state in which the work is performed or the regeneration in the state in which the motor 1 is working.
  • the motor 1 performs an acceleration operation, electric power is consumed and kinetic energy is given to the motor 1 and the mechanical load. Since the amplifier unit 7 consumes power to supply energy to the motor 1, the bus voltage behaves lower than the reference bus voltage value.
  • converter unit 22 supplies power so that the bus voltage becomes the reference bus voltage value.
  • the friction of the mechanical load is small, since the motor 1 does not need to generate a large torque during the time when the motor 1 takes a constant speed, the work performed by the motor 1 can be regarded as almost zero. For this reason, power is hardly consumed.
  • the regenerative transistor 25 when the bus voltage rises and reaches the regenerative transistor ON voltage that is a predetermined voltage value, the regenerative transistor 25 is turned on, the regenerative power is consumed by the regenerative resistor 24, and the bus voltage is less than the regenerative transistor ON voltage. To drop. However, as shown in FIG. 7, when the bus voltage does not reach the regenerative transistor ON voltage even when the decelerating operation is performed and the regenerative state is entered, the regenerative power is not consumed by the regenerative resistor 24. If the bus voltage does not reach the regenerative transistor ON voltage even after the deceleration operation, the regenerative power is stored in the smoothing capacitor 23 between the buses, and the bus voltage increases as the regenerative power is stored in the smoothing capacitor 23.
  • the regenerative electric energy generated during the positioning operation can be regarded as the kinetic energy of the mechanical load.
  • the peak speed is reached to stop at zero speed. Therefore, the equation (1) indicating the kinetic energy calculated from the peak speed is the predicted regenerative electric energy E1 generated during the positioning operation.
  • the regenerative electric energy generated during the positioning operation is not consumed by the regenerative resistor 24 during the current positioning operation, but is entirely stored in the smoothing capacitor 23.
  • the regenerative electric energy stored in the smoothing capacitor 23 can be reused during the next positioning operation.
  • the amount of power required for the positioning operation is composed of the amount of power for the motor output and the amount of power for the loss.
  • a highly efficient motor 1 such as a servo motor is used, the power for the motor output is dominant among the two.
  • the electric power for the motor output mainly becomes the kinetic energy of the motor 1 and the mechanical load during the acceleration operation.
  • step S105 If it is determined in step S105 in FIG. 2 that the process proceeds to step S106 (step S105: Yes), even if the positioning operation is performed using the reference command pattern, the motion that the motor 1 imparts to the mechanical load during the acceleration operation. Since energy is not wasted, power consumption during the positioning operation is small.
  • an S-shaped command or the like that has an effect of reducing shock and vibration as the reference command pattern, there is an effect that positioning control can be performed while reducing both power consumption and vibration shock to some extent.
  • step S105 when it is determined in step S105 in FIG. 2 that the predicted regenerative power amount E1 generated during the current positioning operation is larger than the energy value E2 that can be accumulated in the smoothing capacitor 23 (step S105: No), the positioning operation is performed.
  • the regenerative power cannot be stored in the smoothing capacitor 23, and a part thereof is consumed by the regenerative resistor 24. Since the regenerative power consumed by the regenerative resistor 24 becomes heat, it cannot be reused during the next positioning operation. Minimizing the amount of electric power that is consumed by the regenerative resistor 24 and cannot be reused reduces the amount of power consumed during the positioning operation.
  • the command pattern is as small as possible under the condition that the kinetic energy is as small as possible, that is, the maximum acceleration A max that is the upper limit value of acceleration is given. That is, the command pattern expressed by the expression (3) can reduce the regenerative power consumed by the regenerative resistor 24 as much as possible, and the power consumption during the positioning operation can be reduced.
  • a predetermined movement amount D is moved with a predetermined movement time T, and an acceleration operation is always performed at the maximum acceleration A max and a predetermined constant speed time is maintained. After that, the deceleration operation is always performed at the maximum acceleration ⁇ A max .
  • the command pattern having the smallest speed among the command patterns that move the movement amount D in the movement time T moves at the speed D / T from time 0, that is, from the start to the time T. It is a command pattern. In this command pattern, both the acceleration time and the deceleration time are zero. However, since the acceleration of such a command pattern becomes infinite, it is impossible to realize such a command pattern when there is an upper limit value in the acceleration.
  • This command pattern is a command pattern that can be expressed by equation (3), and when the acceleration has an upper limit value, the command pattern has a minimum peak speed.
  • the amount of energy E2 that can be stored in the smoothing capacitor 23 when calculating the amount of energy E2 that can be stored in the smoothing capacitor 23, from the information of the capacitance C of the smoothing capacitor 23, the bus voltage value Von at which the regenerative transistor 25 is turned on, and the reference bus voltage V0.
  • the example calculated using the formula (2) has been described. Therefore, if the amplifier unit 7 is not changed, the calculated value by the equation (2) does not change. Therefore, the amount of energy that can be stored in the smoothing capacitor 23 corresponding to the amplifier unit 7 is calculated in advance by the equation (2). You may memorize
  • Embodiment 2 FIG. In the first embodiment, an example in which the regenerative electric energy that can be stored in the smoothing capacitor 23 is calculated using the equation (2) has been described, but the present invention is not limited to this. In the present embodiment, an example of calculation other than Expression (2) will be described.
  • FIG. 8 is a block diagram showing the overall configuration of the positioning control apparatus according to the second embodiment of the present invention.
  • the block diagram of FIG. 8 is similar to the block diagram of FIG. 1, and the portions denoted by the same reference numerals are basically the same and will not be described.
  • a part different from FIG. 1 is a command generation unit 10.
  • the command generation unit 10 in FIG. 1 inputs or previously stores information on the movable part inertia J and the capacitance C of the smoothing capacitor 23, whereas the command generation unit 10 in FIG. In addition to the capacity C of 23, information of the correction coefficient G greater than 1 is input or stored in the command generation unit 10 in advance.
  • the correction coefficient G will be described later.
  • FIG. 9 is a flowchart showing a processing procedure of the command generation unit 10 according to the second embodiment of the present invention.
  • the flowchart of FIG. 9 is similar to the flowchart of FIG. About the part which attached
  • step S104 in FIG. 2 is replaced with step S104b in FIG.
  • step S104b the amount of energy E2 stored in the smoothing capacitor 23 is calculated using the capacitance C of the smoothing capacitor 23, the regenerative transistor ON voltage Von, the reference bus voltage V0, and the correction coefficient G (> 1). Using these pieces of information, an energy amount E2 that can be stored in the smoothing capacitor 23 is calculated as in the following equation (5).
  • step S104b When the process of step S104b is completed, the process proceeds to step S105 and subsequent steps. Since the process after step S105 is the same as that of FIG. 2 of Embodiment 1, description is abbreviate
  • positioning control is performed according to the processing of FIG. 9, the power consumption during the positioning operation can be reduced.
  • the regenerative electric energy prediction value E1 in the case of operating with the reference command pattern is calculated, and the comparison result between this and the energy value E2 stored in the smoothing capacitor 23 is obtained.
  • Select a command value for positioning control Since this point is the same as in the first embodiment, an effect of reducing the power consumption during the positioning operation can be obtained.
  • the effect obtained in the present embodiment, which cannot be obtained in the first embodiment, will be described.
  • the difference between the second embodiment and the first embodiment is that the amount of energy that can be stored in the smoothing capacitor 23 is calculated by the equation (5) instead of the equation (2).
  • the equation (5) and the equation (2) differ from each other by a correction coefficient G times, and G> 1, so that the value calculated by the equation (2) is stored in the smoothing capacitor 23 in the present embodiment.
  • the energy will be calculated greatly. This physical meaning will be described with reference to FIGS.
  • FIG. 10 is a diagram showing the relationship between the speed of the motor 1 and the bus voltage when the positioning operation is performed according to the command pattern for performing the decelerating operation immediately after the end of the accelerating operation.
  • the bus voltage decreases because the motor 1 consumes electric power.
  • the motor 1 enters a regenerative state and thus the bus voltage increases. To do.
  • the bus voltage at the start of the deceleration operation takes a value smaller than the reference bus voltage V0.
  • Regenerative power is generated from the time when the deceleration operation is started, and the bus voltage starts to rise.
  • the amount of energy that can be stored in the smoothing capacitor 23 depends on the square difference of the voltage taken by the bus voltage. In the equation (2), it is shown as a square difference between the regenerative transistor ON voltage Von and the reference bus voltage V0. If this difference is large, more energy can be stored. Conversely, if it is small, only that much energy can be stored.
  • the bus voltage at the start of the deceleration operation takes a value smaller than the reference bus voltage V0, energy larger than the value represented by the equation (2) can be stored in the smoothing capacitor 23.
  • FIG. 11 is a graph showing the relationship between the motor speed and the bus voltage when the positioning operation is performed with a command pattern having a constant speed time when the friction of the mechanical load is relatively large.
  • the bus voltage is reduced when the acceleration operation is performed, and the bus voltage is increased when the deceleration operation is performed.
  • a part of the power consumed by the motor 1 includes the power consumed for the motor output.
  • Motor output is represented by the product of motor torque and motor speed. If the friction of the mechanical load is small, the motor torque becomes almost zero when the speed is constant, and the output of the motor 1 becomes almost zero. Thereby, the motor 1 consumes little electric power.
  • the motor drive device consumes electric power, and when the motor 1 is at a constant speed and immediately before starting the deceleration operation, the bus voltage exhibits a behavior that becomes smaller than the reference bus voltage V0.
  • the smoothing capacitor 23 in this situation is obtained by multiplying the energy value that can be stored in the smoothing capacitor 23 calculated by the equation (2) by a correction coefficient G (> 1) as shown in the equation (5).
  • the energy value that can be stored in can be estimated more accurately.
  • the correction coefficient G is, for example, an energy value that can be stored in the smoothing capacitor 23 calculated from the bus voltage value obtained by measuring the bus voltage value immediately before starting the deceleration operation when the positioning operation is performed in advance. It is conceivable that the ratio is determined as a ratio with the energy value that can be stored in the smoothing capacitor 23 calculated by the equation (2).
  • the energy value that can be accumulated in the smoothing capacitor 23 calculated from the bus voltage value is a value calculated by substituting the bus voltage value immediately before the start of the deceleration operation in place of the reference bus voltage.
  • the amount of regenerative electric power generated during the current positioning operation and the energy that can be stored in the smoothing capacitor 23 are calculated, and different positioning command patterns are used according to the comparison results.
  • the energy stored in the smoothing capacitor 23 can be estimated more accurately than in the first embodiment. Therefore, it is possible to select a command value that is advantageous for reducing the power consumption during the positioning operation. Has the effect of becoming possible.
  • Embodiment 3 FIG.
  • the example of calculating the regenerative electric energy that can be stored in the smoothing capacitor 23 based on the reference bus voltage V0 has been described.
  • FIG. 12 is a block diagram showing the overall configuration of the positioning control apparatus according to the third embodiment of the present invention.
  • the block diagram of FIG. 12 is similar to the block diagram of FIG. 1 described in the first embodiment and the block diagram of FIG. 8 described in the second embodiment. The description is omitted because the operation is similar. 12 differs from FIG. 1 and FIG. 8 in that FIG. 12 includes a bus voltage detection circuit 27 and the detected bus voltage value 28 (Vdc) is input to the command generation unit.
  • FIG. 13 is a flowchart showing a processing procedure of the command generation unit 10 according to the third embodiment of the present invention.
  • the flowchart of FIG. 13 is similar to the flowchart of FIG. 2 described in the first embodiment and the flowchart of FIG. 9 described in the second embodiment.
  • step S103 the bus voltage detection circuit 27 detects the bus voltage value Vdc in step S110. Thereafter, in step S104c, an energy amount E2 that can be stored in the smoothing capacitor 23 is calculated using the detected bus voltage value 28 (Vdc). The specific calculation is the following equation (6).
  • the difference between (6) and (2) is that the reference bus voltage V0 is replaced with the bus voltage Vdc.
  • the amount of energy E2 that can be stored in the smoothing capacitor 23 may be calculated by further multiplying the equation (6) by the correction coefficient G (> 1). That is, E2 may be calculated as the following equation (7).
  • step S104c When the process of step S104c is completed, the processes after step S105 are executed. Regarding the processing after step S105, the processing after step S105 described in the first embodiment is performed. When positioning control is performed in accordance with the processing of FIG. 13, the power consumption during the positioning operation can be reduced.
  • the regenerative electric energy prediction value E1 in the case of operating with the reference command pattern is calculated, and the comparison result between this and the energy value E2 stored in the smoothing capacitor 23 is obtained.
  • Select a command value for positioning control Since this point is the same as in the first embodiment, an effect of reducing the power consumption during the positioning operation can be obtained.
  • FIG. 14 is a diagram illustrating the relationship between the motor speed and the bus voltage when the positioning operation according to the third embodiment of the present invention is intermittently performed a plurality of times. Specifically, the example of FIG. 14 represents the relationship between the motor speed and the bus voltage when the positioning operation is performed twice intermittently. The effect of this Embodiment is demonstrated using FIG.
  • the motor 1 consumes power during the acceleration operation and the constant speed operation, so the bus voltage takes a bus voltage smaller than the reference bus voltage V0, During this time, the converter unit 22 of the amplifier unit 7 supplies power to the inverter unit 26.
  • the regenerative state occurs during the deceleration operation, and the mechanical load and the kinetic energy of the motor 1 are stored in the smoothing capacitor 23 from the start of the deceleration operation. As a result, the bus voltage increases.
  • the positioning control Since the positioning control reaches a certain speed from the stop state and then stops again, the kinetic energy is 0 at the start of positioning, which is the start of acceleration operation, and at the end of positioning, which is the end of deceleration operation. However, since the power is supplied from the converter unit 22 when the bus voltage is lower than the reference bus voltage V0 during the acceleration operation, the bus voltage at the end of the positioning operation is generally higher than the bus voltage at the start of the positioning operation. Also grows. When the positioning operation is performed intermittently, a certain positioning operation, that is, the positioning operation X in FIG. 14 is performed, and after stopping for a while, another positioning operation, that is, the positioning operation Y in FIG. 14 is started. .
  • the bus voltage Vdc immediately before or at the start of the positioning operation is acquired in step S110, and the energy amount that can be stored in the smoothing capacitor 23 in step S104c is expressed by the equations (6) and (7).
  • the energy value E2 stored in the smoothing capacitor 23 in the case shown in FIG. 14 can be accurately calculated.
  • Multiplying the correction coefficient G as in equation (7) is, for example, when the following is taken into consideration. That is, before starting the positioning operation, it is necessary to determine whether or not to perform the positioning operation with the reference command pattern. Therefore, only the bus voltage Vdc at the time of starting the positioning operation can be obtained as the measured data of the bus voltage.
  • the energy stored in the smoothing capacitor 23 depends on the bus voltage at the start of the deceleration operation. Therefore, the energy stored in the smoothing capacitor 23 increases due to the decrease in the bus voltage due to the acceleration operation from the start of the positioning operation to the start of the deceleration operation.
  • Embodiment 4 FIG.
  • reference command pattern information is input, and a regenerative electric energy predicted value E1 predicted when a command value for the current positioning operation is generated according to the reference command pattern is obtained.
  • Positioning control was executed while selecting a command value based on the comparison result with the amount of energy E2 that can be stored in 23.
  • a configuration will be described in which a certain command value is used as a reference command pattern, thereby further reducing the power consumption during positioning control.
  • FIG. 15 is a block diagram showing the overall configuration of the positioning control apparatus according to the fourth embodiment of the present invention.
  • FIG. 15 has portions in common with the block diagram of FIG. 1, and description of portions similar to those of FIG. 1 is omitted.
  • the difference between FIG. 15 and the block diagram of FIG. 1 is that there is no input of reference command pattern information from the outside to the command generation unit 10 and the command generation unit 10 holds a predetermined reference command pattern described below. It is a point.
  • FIG. 16 is a flowchart showing a processing procedure of the command generation unit 10 according to the fourth embodiment of the present invention.
  • the flowchart in FIG. 16 has portions in common with the flowchart in FIG. 2, and description of the same portions as those in FIG. 2 is omitted. 16 differs from the flowchart in FIG. 2 in that step S102 in FIG. 2 is replaced with step S102b and step S102c.
  • step S102b a movement amount D, a movement time T, and a maximum acceleration A max are input as positioning operation specification information.
  • the reference command pattern is a command pattern in which the acceleration gradually decreases at the start of acceleration and the deceleration gradually increases at the start of deceleration, or the acceleration maintains a constant acceleration, that is, a maximum acceleration for a predetermined period at the start of acceleration.
  • the acceleration gradually decreases, and after changing to deceleration, the deceleration gradually increases, and then the deceleration is set to a command pattern for maintaining a constant deceleration for a predetermined period, that is, a maximum deceleration.
  • the maximum deceleration is a negative maximum acceleration.
  • the peak speed vp when positioning is performed according to the acceleration that the command pattern can be expressed by the equation (8) can be calculated as a value obtained by integrating the equation (8) from the time 0 to the time T / 2. It is.
  • the command pattern in which the acceleration gradually decreases as the acceleration operation starts and the deceleration increases as the deceleration starts is not limited to equation (8).
  • equation (8) the acceleration gradually decreases linearly with the start of the acceleration operation, and the deceleration increases linearly with the start of the deceleration.
  • a time such as a cosine curve is required. It may be a trigonometric function relating to t or a curve represented by a high-order polynomial relating to time t.
  • the acceleration is maintained at a constant acceleration for a predetermined period, that is, the maximum acceleration is maintained.
  • the acceleration gradually decreases, the deceleration gradually increases after turning to deceleration, and then the deceleration is constant deceleration for a predetermined period.
  • a specific example of the command pattern for maintaining the maximum deceleration is the command pattern shown in FIG. 18, and the acceleration is represented by the following equation (11). here, It is.
  • the peak speed vp when positioning is performed according to the acceleration that the command pattern can be expressed by the equation (11) can be calculated by integrating the equation (11) from time 0 to time T / 2. It is.
  • the acceleration is maintained at a constant acceleration for a predetermined period at the start of acceleration, that is, the maximum acceleration is maintained. Thereafter, the acceleration gradually decreases, the deceleration gradually increases after turning to deceleration, and then the deceleration is constant for a predetermined period.
  • the command pattern for maintaining the deceleration, that is, the maximum deceleration is not limited to the equation (11).
  • the acceleration gradually decreases linearly, or the acceleration decreases linearly with the start of the deceleration operation, and the deceleration increases linearly with the start of the deceleration, but is not necessarily limited to a straight line.
  • a trigonometric function related to time t such as a cosine curve, or a curve represented by a higher-order polynomial related to time t may be used.
  • step S103 the same processing as in the first embodiment is performed. Further, similarly to the second and third embodiments, the process of step S104b or step S104c may be executed instead of step S104.
  • the amount of regenerative electric power generated during the current positioning operation is predicted before the positioning start, and the predicted value E1 and the energy value E2 that can be stored in the smoothing capacitor 23
  • the command pattern that minimizes the peak speed under the given positioning conditions is the same.
  • a command pattern in which the acceleration gradually decreases at the start of acceleration and the deceleration gradually increases at the start of deceleration as represented by FIG. 17 shown by equation (8), FIG. 18 shown by equation (11), and the like.
  • the acceleration is kept constant for a predetermined period, that is, the maximum acceleration is maintained, then the acceleration gradually decreases, the deceleration gradually increases after turning to deceleration, and then the deceleration is a predetermined period.
  • the regenerative electric energy predicted value E1 generated during the positioning operation in step S105 in FIG. When it is determined that the energy amount E2 can be stored or less, the power consumption amount during positioning control can be further reduced. The reason will be described below.
  • the power consumption required for positioning operation is composed of the power for the output of the motor 1 and the power for the loss.
  • the output of the motor 1 becomes the kinetic energy of the motor 1 and the mechanical load.
  • the kinetic energy becomes the regenerative electric energy during the deceleration operation.
  • a major factor in the loss is copper loss caused by current flowing through the motor winding resistance.
  • the copper loss that occurs in the motor winding resistance during the positioning operation uses the current I (t) that flows through the motor 1 during the positioning operation. It is represented by Furthermore, when a (t) is a motor acceleration, the equation of motion of the motor 1 and the mechanical load Since (J: inertia of movable part of motor and mechanical load, a (t): motor acceleration, Kt: motor torque constant) is established, current and acceleration are in a proportional relationship.
  • a command pattern for moving the predetermined movement amount D over a predetermined movement time T that minimizes the above expression (14) can be expressed by expression (8). The feature of this command pattern is that the acceleration gradually decreases at the start of acceleration and the deceleration, which is a negative acceleration at the start of deceleration, gradually increases, and this movement can obtain the effect of reducing the copper loss.
  • the amount of movement with this command pattern is equal to the amount of speed pattern surrounded by the movement time 0 to the movement time T, so the movement amount when the positioning operation is performed according to this command pattern is 7/32 ⁇ ⁇ ⁇ T 2 .
  • the average acceleration absolute value during the positioning time T is It becomes.
  • an average acceleration absolute value during the positioning time T is 24/5 ⁇ D / T 2 .
  • FIG. 21 shows command patterns for positioning operation at a constant acceleration ⁇ and deceleration ⁇ during the acceleration operation and the deceleration operation, respectively.
  • the average acceleration absolute value during the positioning time T is also 4 ⁇ D / T 2 .
  • the command patterns shown in FIGS. 19, 20, and 21 are all command patterns for positioning the desired movement amount D in the desired movement time T. According to the command pattern when each positioning operation is performed, the copper loss when the positioning operation is performed is compared.
  • a relatively large speed can be taken until immediately before the deceleration stop at which the speed becomes zero.
  • positioning a certain amount of movement in a certain movement time requires a small speed during the positioning time. Since the acceleration is the rate of change of speed, that is, the derivative of the speed, if the speed is small, even if the absolute value of the acceleration, which is the rate of change, is reduced on average during the travel time, The determined movement amount D can be moved.
  • the average acceleration of the command pattern shown in FIG. 19 is the smallest. Since the motor acceleration and the motor current are in a proportional relationship, taking such a command pattern reduces the current during the positioning time on average, resulting in an effect of reducing the copper loss during the positioning control.
  • the acceleration during the positioning operation exceeds the maximum acceleration A max.
  • the acceleration is maintained at the maximum acceleration for a certain time at the start of acceleration, then gradually decreases, the deceleration is gradually increased at the start of deceleration, and then the maximum acceleration for a certain time is decelerated.
  • the command pattern to be maintained is used.
  • a case where a rotary motor is used as the motor 1 and the rotational load is converted into a translational motion by the ball screw 3 and the mechanical load is positioned and controlled has been described as an example.
  • the present invention can also be applied to the case where the mechanical load positioning control is performed using a motor that generates power in a linear direction such as a motor.
  • the present invention is not limited to the above-described embodiment, and various modifications can be made without departing from the scope of the invention in the implementation stage.
  • the above embodiments include inventions at various stages, and various inventions can be extracted by appropriately combining a plurality of disclosed constituent requirements. For example, even if some constituent requirements are deleted from all the constituent requirements shown in the embodiment, the problem described in the column of the problem to be solved by the invention can be solved, and is described in the column of the effect of the invention. When an effect is obtained, a configuration from which this configuration requirement is deleted can be extracted as an invention.
  • the constituent elements over different embodiments may be appropriately combined.
  • the positioning control device is useful for reducing power consumption when positioning control of a mechanical load using a motor, and in particular, positioning having an amplifier unit equipped with a smoothing capacitor. Suitable for control device.

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Stopping Of Electric Motors (AREA)
  • Control Of Electric Motors In General (AREA)
  • Power Engineering (AREA)
  • Control Of Ac Motors In General (AREA)
  • Manipulator (AREA)

Abstract

　実施の形態の位置決め制御装置は、交流電源を整流して母線間に出力するコンバータと、コンバータの出力を平滑化して母線電圧を生成する平滑コンデンサと、母線間に接続された回生抵抗および回生トランジスタと、モータを駆動する駆動電流を供給するインバータを有するアンプ部と、指令速度および指令加速度のパターン情報である指令パターンに基づいて、モータに接続された機械負荷の位置決め制御用の位置指令値を生成する指令生成部と、を備える位置決め制御装置であって、インバータは、母線間に接続され、位置指令値に基づいて駆動電流を供給し、指令生成部は、位置決め動作の開始前に指令パターンから予測される回生電力量予測値と平滑コンデンサに蓄積可能なエネルギー値とを求めて、両者の比較結果に基づいて、指令パターンに基づいた位置指令値を位置決め動作において使用するか否かを決定する。

Description

位置決め制御装置
　本発明は、位置決め制御装置に関する。
　サーボモータをはじめとするモータは、搬送機械、半導体製造装置、電子部品実装機、ロボットなどさまざまな産業用機械の位置決め制御用の駆動源に使用されている。産業用機械のランニングコストを抑制するためには、モータが位置決め動作を行う際の消費電力量、即ち積算電力を小さくする必要がある。
　消費電力量を削減するために、効率が高いモータや電源回生コンバータなどの機器を使用するという方法も考えられるが、これらの機器は高価であるという問題がある。位置決め制御用の指令値を工夫することで消費電力量を削減できれば、新たな機器導入をせずに、安価に消費電力量の削減を図ることができる。
　位置決め時間が短いが消費電力量が大きい位置決め制御用指令値と、位置決め時間が長いが消費電力が小さい位置決め制御用指令値とを記憶させておき、これらを使用者が選択できるようにしておくという技術が公開されている（例えば、特許文献１参照）。
特開平５－３２５４４６号公報
　位置決め動作は、機械負荷をある位置から別の位置に移動させるために、加速動作と減速動作を伴う。加速動作を行う際は、モータは電力を消費するが、減速動作を行う際は、逆に、モータは発電状態となり回生電力が一般に発生する。例えば、サーボアンプのように、モータを駆動するためのモータ駆動機器には回生抵抗と回生トランジスタが備わることが多い。このような構成の場合、回生電力が発生すると、一部は回生抵抗で消費されるが、発生したすべての回生電力が回生抵抗で消費されるわけではなく、一部はモータ駆動機器内に残留し、次の位置決め動作に使用される。この回生電力は、モータ駆動時の消費電力量を考える上で重要な要素であり、従来技術はこの回生電力を考慮していないため、消費電力量の低減が十分ではないという課題がある。
　本発明は、上記に鑑みてなされたものであって、位置決め動作時の消費電力量を低減する位置決め制御装置を得ることを目的とする。
　上述した課題を解決し、目的を達成するために、本発明は、交流電源を整流して母線間に出力するコンバータと、前記コンバータの出力を平滑化して母線電圧を生成する平滑コンデンサと、前記母線間に接続された回生抵抗および回生トランジスタと、モータを駆動する駆動電流を供給するインバータを有するアンプ部と、指令速度および指令加速度のパターン情報である指令パターンに基づいて、前記モータに接続された機械負荷の位置決め制御用の位置指令値を生成する指令生成部と、を備える位置決め制御装置であって、前記インバータは、前記母線間に接続され、前記位置指令値に基づいて前記駆動電流を供給し、前記指令生成部は、位置決め動作の開始前に前記指令パターンから予測される回生電力量予測値と前記平滑コンデンサに蓄積可能なエネルギー値とを求めて、両者の比較結果に基づいて、前記指令パターンに基づいた前記位置指令値を前記位置決め動作において使用するか否かを決定することを特徴とする。
　本発明にかかる位置決め制御装置によれば、モータを用いて機械負荷を位置決め制御する際の消費電力量を小さくするという効果を奏する。
図１は、本発明の実施の形態１にかかる位置決め制御装置の全体構成を示すブロック図である。 図２は、本発明の実施の形態１にかかる指令生成部の処理手順を表すフローチャートである。 図３は、本発明の実施の形態１にかかる基準指令パターンで規定される指令速度と指令加速度の例を示す図である。 図４は、本発明の実施の形態１にかかる別の基準指令パターンで規定される指令速度と指令加速度の例を示す図である。 図５は、本発明の実施の形態１にかかるさらに別の基準指令パターンで規定される指令速度と指令加速度の例を示す図である。 図６は、本発明の実施の形態１にかかるモータのピーク速度が最小になる指令速度と指令加速度の波形を示す図である。 図７は、本発明の実施の形態１にかかる位置決め動作を行った際のモータ速度とアンプ部の母線電圧の関係の典型的な例を表す図である。 図８は、本発明の実施の形態２にかかる位置決め制御装置の全体構成を示すブロック図である。 図９は、本発明の実施の形態２にかかる指令生成部の処理手順を表すフローチャートである。 図１０は、本発明の実施の形態２において一定速度動作がない位置決め動作を行った際の速度と母線電圧の関係を表す図である。 図１１は、本発明の実施の形態２において機械負荷の摩擦が比較的大きい場合位置決め動作を行った際の速度と母線電圧の関係を表す図である。 図１２は、本発明の実施の形態３にかかる位置決め制御装置の全体構成を示すブロック図である。 図１３は、本発明の実施の形態３にかかる指令生成部の処理手順を表すフローチャートである。 図１４は、本発明の実施の形態３にかかる位置決め動作を複数回間歇的に行った際のモータ速度と母線電圧の関係を表す図である。 図１５は、本発明の実施の形態４にかかる位置決め制御装置の全体構成を示すブロック図である。 図１６は、本発明の実施の形態４にかかる指令生成部の処理手順を表すフローチャートである。 図１７は、本発明の実施の形態４にかかる加速動作時に加速度が漸減し、減速開始時に減速度が漸増する指令パターンの例を示す図である。 図１８は、本発明の実施の形態４にかかる加速開始時に加速度は予め定めた期間一定加速度を維持し、その後加速度は漸減し、減速に転じた後は減速度が漸増していき、その後減速度が予め定めた期間一定減速度を維持する指令パターンの例を示す図である。 図１９は、本発明の実施の形態４にかかる加速度が加速開始時に漸減し、減速開始時に減速度が漸増する指令パターンを示す図である。 図２０は、本発明の実施の形態４にかかる加速度が加速開始時に漸増し、減速開始時に減速度が漸減する指令パターンを示す図である。 図２１は、本発明の実施の形態４にかかる加速度が加速動作中、および減速動作中一定の指令パターンを示す図である。
　以下に、本発明にかかる位置決め制御装置の実施の形態を図面に基づいて詳細に説明する。なお、この実施の形態によりこの発明が限定されるものではない。
実施の形態１．
　図１は、本発明の実施の形態１にかかる位置決め制御装置の全体構成を示すブロック図である。図１には、モータ１、エンコーダ２、ボールネジ３、位置決めヘッド４、カップリング５、アンプ部７、指令生成部１０、および交流電源２１が示されている。例えば、ボールネジ３、位置決めヘッド４、カップリング５などが、モータ１に接続された機械負荷である。
　アンプ部７は、指令生成部１０から指令パターンである位置決め制御指令値１１を受信し、指令値に追従するように、モータ１に電流１４を供給する。アンプ部７は、サーボ制御部１２、コンバータ部２２、平滑コンデンサ２３、回生抵抗２４、回生トランジスタ２５およびインバータ部２６を備える。回生抵抗２４および回生トランジスタ２５は、平滑コンデンサ２３と並列するように母線間に接続されている。回生トランジスタ２５は回生抵抗２４に通電させるために設置されている。
　モータ１は、アンプ部７からの電流１４によって駆動され、位置決め制御の駆動源となる。モータ１に接続されたエンコーダ２は、モータ１の位置および速度を検出し、検出情報１３、即ち、モータ位置および速度情報を出力する。ボールネジ３は、カップリング５によってモータ１に接続されている。モータ１の回転運動はボールネジ３によって並進運動に変換され、ボールネジ３に固定された位置決めヘッド４の運動が制御される。
　図１に示す例では、ボールネジ３、位置決めヘッド４およびカップリング５で機械負荷を構成している。なお、図１には、ボールネジ３を利用して機械負荷を位置決め制御する例を示しているが、本発明はこれに限定されず、タイミングベルトやラックアンドピニオンなどの他の機構を用いてもよいし、これら機構を複数個組み合わせて機械負荷の位置決め制御が実現されていてもよい。
　交流電源２１は、アンプ部７に交流電力を供給する。アンプ部７では、供給された交流電力をもとに、以下のようにモータ１に電流１４を供給する。交流電源２１が接続されたコンバータ部２２は、交流電源２１から供給される交流電力を整流して母線間に出力する。コンバータ部２２は、例えば、ダイオードスタックにより実現される。整流された交流電力は、平滑コンデンサ２３により平滑化された直流電源となり、これにより母線間に母線電圧を生成する。
　回生トランジスタ２５は、モータ１が動作中に母線電圧が過度に上昇するとオン（ＯＮ）し、回生電力を回生抵抗２４に消費させ、母線電圧を低下させる。インバータ部２６は、パルス幅変調（ＰＷＭ：pulse　width　modulation）を行い、後述する電圧指令１５をもとにして、指令値に追従するようにモータ１を駆動するための電流１４をモータ１に供給する。
　サーボ制御部１２は、位置決め制御用の位置決め指令値である位置指令信号１１にモータ１の位置が追従するように、電圧指令１５を算出する。モータ１の位置は、エンコーダ２が出力するモータ検出情報１３としてサーボ制御部１２に与えられる。電圧指令１５を算出する具体例は、位置指令１１とモータ位置１３をもとにフィードバック制御を構成することが挙げられるが、これに限られるものではなく、フィードフォワード制御を併用してもよい。アンプ部７の具体例は、サーボアンプや汎用インバータなどが該当する。
　指令生成部１０は、位置決め制御用の位置指令値１１を生成し、アンプ部７に出力するものであり、本実施の形態の中心的な役割を果たす構成要素である。指令生成部１０は、位置決め制御時の移動量Ｄ、位置決めが開始されてから終了するまでの時間である移動時間Ｔ、位置決め制御時に許容される最大の加速度である最大加速度Ａmaxなどの位置決め動作仕様情報、可動部分イナーシャＪ、平滑コンデンサ２３の容量Ｃ、後述する基準指令パターン情報、および位置決め開始されるタイミングを規定する指令始動信号に基づいて、位置指令値を生成する。
　ここで、可動部分イナーシャＪとは、モータ１の回転に伴い可動する部分のイナーシャの合計値である。図１においては、モータ１のロータ部分イナーシャと位置決めヘッド４、ボールネジ３、およびカップリング５のイナーシャを合計した値となる。また、指令始動信号の具体例は、オンおよびオフ（ＯＦＦ）で構成され、オフからオンに切換った瞬間に位置指令値の生成が開始される例が挙げられ、機械の動作シーケンスを司るプログラマブルロジックコントローラなどが指令始動信号を生成し、これが指令生成部１０に与えられる。
　移動量Ｄ、移動時間Ｔ、最大加速度Ａmaxの情報は、ポイントテーブルとして指令生成部１０内に予め登録されるという形で記憶されていてもよいし、位置決め始動信号と同時にこれらの情報もプログラマブルロジックコントローラから同時に受信する形で与えられてもよい。また、可動部分イナーシャＪおよび平滑コンデンサ２３の容量Ｃの情報は指令生成部１０に予め記憶されているものとする。
　図２は、本発明の実施の形態１で中心的役割を果たす指令生成部１０の処理手順を表すフローチャートである。図２の処理の流れを以下に説明する。
　ステップＳ１０１では、位置決め制御を開始すべきタイミングかどうかを監視する。具体的には、位置決め始動信号が、オフからオンに切換ったタイミングを監視する。もし、位置決め制御を開始すべきタイミングでないと判断された場合（ステップＳ１０１：Ｎｏ）は監視を続行し、位置決めを開始すべきと判断された場合（ステップＳ１０１：Ｙｅｓ）はステップＳ１０２に移行する。
　ステップＳ１０２では、位置決め動作仕様情報および基準指令パターン情報を取得する。ここで、位置決め動作仕様情報とは、位置決め指令値を構成する上で必要な情報であり、具体例は、移動量Ｄ、移動時間Ｔ、最大加速度Ａmaxが該当する。ここで、移動時間とは、機械負荷が停止状態から移動を開始し移動を終了し再び停止状態になるのに要する時間を表し、最大加速度は、機械負荷やモータ１がとれる加速度の絶対値の上限値を表す。
　また、基準指令パターン情報とは、位置決め動作をさせるために必要な情報であり、位置決め指令値の形状を指定する情報である。基準指令パターン情報は、指令速度および指令加速度のパターン情報である指令パターンを含んでいる。図３は、本発明の実施の形態１にかかる基準指令パターンで規定される指令速度と指令加速度の例を示す図である。基準指令パターン情報の具体例は、位置決め制御用に用いる指令パターンが、例えば図３に示されるような指令速度の形状が対称三角になる指令値であれば、指令パターンが対称三角であるという情報である。速度が対称三角であるという情報、並びに移動量Ｄおよび移動時間Ｔから、加速時間と減速時間はＴ1＝Ｔ／２、ピーク速度ｖｐ＝２・Ｄ／Ｔ、加速度ａ＝４・Ｄ／Ｔ2など位置決め制御指令値を一意に規定することができる。
　なお、図３においては、指令速度と指令加速度の波形を図示しているが、速度パターンである指令速度は位置指令値の微分を表し、加速度パターンである指令加速度は指令速度を微分した信号を指すものとする。指令速度を１回積分した信号が、位置決め制御の指令値である。
　また、図４は、本発明の実施の形態１にかかる別の基準指令パターンで規定される指令速度と指令加速度の例を示す図である。別の基準指令パターン情報の例は、位置決め制御用に用いる指令値が、例えば図４に示されるような指令速度の形状が非対称三角になる指令値であれば、指令パターンが非対称三角であるという情報と加速動作時の加速度ａとである。これらの情報から、ピーク速度ｖｐ＝２・Ｄ／Ｔ、加速時間Ｔ1＝ｖｐ／ａ＝２・Ｄ／（ａ・Ｔ）、減速時間Ｔ2＝Ｔ－Ｔ1＝Ｔ－２・Ｄ／（ａ・Ｄ）、減速時の減速度はａｄ＝ｖｐ／Ｔと指令値を一意に規定することができる。ここで、減速度とは、減速動作時における加速度の絶対値を表すものである。
　また、図５は、本発明の実施の形態１にかかるさらに別の基準指令パターンで規定される指令速度と指令加速度の例を示す図である。さらに別の基準指令パターン情報の例は、図５に示すようなＳ字加減速を伴う指令パターン情報を含んでいてもよい。基準指令パターン情報は、上述した例に限られるものではなく、停止状態から加速動作を行い、減速動作を行うことで再度停止状態に至る位置決め制御を実現する指令値を規定する情報であれば、どのようなものであってもかまわない。
　ステップＳ１０３では、位置決め動作仕様情報で指定され、予め定めた移動量を予め定めた移動時間で、基準指令パターン情報に従った位置指令値のパターンに従って位置決め動作した場合に発生すると予測される回生電力量予測値Ｅ１を算出する。具体的な算出方法の１つは、ステップＳ１０２で取得した、位置決め仕様情報および基準指令パターンの情報から算出した速度指令のピーク速度ｖｐと、機械負荷およびモータ１の可動部分イナーシャＪとに基づいて、
Figure JPOXMLDOC01-appb-M000006
 と計算する。
　ステップＳ１０４では、平滑コンデンサ２３に蓄積可能なエネルギーＥ２を算出する。具体的な算出法の１つは、平滑コンデンサ２３の容量Ｃ、回生トランジスタ２５がオンになる母線電圧値Ｖｏｎと、基準母線電圧値Ｖ０を用いて、
Figure JPOXMLDOC01-appb-M000007
 と計算することが挙げられる。
　ここで、基準母線電圧値Ｖ０はコンバータが出力する定常的な電圧値、すなわち、交流電源をアンプ部７に接続し、インバータに電圧指令を与えず、かつ、モータを動作させていないときの母線電圧値を指すものとする。整流部がダイオードスタックである場合は、交流電源の実効電圧の√２倍である交流電源電圧の波高値が、基準母線電圧値に相当する。
　例えば、交流電源のＡＣ２００ボルトで、交流電源の波高値である２００×√２＝２８３ボルトがおおよその基準母線電圧Ｖ０となる。この基準母線電圧Ｖ０、平滑コンデンサ２３の容量Ｃ、回生トランジスタ２５がオンとなる母線電圧値Ｖｏｎも指令生成部１０に予め記憶させておくことでステップＳ１０４の計算を行うことができる。
　ステップＳ１０５では、ステップＳ１０３で計算した回生電力量予測値Ｅ１とステップＳ１０４で計算した平滑コンデンサ２３に蓄積可能なエネルギーＥ２を比較する。もし、回生電力量予測値Ｅ１が平滑コンデンサ２３に蓄積可能なエネルギーＥ２以下であれば（ステップＳ１０５：Ｙｅｓ）、ステップＳ１０６に移行し、そうでなければ（ステップＳ１０５：Ｎｏ）、ステップＳ１０７に移行する。
　ステップＳ１０６では、位置決め制御用の指令値として基準指令パターンを位置決め制御の指令パターンとして選択する。
　ステップＳ１０７では、与えられた位置決め動作仕様の情報をもとにモータ１のピーク速度が最小になる指令パターンを選択する。図６は、本発明の実施の形態１にかかるモータ１のピーク速度が最小になる指令速度と指令加速度の波形を示す図である。例えば、位置決め動作仕様が、移動量Ｄ、移動時間Ｔ、さらに加速度の絶対値の上限値が最大加速度Ａmaxであれば、図６に示されるように、加速動作および減速動作を常に絶対値が最大加速度Ａmaxの加速度で行う速度パターンおよび加速度パターンを選択する。図６の中の速度パターンＶ（ｔ）は、時間ｔ＝０で位置決めを開始したときの以下のように表せる。
Figure JPOXMLDOC01-appb-M000008
 　ここで、加速時間と減速時間はＴ1、一定速度時間はＴ2、一定速度はｖｐであり、それぞれ、移動量Ｄ、移動時間Ｔ、最大加速度Ａmaxを用いて、以下のように表される。
Figure JPOXMLDOC01-appb-M000009
　ステップＳ１０６もしくはＳ１０７の処理が終了したら、ステップＳ１０８に移行する。ステップＳ１０８では、ステップＳ１０６もしくはＳ１０７で選択された位置決め制御用指令値を時間ごとに生成し、モータを動作させ位置決め動作を実際に開始する。なお、ステップＳ１０８に入る前はモータの動作は行われず、ステップＳ１０６もしくはＳ１０７で位置決め制御用の指令値が選択されてから、ステップＳ１０８で位置決め制御が実際に開始される。
　このように、図２のフローチャートで示した処理に従って、位置決め制御を行うと、位置決め動作時の消費電力量を小さくすることができる。なお、図２のフローチャートは１回の位置決め動作に係る処理を説明したフローチャートである。なお、間歇的に複数回位置決め動作する場合であれば、今回の位置決め動作が完了したならば、再度、ステップＳ１０１に戻り、次の位置決め動作についても同様の処理を繰り返していく。
　次に本実施の形態の効果を説明する。図７は、本発明の実施の形態１にかかる位置決め動作を行った際のモータ速度とアンプ部の母線電圧の関係の典型的な例を表す図である。なお以下の議論は、図７に示すように、加速動作において速度が直線的に増加し、減速動作において速度が直線的に減少する場合を例にしてなされているが、加速動作、減速動作がＳ字指令など直線加減速以外のパターンをとっても同様に成立する。また、モータ速度はアンプ部７により指令速度、即ち速度パターンに追従するように制御されるため、モータ速度は指令速度、即ち速度パターンとほぼ同じと見なせる。
　位置決め動作を行う直前の母線電圧は、アンプ部７に交流電源２３から交流電圧が供給されてからはじめて位置決め動作をする前、又は、前回の位置決め動作との間の時間が充分大きければ、基準母線電圧をとる。位置決め動作を行うと、モータ１は停止状態、すなわち速度０の状態から加速動作を行い、その後、一定速度を維持し、モータ１の位置が目標距離に近づくと、減速動作を行い停止するという挙動をとる。
　このとき母線電圧は、モータ１が仕事を行っている状態である力行か、モータ１に仕事がされている状態である回生かに応じて、変動する。モータ１が加速動作を行うと、電力を消費してモータ１および機械負荷に運動エネルギーを与える。アンプ部７はモータ１にエネルギーを供給するため電力を消費するので、母線電圧は基準母線電圧値より低下する挙動をとる。母線電圧が基準母線電圧以下になると、コンバータ部２２は母線電圧を基準母線電圧値になるように電力を供給する。機械負荷の摩擦が小さいような場合、モータ１が一定速度をとる時間において、モータ１は大きなトルクを発生する必要がないので、モータ１が行う仕事はほとんど０とみなせる。このため電力をほとんど消費しない。従って、モータ１が一定速度である間に、コンバータ部２２から電力が供給されて、母線電圧は基準母線電圧付近の値に戻る。モータが減速動作を行うと、モータ１および機械負荷の運動エネルギーは減少していき回生電力が発生する。減少した運動エネルギーが回生電力となり、母線電圧が基準母線電圧値より上昇する。
　前述のとおり、母線電圧が上昇し、予め定めた電圧値である回生トランジスタＯＮ電圧に到達すると、回生トランジスタ２５がオンし、回生電力は回生抵抗２４で消費され、母線電圧が回生トランジスタＯＮ電圧未満に低下する。しかし、図７に示すように、減速動作をして回生状態になっても母線電圧が回生トランジスタＯＮ電圧に到達しない場合には、回生電力は回生抵抗２４で消費されない。減速動作をしても母線電圧が回生トランジスタＯＮ電圧に到達しない場合、回生電力は母線間の平滑コンデンサ２３に蓄えられ、平滑コンデンサ２３に回生電力が蓄えられるにつれて、母線電圧が上昇する。位置決め動作時に発生する回生電力量は機械負荷の運動エネルギーとみなせる。減速動作時にはピーク速度から速度０の状態である停止に至るので、ピーク速度から計算される運動エネルギーを示す（１）式が、位置決め動作時に発生する回生電力量予測値Ｅ１となる。
　この回生電力量予測値Ｅ１がすべて平滑コンデンサ２３に蓄積されるならば、回生電力は回生抵抗２４で消費されることはない。平滑コンデンサ２３にエネルギーをどの程度蓄積できるかは、（２）式で見積もることができる。これは、母線電圧値が回生トランジスタＯＮ電圧値をとるときに平滑コンデンサ２３に蓄えられているエネルギー（＝１／２・Ｃ・Ｖｏｎ2）と、母線電圧値が基準母線電圧値をとるときに平滑コンデンサ２３に蓄えられているエネルギー（＝１／２・Ｃ・Ｖ０2）との差に相当する。すなわち、母線電圧が基準母線電圧から回生トランジスタＯＮ電圧まで上昇した場合に、蓄えることができるエネルギーの量を表す。
　（１）式で計算される今回の位置決め動作時に発生する回生電力量予測値Ｅ１と（２）式で計算される平滑コンデンサ２３に蓄積可能なエネルギー値Ｅ２を比較し、Ｅ２よりＥ１が小さい場合は、位置決め動作時に発生する回生電力量は、今回の位置決め動作中に回生抵抗２４で消費されず、すべて平滑コンデンサ２３に蓄えられる。平滑コンデンサ２３に蓄えられた回生電力量は、次回の位置決め動作時に再利用することが可能である。位置決め動作に必要になる電力量は、モータ出力分の電力量と損失分の電力量から構成される。サーボモータのような高効率なモータ１を使用した場合、この２つのうち、モータ出力分の電力が支配的である。モータ出力分の電力は、主に加速動作中にモータ１および機械負荷の運動エネルギーとなる。
　図２のステップＳ１０５で、ステップＳ１０６に移行すると判断される場合（ステップＳ１０５：Ｙｅｓ）は、基準指令パターンを用いて位置決め動作をしても、加速動作中にモータ１が機械負荷に与えた運動エネルギーは無駄にならないため、位置決め動作時の消費電力量は小さい。基準指令パターンにショックや振動を低減する効果のあるＳ字指令などを選択することにより、消費電力量の削減と振動ショック低減がある程度両立しながら、位置決め制御を行うことができるという効果もある。
　他方、図２のステップＳ１０５で、今回の位置決め動作時に発生する回生電力量予測値Ｅ１が平滑コンデンサ２３に蓄積可能なエネルギー値Ｅ２より大きいと判定される場合（ステップＳ１０５：Ｎｏ）は、位置決め動作を行ったときに、回生電力は平滑コンデンサ２３に蓄えきれず、その一部が回生抵抗２４で消費されることになる。回生抵抗２４で消費されてしまう回生電力は熱になってしまうので、次回の位置決め動作時に再利用することはできない。回生抵抗２４で消費されてしまい再利用することができない電力量をなるべく小さくすることが、位置決め動作時の消費電力量を削減することになる。回生電力量はモータ１および機械負荷の運動エネルギーであるので、運動エネルギーがなるべく小さい、すなわち、加速度の上限値である最大加速度Ａmaxが与えられている条件下でピーク速度がなるべく小さくなる指令パターン、すなわち、（３）式で表せる指令パターンが、回生抵抗２４で消費させてしまう回生電力量をなるべく小さくすることができ、位置決め動作時の消費電力量を小さくする。
　（３）式で表される指令パターンは、予め定めた移動量Ｄを予め定めた移動時間Ｔで移動するのに、加速動作をつねに最大加速度Ａmaxで行い、予め定めた一定速度時間を維持した後、減速動作をつねに最大加速度－Ａmaxで行う。仮に加速度の上限値がなければ、移動量Ｄを移動時間Ｔで移動する指令パターンのうちで速度が最も小さくなる指令パターンは、時間０、即ち始動時から時間Ｔまで速度Ｄ／Ｔで移動する指令パターンである。この指令パターンは加速時間および減速時間がともに０である。しかし、このような指令パターンは加速度が無限大となってしまうため、加速度に上限値がある場合は、このような指令パターンを実現することが不可能である。
　従って、加速度の絶対値Ａmax以下にしながら、予め定めた移動量Ｄを予め定めた移動時間Ｔでピーク速度が最小になるように位置決めするためには、なるべく短い時間で加速動作を行い、なるべく短い時間で減速動作を行う、すなわち、最大加速度Ａmaxで加速動作と減速動作を行う必要がある。この指令パターンが（３）式で表せる指令パターンであり、加速度に上限値がある場合、ピーク速度が最小になる指令パターンとなる。
　なお、本実施の形態では、平滑コンデンサ２３に蓄積可能なエネルギー量Ｅ２を算出する場合において、平滑コンデンサ２３の容量Ｃ、回生トランジスタ２５がオンになる母線電圧値Ｖｏｎ、基準母線電圧Ｖ０の情報から（２）式の計算式を用いて算出した例を説明した。従って、アンプ部７に変更がなければ（２）式による計算値は変わらないので、アンプ部７に対応した、平滑コンデンサ２３に蓄積可能なエネルギー量を（２）式により予め計算しておき、この値を指令生成部１０に記憶させて、この値を取得して処理を行ってもよい。
実施の形態２．
　実施の形態１では、平滑コンデンサ２３に蓄積可能な回生電力量を算出するのに、（２）式により計算を行う例を説明したが、これに限られるものではない。本実施の形態では、（２）式以外で計算する例について説明を行う。
　図８は、本発明の実施の形態２にかかる位置決め制御装置の全体構成を示すブロック図である。図８のブロック図は図１のブロック図と類似しており、同じ番号を付している箇所に関しては、基本的に同じ働きをするものとして説明を省略する。図１と異なる部分は指令生成部１０である。図１の指令生成部１０は、可動部分イナーシャＪ、平滑コンデンサ２３の容量Ｃの情報を入力、又は予め記憶していたのに対し、図８の指令生成部１０は可動部分イナーシャＪ、平滑コンデンサ２３の容量Ｃに加えて、１より大きい補正係数Ｇの情報が入力される、又は、予め指令生成部１０に記憶されているものとする。この補正係数Ｇがどのようなものかは後述する。
　図９は、本発明の実施の形態２にかかる指令生成部１０の処理手順を表すフローチャートである。図９のフローチャートは、図２のフローチャートと類似している。同じ番号を付している箇所については、基本的に同じ処理を行うものとして説明を省略する。
　図９のフローチャートが図２のフローチャートと異なる部分は、図２のステップＳ１０４が、図９ではステップＳ１０４ｂに置き換わる点である。ステップＳ１０４ｂでは、平滑コンデンサ２３に蓄えられるエネルギー量Ｅ２を、平滑コンデンサ２３の容量Ｃ、回生トランジスタＯＮ電圧Ｖｏｎ、基準母線電圧Ｖ０、および補正係数Ｇ(＞１)を用いて算出する。これらの情報を用いて以下の（５）式のように平滑コンデンサ２３に蓄積可能なエネルギー量Ｅ２を算出する。
Figure JPOXMLDOC01-appb-M000010
　ステップＳ１０４ｂの処理が終了したら、ステップＳ１０５以降の処理に移行する。ステップＳ１０５以降の処理は実施の形態１の図２と同様なので説明を省略する。図９の処理に従って、位置決め制御を行うと、位置決め動作時の消費電力量を小さくすることができる。
　本実施の形態においても、位置決め動作を実際に行う前に、基準指令パターンで動作した場合の回生電力量予測値Ｅ１を算出し、これと平滑コンデンサ２３に蓄えられるエネルギー値Ｅ２との比較結果によって、位置決め制御用の指令値を選択する。この点は実施の形態１と同様なので、位置決め動作時の消費電力量を小さくするという効果が得られる。
　実施の形態１では得られず、本実施の形態で得られる効果について説明を行う。実施の形態２と実施の形態１との違いは、平滑コンデンサ２３に蓄積可能なエネルギー量の算出を（２）式の代わりに（５）式で行うことである。ここで、（５）式と（２）式とは、補正係数Ｇ倍だけ異なり、Ｇ＞１なので、（２）式で算出する値よりも、本実施の形態においては平滑コンデンサ２３に蓄えられるエネルギーを大きく算出することになる。この物理的な意味を図１０および図１１を用いて説明する。
　図１０は、一定速度時間がない、すなわち、加速動作が終了した直後に減速動作を行う指令パターンに従って位置決め動作を行ったときのモータ１の速度と母線電圧の関係を表す図である。実施の形態１で述べたように、モータ１が加速動作をするとモータ１が電力を消費するため母線電圧は低下し、逆に減速動作を行うとモータ１が回生状態となるため母線電圧が上昇する。
　図１０に示すように加速動作終了直後に減速動作を開始すると、加速動作中に母線電圧が低下するため、減速動作開始時の母線電圧は基準母線電圧Ｖ０よりも小さい値をとる。減速動作を開始した時点から回生電力が発生し、母線電圧が上昇し始める。平滑コンデンサ２３に蓄積できるエネルギー量は母線電圧がとる電圧の二乗差に依存する。（２）式では、回生トランジスタＯＮ電圧Ｖｏｎと基準母線電圧Ｖ０の二乗差として示されている。この差が大きければより大きなエネルギーを蓄えることが可能で、逆に小さければそれだけしかエネルギーを蓄えることができない。しかし、図１０の場合は減速動作開始時の母線電圧は基準母線電圧Ｖ０よりも小さい値をとるので、（２）式で示される値より大きいエネルギーを平滑コンデンサ２３に蓄積することができる。
　また、図１１は機械負荷の摩擦が比較的大きい場合に、一定速度時間がある指令パターンで位置決め動作をしたときの、モータ速度と母線電圧の関係を表す図である。前述のように加速動作を行うときには母線電圧が小さくなり、減速動作を行うときには母線電圧が大きくなる点は同じである。モータ１が消費する電力の一部には、モータ出力分の消費電力が含まれる。モータ出力はモータトルクとモータ速度の積により表される。機械負荷の摩擦が小さければ、速度が一定であるときにモータトルクがほぼ０となり、モータ１の出力もほぼ０となる。これにより、モータ１はほとんど電力を消費しない。しかし、機械負荷の摩擦が比較的大きいと、速度が一定である場合に機械負荷の摩擦が要因となりモータトルクも大きくなり、モータ出力は０でなくなる。このためモータ駆動装置は電力を消費し、モータ１が一定速度をとっている場合、および減速動作を開始する直前において、母線電圧が基準母線電圧Ｖ０よりも小さくなるという挙動を示す。
　図１０および図１１で示されるように減速動作を行う直前の母線電圧は基準母線電圧Ｖ０よりも小さくなる場合には、減速動作時に（２）式で計算される平滑コンデンサ２３に貯められるエネルギー値よりも大きな回生電力量を貯めることができる。そこで、（２）式で計算される平滑コンデンサ２３に蓄えることができるエネルギー値に対し、（５）式に示すように補正係数Ｇ(＞１)を乗じることで、この状況での平滑コンデンサ２３に蓄えることができるエネルギー値をより正確に見積もることができる。
　ここで、補正係数Ｇは、例えば、予め位置決め動作を行わせたときの減速動作を開始直前の母線電圧値を測定し、その母線電圧値から計算される平滑コンデンサ２３に蓄積可能なエネルギー値と、（２）式で計算される平滑コンデンサ２３に蓄積可能なエネルギー値との比として決定することが考えられる。母線電圧値から計算される平滑コンデンサ２３に蓄積可能なエネルギー値とは、基準母線電圧の代わりに減速動作開始直前の母線電圧値を代入し計算した値である。
　本実施の形態は、位置決め始動前に、今回の位置決め動作時に発生する回生電力量と、平滑コンデンサ２３に蓄積可能なエネルギーを算出し、これらの比較結果に応じて、位置決め指令パターンを使い分けるという点は同じなので、実施の形態１と同様の効果がある。さらに、本実施の形態によれば、実施の形態１に比べて、平滑コンデンサ２３に蓄えられるエネルギーをより正確に見積もるので、位置決め動作時の消費電力量を削減するのに有利な指令値の選択が可能になるという効果がある。
実施の形態３．
　実施の形態１および２においては、基準母線電圧Ｖ０をもとに平滑コンデンサ２３に蓄積可能な回生電力量を算出する例を説明したが、基準母線電圧Ｖ０を用いずに平滑コンデンサ２３に蓄積可能なエネルギーＥ２を算出することが可能であり、本実施の形態では、そのような場合についての説明を行う。
　図１２は、本発明の実施の形態３にかかる位置決め制御装置の全体構成を示すブロック図である。図１２のブロック図は、実施の形態１で説明した図１のブロック図および実施の形態２で説明した図８のブロック図と類似しており、同じ番号を付している箇所に関しては、基本的に同様な動作をするものとして説明を省略する。図１２が、図１および図８と異なる点は、図１２には母線電圧検出回路２７が備わり、検出された母線電圧値２８（Ｖｄｃ）が指令生成部に入力される点である。
　図１３は、本発明の実施の形態３にかかる指令生成部１０の処理手順を表すフローチャートである。図１３のフローチャートは、実施の形態１で説明した図２のフローチャートおよび実施の形態２で説明した図９のフローチャートと類似している。同じ番号を付している箇所については、基本的に同様な処理を行うものとして説明を省略する。
　図１３のフローチャートが図２のフローチャートと異なる部分は、ステップＳ１０３の処理を行った後、ステップＳ１１０で、母線電圧検出回路２７で母線電圧値Ｖｄｃを検出する処理を行う点である。その後、ステップＳ１０４ｃで、検出された母線電圧値２８（Ｖｄｃ）を用いて、平滑コンデンサ２３に蓄積可能なエネルギー量Ｅ２を計算する。具体的な計算は以下の（６）式である。
Figure JPOXMLDOC01-appb-M000011
　（６）式と（２）式との違いは、基準母線電圧Ｖ０が母線電圧Ｖｄｃに置き換わった点である。また、実施の形態２で説明したように、（６）式にさらに補正係数Ｇ（＞１）を乗じて、平滑コンデンサ２３に蓄積可能なエネルギー量Ｅ２を算出してもよい。すなわち、Ｅ２を以下の（７）式として計算してもよい。
Figure JPOXMLDOC01-appb-M000012
　ステップＳ１０４ｃの処理が終了したら、ステップＳ１０５以降の処理を実行する。ステップＳ１０５以降の処理については実施の形態１で説明を行ったステップＳ１０５以降の処理を行う。図１３の処理に従って、位置決め制御を行うと、位置決め動作時の消費電力量を小さくすることができる。
　本実施の形態においても、位置決め動作を実際に行う前に、基準指令パターンで動作した場合の回生電力量予測値Ｅ１を算出し、これと平滑コンデンサ２３に蓄えられるエネルギー値Ｅ２との比較結果によって、位置決め制御用の指令値を選択する。この点は実施の形態１と同様なので、位置決め動作時の消費電力量を小さくするという効果が得られる。　　　
　実施の形態１および２では得られず、本実施の形態で得られる効果について説明を行う。図１４は、本発明の実施の形態３にかかる位置決め動作を複数回、間歇的に行った際のモータ速度と母線電圧の関係を表す図である。具体的には、図１４の例では位置決め動作を２回、間歇的に行った際のモータ速度と母線電圧の関係を表している。図１４を用いて本実施の形態の効果を説明する。
　実施の形態１および２で述べたように、位置決め動作を行うと、加速動作時、一定速動作時にはモータ１は電力を消費するため、母線電圧は基準母線電圧Ｖ０よりも小さい母線電圧をとり、この間、アンプ部７のコンバータ部２２がインバータ部２６に電力を供給する。一方、減速動作時は回生状態となり、減速動作開始時から機械負荷、モータ１の運動エネルギーが平滑コンデンサ２３に蓄えられ、その結果、母線電圧が上昇する。位置決め制御は停止状態からある速度に到達し、その後再度停止状態になるので、運動エネルギーは、加速動作開始時である位置決め開始時および減速動作終了時である位置決め終了時は０である。しかし、加速動作中に母線電圧が基準母線電圧Ｖ０よりも小さい状態の時に、コンバータ部２２から電力の供給を受けるため、位置決め動作終了時の母線電圧は、一般に、位置決め動作開始時の母線電圧よりも大きくなる。間歇的に位置決め動作をする場合、ある位置決め動作、即ち図１４の位置決め動作Ｘを行って、しばらく停止状態を維持した後、別の位置決め動作、即ち図１４の位置決め動作Ｙを開始することになる。この停止状態中、停止状態を維持するためにモータ１には小さいながらも電流を流す必要がある。モータ１に電流を流すとモータ１の巻線抵抗で損失が発生し電力を消費するので、母線電圧が徐々に下がっていく。停止状態が長ければ、母線電圧は基準母線電圧Ｖ０まで下がることになるが、図１４に示されるように、停止状態の期間が短ければ、基準母線電圧Ｖ０まで下がる前に、次の位置決め動作が開始されることになる。すると、位置決め動作Ｙが開始されるときの母線電圧は基準母線電圧Ｖ０より大きくなるが、この分だけ、回生トランジスタＯＮ電圧Ｖｏｎと位置決め動作開始時の母線電圧との差が小さくなる。よって、位置決め動作Ｙを行う際には、母線電圧が基準母線電圧Ｖ０から位置決め動作を開始するときに比べて、平滑コンデンサ２３に蓄えられるエネルギーが小さくなる。
　図１３のフローチャートにおいて、ステップＳ１１０で位置決め動作始動直前又は位置決め動作始動時の母線電圧Ｖｄｃを取得し、ステップＳ１０４ｃで平滑コンデンサ２３に蓄積可能なエネルギー量を、（６）式や（７）式により算出することにより、図１４で示したような場合において平滑コンデンサ２３に蓄えられるエネルギー値Ｅ２を正確に算出することができる。
　（７）式のように補正係数Ｇを乗ずるのは、例えば、以下のようなことを考慮に入れた場合である。即ち、位置決め動作始動時以前には基準指令パターンで位置決め動作を行うかを決定する必要があるので母線電圧の実測データとしては位置決め動作始動時の母線電圧Ｖｄｃしか得られないのであるが、実際に平滑コンデンサ２３に蓄えられるエネルギーは、減速動作開始時の母線電圧に依存する。従って、位置決め動作始動時から減速動作開始時までの加速動作による母線電圧の低下により、平滑コンデンサ２３に蓄えられるエネルギーが増大するので、それを考慮する場合などである。
　これにより、位置決め動作時に発生する回生電力量が回生抵抗２４で消費されるかどうかをより正確に判定することが可能になる。従って、与えられた位置決め動作仕様で、消費電力量を削減するのに有利になるように、基準指令パターンで位置決め動作を行うか、又は、ピーク速度が最小になる指令パターンで位置決め動作を行うかを適切に選択することが可能になり、位置決め動作時の消費電力量を削減するのに有利な指令値の選択が可能になるという効果が得られる。
実施の形態４．
　実施の形態１、２、および３では、基準指令パターン情報を入力し、基準指令パターンに従って今回位置決め動作の指令値を生成した場合に予測される回生電力量予測値Ｅ１を求め、これと平滑コンデンサ２３に蓄積可能なエネルギー量Ｅ２との比較結果に基づいて指令値を選択しながら位置決め制御を実行した。本実施の形態においては、基準指令パターンとして、ある指令値を用いることで、さらに、位置決め制御時の消費電力量を削減することができる構成について説明する。
　図１５は、本発明の実施の形態４にかかる位置決め制御装置の全体構成を示すブロック図である。図１５は図１のブロック図と共通している部分があり、図１と同様な部分については説明を省略する。図１５と図１のブロック図とで異なるのは、指令生成部１０に対して外部からの基準指令パターン情報の入力がなく指令生成部１０が以下で説明する予め定めた基準指令パターンを保持している点である。
　図１６は、本発明の実施の形態４にかかる指令生成部１０の処理手順を表すフローチャートである。図１６のフローチャートは図２のフローチャートと共通している部分があり、図２と同じ部分については説明を省略する。図１６のフローチャートが図２のフローチャートと異なる処理は、図２のステップＳ１０２が、ステップＳ１０２ｂおよびステップＳ１０２ｃに置き換わる点である。
　ステップＳ１０２ｂでは位置決め動作仕様情報として、移動量Ｄ、移動時間Ｔ、最大加速度Ａmaxを入力する。
　その後、ステップＳ１０２ｃで、基準指令パターンを、加速開始時に加速度が漸減し、減速開始時に減速度が漸増する指令パターン、又は、加速開始時に加速度は予め定めた期間一定加速度、即ち最大加速度を維持し、その後加速度は漸減し、減速に転じた後は減速度が漸増していき、その後減速度が予め定めた期間一定減速度、即ち最大減速度を維持する指令パターンとする。ここで、最大減速度は負の最大加速度である。
　加速開始時に加速度が漸減し、減速開始時に減速度が漸増する指令パターンの具体例は、図１７に示される指令パターンがあり、その加速度の数式表現は以下の（８）式となる。
Figure JPOXMLDOC01-appb-M000013
　ここで、Ａpは加速動作開始時の加速度、減速動作時の終了後の減速度であり、移動量Ｄと移動時間Ｔを用いて、
Figure JPOXMLDOC01-appb-M000014
 と表される。
　また、指令パターンが（８）式で表すことができる加速度に従って、位置決めした際のピーク速度ｖｐは、（８）式を時間０から時間Ｔ/２まで積分した値として計算できるので、
Figure JPOXMLDOC01-appb-M000015
 である。
　ここで、加速動作開始とともに加速度が漸減し、減速開始時とともに減速度が増加する指令パターンは（８）式に限られるものではない。（８）式は、加速動作開始とともに加速度が直線的に漸減し、減速開始時とともに減速度が直線的に増加しているが、直線に限られる必要はなく、コサイン（ｃｏｓ）カーブなどの時間ｔに関する三角関数や、時間ｔに関する高次多項式で表される曲線などであってもよい。
　加速開始時に加速度は予め定めた期間一定加速度、即ち最大加速度を維持し、その後加速度は漸減し、減速に転じた後は減速度が漸増していき、その後減速度が予め定めた期間一定減速度、即ち最大減速度を維持する指令パターンの具体例は、図１８に示される指令パターンがあり、その加速度は以下の（１１）式で表される。
Figure JPOXMLDOC01-appb-M000016
 ここで、
Figure JPOXMLDOC01-appb-M000017
 である。
　また、指令パターンが（１１）式で表すことができる加速度に従って、位置決めした際のピーク速度ｖｐは、（１１）式を時間０から時間Ｔ/２まで積分した値で計算できるので、
Figure JPOXMLDOC01-appb-M000018
 である。
　また、加速開始時に加速度は予め定めた期間一定加速度、即ち最大加速度を維持し、その後加速度は漸減し、減速に転じた後は減速度が漸増していき、その後減速度が予め定めた期間一定減速度、即ち最大減速度を維持する指令パターンは、（１１）式に限られるものではない。（１１）式は、加速度が直線的に漸減、又は、減速動作開始とともに加速度が直線的に漸減し、減速開始時とともに減速度が直線的に増加しているが、直線に限られる必要はなく、コサインカーブなどの時間ｔに関する三角関数や、時間ｔに関する高次の多項式で表される曲線などであってもよい。
　ステップＳ１０３以降は、実施の形態１と同様の処理を行う。また、実施の形態２、３と同様に、ステップＳ１０４の代わりにステップＳ１０４ｂ又はステップＳ１０４ｃの処理を実行してもよい。
　次に、本実施の形態の効果を説明する。本実施の形態も、実施の形態１、２、３と同様、今回位置決め動作時に発生する回生電力量を位置決め始動前に予測し、この予測値Ｅ１と平滑コンデンサ２３に蓄積可能なエネルギー値Ｅ２とを比較し、回生電力量予測値Ｅ１のほうが大きい場合は、与えられた位置決め条件でピーク速度が最小になる指令パターンを選択する点は同じである。これにより、再利用できない回生抵抗２４で消費されてしまう回生電力量を最小化し、位置決め動作時の消費電力量を減少させるという効果が得られる。
　基準指令パターンとして、（８）式で示される図１７や（１１）式で示される図１８などで代表されるように、加速開始時に加速度が漸減し、減速開始時に減速度が漸増する指令パターン、又は、加速開始時に加速度は予め定めた期間一定加速度、即ち最大加速度を維持し、その後加速度は漸減し、減速に転じた後は減速度が漸増していき、その後減速度が予め定めた期間一定減速度、即ち最大減速度を維持する指令パターンを用いることで、さらに位置決め制御時の消費電力量を減少させることができる。
　即ち、本実施の形態によれば、実施の形態１、２、および３で説明した場合よりも、図１６のステップＳ１０５で、位置決め動作時に発生する回生電力量予測値Ｅ１が、平滑コンデンサ２３に蓄積可能なエネルギー量Ｅ２以下と判断されるときに、さらに位置決め制御時の消費電力量を減少させることができる。以下にその理由を説明する。
　位置決め動作時に必要な消費電力量は、モータ１の出力分の電力量と損失分の電力量から構成される。加速動作中、モータ１の出力はモータ１および機械負荷の運動エネルギーとなる。さらに、減速動作中、この運動エネルギーが回生電力量となるのは実施の形態１、２、および３で述べた通りである。位置決め動作時に発生する回生電力量がすべて平滑コンデンサ２３に蓄積される場合（ステップＳ１０５：Ｙｅｓ）には、図１６のステップＳ１０５からステップＳ１０６に移行する。位置決め動作時に発生する回生電力量がすべて平滑コンデンサ２３に蓄積されれば、次回の位置決め動作時に、その回生電力量を再利用することができるのでステップＳ１０６に移行する場合は、モータ１の出力分の電力量は位置決め動作時にトータルで０と考えることができる。
　一方、位置決め動作を行うときには加速動作及び減速動作が伴う。加速動作及び減速動作を行わせるためには、モータ１にトルクを発生させる必要があり、トルクを発生させるためにはモータ１に電流を流す必要がある。モータ１に電流が流れると、損失が発生するので、ステップＳ１０６に移行する場合は損失がなるべく小さくなるように指令パターンを構成することで位置決め動作時の消費電力量を更に減少させることが可能となる。
　損失の中で大きな要因となるのは、モータ巻線抵抗に電流が流れることにより発生する銅損である。位置決め動作中にモータ巻線抵抗で発生する銅損は、位置決め動作中にモータ１に流れる電流Ｉ（ｔ）を用いて、
Figure JPOXMLDOC01-appb-M000019
 で表される。さらに、ａ（ｔ）をモータ加速度とした場合、モータ１および機械負荷の運動方程式
Figure JPOXMLDOC01-appb-M000020
 (Ｊ：モータおよび機械負荷の可動部分のイナーシャ、ａ（ｔ）：モータ加速度、Ｋｔ：モータトルク定数)が成立することから、電流と加速度とは比例関係がある。予め定めた移動量Ｄを予め定めた移動時間Ｔだけかけて移動する指令パターンで上記の（１４）式を最小化するものは（８）式で表わせる。この指令パターンの特徴は、加速開始時に加速度が漸減し、減速開始時の負の加速度である減速度が漸増していくことであり、この動きにより銅損を減少させる効果を得ることができる。
　図１９、図２０、および図２１に示す３つの指令パターンを用いて、この効果について説明する。図１９は、加速動作初期（０≦ｔ≦Ｔ／４）の加速度はαであり、加速動作終盤（Ｔ／４＜ｔ≦Ｔ／２）に加速度が小さくなってα／２になり、減速動作初期（Ｔ／２＜ｔ≦３／４・Ｔ）の減速度はα／２であり、減速動作終盤（３／４・Ｔ＜ｔ≦Ｔ）に減速度は大きくなって減速度がαとなる指令パターンである。また、ここで、ｔは時間を表すパラメータである。この指令パターンで移動する量は、速度パターンが移動時間０から移動時間Ｔ囲まれる量に等しいため、この指令パターンにしたがって位置決め動作したときの移動量は７／３２・α・Ｔ2となる。所望の移動量Ｄに移動させるためには、加速度αはα＝３２／７・Ｄ／Ｔ2である。また、このとき、位置決め時間Ｔ中の平均的な加速度絶対値は、
Figure JPOXMLDOC01-appb-M000021
 となる。
　一方、図２０は、図１９の指令パターンとは逆に、加速動作初期（０≦ｔ≦Ｔ／４）の加速度はβ／２で、加速動作終盤（Ｔ／４＜ｔ≦Ｔ／２）に加速度が大きくなってβになり、減速動作初期（Ｔ／２＜ｔ≦３／４・Ｔ）の減速度はβであり、減速動作終盤（３／４・Ｔ＜ｔ≦Ｔ）に減速度は小さくなって減速度がβ／２となる指令パターンである。この指令パターンに従って、位置決め動作した時に移動量を所望の移動量Ｄにするためには、加速度βはβ＝３２／５・Ｄ／Ｔ2である。また、このとき位置決め時間Ｔ中の平均的な加速度絶対値は、２４／５・Ｄ／Ｔ2となる。
　また、図２１は、加速動作中および減速動作中に、それぞれ一定の加速度γおよび減速度γで位置決め動作する指令パターンである。この指令パターンに従って、位置決め動作したときに移動量を所望の移動量Ｄにするためには、加速度γは、γ＝４・Ｄ／Ｔ2である。位置決め時間Ｔ中の平均的な加速度絶対値も４・Ｄ／Ｔ2である。
　図１９、２０、および２１に示す指令パターンは、いずれも所望の移動量Ｄを所望の移動時間Ｔで位置決め動作するための指令パターンである。それぞれの位置決め動作をしたときの指令パターンに従って、位置決め動作したときの銅損を比較する。図１９、２０、および２１に示す指令パターンのそれぞれに従って位置決め動作したときの銅損をそれぞれＬ１、Ｌ２、およびＬ３で表す。運動方程式から、位置決め動作をしたときの電流Ｉ（ｔ）は、Ｉ（ｔ）＝Ｊ／Ｋt・Ａ（ｔ）と表すことができる。ただし、Ｊ：機械負荷およびモータのイナーシャ、Ｋt：モータのトルク定数、即ち単位電流がモータに流れた際に発生するトルク、Ａ（ｔ）：指令パターンの加速度である。
　このとき、モータ１の巻線抵抗Ｒを用いて、Ｌ１、Ｌ２、およびＬ３は以下のように計算される。
Figure JPOXMLDOC01-appb-M000022
Figure JPOXMLDOC01-appb-M000023
Figure JPOXMLDOC01-appb-M000024
　すなわち、同じ移動量Ｄ、同じ移動時間Ｔで位置決めしたときに、銅損を減少させる効果が大きいのは、図１９のように、加速動作中は加速度が時間経過につれて減少し、減速動作中は減速度が時間経過につれて増加していく指令パターンである。これは、図１９の指令パターンにだけ見られる性質ではなく、加速動作時に加速度が漸減して、減速動作時に減速度が漸増していくパターンに共通してみられる性質である。同一の移動量Ｄを、同一の移動時間Ｔで移動する際に、加速動作初期に大きな加速度をとることにより、位置決め開始直後から大きな速度をとることができ、減速動作終盤に大きな減速動作をとることにより、速度が０になる減速停止の直前まで比較的大きな速度をとることができる。これにより、ある移動量をある移動時間で位置決めするのに、位置決め時間中小さな速度で済む。加速度は速度の変化率、即ち速度の微分であるため、速度が小さければその変化率である加速度の絶対値を移動時間中に平均的に小さくしても、予め定めた移動時間Ｔで、予め定めた移動量Ｄを移動できる。実際、図１９、図２０、図２１に示される指令パターンの例においても、図１９に示される指令パターンの平均的な加速度が一番小さくなっている。モータ加速度とモータ電流は比例関係にあるので、このような指令パターンをとることで位置決め時間中の電流も平均して小さくなり、その結果、位置決め制御中の銅損を小さくするという効果がある。
　ここで、（８）式に代表されるように、加速開始時に加速度が漸減し、減速開始時に減速度が漸増する指令パターンを用いると、位置決め動作中の加速度が最大加速度Ａmaxを超えてしまう場合は、（１１）式のように、加速開始時に加速度が最大加速度をある時間維持し、その後漸減し、減速開始時に、減速度が漸増していき、その後、減速度がある時間最大加速度を維持する指令パターンとする。このような指令パターンは同一の移動時間Ｔで移動する際に、加速動作初期に大きな加速度をとることにより、位置決め開始直後から大きな速度をとることができ、減速動作終盤に大きな減速動作をとることにより、速度が０になる減速停止の直前まで比較的大きな速度をとることが、加速度の最大値を最大加速度Ａmax以下にしながら実現することができる。
　以上に説明した実施の形態１～４においては、モータ１として回転型モータを用いて、ボールネジ３により回転運動を並進運動に変換して機械負荷を位置決め制御する場合を例として説明したが、リニアモータのように直線方向に動力を発生するモータを用いて機械負荷を位置決め制御を行う場合でも同様に適用することができる。
　また、図１、図８、図１２、および図１５においては位置決め制御装置に平滑コンデンサ２３が１つだけ設けられている例を説明したが、母線間に並列に平滑コンデンサを複数個設ける構成であってもよい。この場合、複数の平滑コンデンサの容量の合成値を、平滑コンデンサ２３の容量として計算すればよい。例えば、容量がＣ１とＣ２の２つの平滑コンデンサを母線間に並列に接続した場合は、Ｃ＝Ｃ１・Ｃ２／（Ｃ１＋Ｃ２）として平滑コンデンサ２３の容量を計算すれば、上記実施の形態１～４を同様に実施することができる。
　さらに、本願発明は上記実施の形態に限定されるものではなく、実施段階ではその要旨を逸脱しない範囲で種々に変形することが可能である。また、上記実施の形態には種々の段階の発明が含まれており、開示される複数の構成要件における適宜な組み合わせにより種々の発明が抽出されうる。例えば、実施の形態に示される全構成要件からいくつかの構成要件が削除されても、発明が解決しようとする課題の欄で述べた課題が解決でき、発明の効果の欄で述べられている効果が得られる場合には、この構成要件が削除された構成が発明として抽出されうる。更に、異なる実施の形態にわたる構成要素を適宜組み合わせてもよい。
　以上のように、本発明にかかる位置決め制御装置は、モータを用いて機械負荷を位置決め制御する際の消費電力量を小さくすることに有用であり、特に、平滑コンデンサを備えたアンプ部を有する位置決め制御装置に適している。
　１　モータ、２　エンコーダ、３　ボールネジ、４　位置決めヘッド、５　カップリング、６　モータ制御装置、７　アンプ部、１０　指令生成部、１３　検出情報、１４　電流、１５　電圧指令、２１　交流電源、２２　コンバータ部、２３　平滑コンデンサ、２４　回生抵抗、２５　回生トランジスタ、２６　インバータ部、２７　母線電圧検出回路、２８　検出された母線電圧値（Ｖｄｃ）。

Claims (12)

  1. 　交流電源を整流して母線間に出力するコンバータと、前記コンバータの出力を平滑化して母線電圧を生成する平滑コンデンサと、前記母線間に接続された回生抵抗および回生トランジスタと、モータを駆動する駆動電流を供給するインバータを有するアンプ部と、
    　指令速度および指令加速度のパターン情報である指令パターンに基づいて、前記モータに接続された機械負荷の位置決め制御用の位置指令値を生成する指令生成部と、
    　を備える位置決め制御装置であって、
    　前記インバータは、前記母線間に接続され、前記位置指令値に基づいて前記駆動電流を供給し、
    　前記指令生成部は、位置決め動作の開始前に前記指令パターンから予測される回生電力量予測値と前記平滑コンデンサに蓄積可能なエネルギー値とを求めて、両者の比較結果に基づいて、前記指令パターンに基づいた前記位置指令値を前記位置決め動作において使用するか否かを決定する
    　ことを特徴とする位置決め制御装置。
  2. 　前記指令生成部は、前記回生電力量予測値が前記エネルギー値より大きい場合は、加速度の絶対値に上限値が与えられている条件下で前記モータのピーク速度が最小になるような前記位置指令値を前記位置決め動作において使用する
    　ことを特徴とする請求項１に記載の位置決め制御装置。
  3. 　前記指令生成部は、前記回生電力量予測値が前記エネルギー値以下である場合は、前記指令パターンに基づいた前記位置指令値を前記位置決め動作において使用する
    　ことを特徴とする請求項１または２に記載の位置決め制御装置。
  4. 　前記アンプ部は、前記位置指令値と前記モータの位置に基づいて指令信号を出力するサーボ制御部を有し、
    　前記インバータは、前記指令信号に基づいて前記駆動電流を供給する
    　ことを特徴とする請求項１から３のいずれか１項に記載の位置決め制御装置。
  5. 　前記指令生成部は、前記機械負荷および前記モータの可動部分のイナーシャＪと、
    前記指令パターンに基づいたピーク速度ｖｐを用いて、前記回生電力量予測値を
    Figure JPOXMLDOC01-appb-M000001
     と求める
    　ことを特徴とする請求項１から４のいずれか１項に記載の位置決め制御装置。
  6. 　前記指令生成部は、前記平滑コンデンサの容量Ｃと、前記回生トランジスタがオンとなる電圧値Ｖｏｎと、前記コンバータが出力する定常的な前記母線電圧の値を表す基準母線電圧Ｖ０を用いて、前記エネルギー値を
    Figure JPOXMLDOC01-appb-M000002
     と求める
    　ことを特徴とする請求項１から５のいずれか１項に記載の位置決め制御装置。
  7. 　前記指令生成部は、前記平滑コンデンサの容量Ｃと、前記回生トランジスタがオンとなる電圧値Ｖｏｎと、前記コンバータが出力する定常的な前記母線電圧の値を表す基準母線電圧Ｖ０と、１より大きい定数Ｇを用いて、前記エネルギー値を
    Figure JPOXMLDOC01-appb-M000003
     と求める
    　ことを特徴とする請求項１から５のいずれか１項に記載の位置決め制御装置。
  8. 　前記指令生成部は、前記平滑コンデンサの容量Ｃと、前記回生トランジスタがオンとなる電圧値Ｖｏｎと、前記位置決め動作の開始時の母線電圧Ｖｄｃを用いて、前記エネルギー値を
    Figure JPOXMLDOC01-appb-M000004
     と求める
    　ことを特徴とする請求項１から５のいずれか１項に記載の位置決め制御装置。
  9. 　前記指令生成部は、前記平滑コンデンサの容量Ｃと、前記回生トランジスタがオンとなる電圧値Ｖｏｎと、前記位置決め動作の開始時の母線電圧Ｖｄｃと、１より大きい定数Ｇを用いて、前記エネルギー値を
    Figure JPOXMLDOC01-appb-M000005
     と求める
    　ことを特徴とする請求項１から５のいずれか１項に記載の位置決め制御装置。
  10. 　前記指令加速度のパターンが、加速開始時に加速度が漸減し、減速開始時に減速度が漸増するパターンである
    　ことを特徴とする請求項１から９のいずれか１項に記載の位置決め制御装置。
  11. 　前記指令加速度のパターンが、加速開始時に加速度は予め定めた期間一定加速度を維持し、その後加速度は漸減し、減速に転じた後は減速度が漸増していき、その後減速度が予め定めた期間一定減速度を維持するパターンである
    　ことを特徴とする請求項１から９のいずれか１項に記載の位置決め制御装置。
  12. 　前記平滑コンデンサは、前記母線間に並列に接続された複数のコンデンサから構成される
    　ことを特徴とする請求項１から１１のいずれか１項に記載の位置決め制御装置。
     
PCT/JP2014/067021 2014-06-26 2014-06-26 位置決め制御装置 WO2015198455A1 (ja)

Priority Applications (7)

Application Number Priority Date Filing Date Title
DE112014001613.6T DE112014001613B4 (de) 2014-06-26 2014-06-26 Positionierungssteuerungsvorrichtung
US14/781,348 US9535426B2 (en) 2014-06-26 2014-06-26 Positioning control device
KR1020157029765A KR101611148B1 (ko) 2014-06-26 2014-06-26 위치 결정 제어 장치
CN201480021861.6A CN105393450B (zh) 2014-06-26 2014-06-26 定位控制装置
PCT/JP2014/067021 WO2015198455A1 (ja) 2014-06-26 2014-06-26 位置決め制御装置
JP2015524521A JP5805353B1 (ja) 2014-06-26 2014-06-26 位置決め制御装置
TW104111203A TWI559670B (zh) 2014-06-26 2015-04-08 定位控制裝置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2014/067021 WO2015198455A1 (ja) 2014-06-26 2014-06-26 位置決め制御装置

Publications (1)

Publication Number Publication Date
WO2015198455A1 true WO2015198455A1 (ja) 2015-12-30

Family

ID=54544795

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2014/067021 WO2015198455A1 (ja) 2014-06-26 2014-06-26 位置決め制御装置

Country Status (7)

Country Link
US (1) US9535426B2 (ja)
JP (1) JP5805353B1 (ja)
KR (1) KR101611148B1 (ja)
CN (1) CN105393450B (ja)
DE (1) DE112014001613B4 (ja)
TW (1) TWI559670B (ja)
WO (1) WO2015198455A1 (ja)

Families Citing this family (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6157772B1 (ja) * 2016-06-16 2017-07-05 三菱電機株式会社 サーボ制御診断システム
JP7225560B2 (ja) * 2018-04-26 2023-02-21 セイコーエプソン株式会社 制御装置、ロボットシステム、及び表示制御方法
CN109546922B (zh) * 2018-12-05 2022-07-26 北京爱其科技有限公司 伺服电机控制方法和***
CN110504885B (zh) * 2019-09-18 2020-11-13 哈尔滨工业大学 一种适用于pmsm伺服***的快速响应高精度位置控制方法
WO2021124603A1 (ja) * 2019-12-16 2021-06-24 株式会社日立産機システム モータ制御装置、モータ制御方法
CN115136095B (zh) * 2020-03-04 2023-04-04 三菱电机株式会社 定位控制装置及定位方法

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05325446A (ja) * 1992-05-22 1993-12-10 Ricoh Co Ltd ヘッド位置決め装置
JP2000236679A (ja) * 1999-02-16 2000-08-29 Fuji Electric Co Ltd 電動機制御用電力変換装置の制御方法
JP2006054947A (ja) * 2004-08-10 2006-02-23 Fanuc Ltd コンバータ装置、インバータ装置及びｄｃリンク電圧の制御方法
JP2006238520A (ja) * 2005-02-22 2006-09-07 Ishikawajima Harima Heavy Ind Co Ltd 負荷駆動装置
JP2006321640A (ja) * 2005-05-20 2006-11-30 Ishikawajima Harima Heavy Ind Co Ltd 負荷駆動装置
WO2012093545A1 (ja) * 2011-01-05 2012-07-12 三菱電機株式会社 モータ制御装置
JP2013017305A (ja) * 2011-07-04 2013-01-24 Fanuc Ltd エネルギー蓄積部を有するモータ制御装置

Family Cites Families (22)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3089958B2 (ja) * 1994-12-06 2000-09-18 三菱自動車工業株式会社 電気自動車の制動制御装置
JP3708728B2 (ja) * 1998-11-05 2005-10-19 日創電機株式会社 射出成形機のモータ駆動装置
JP3042686B1 (ja) * 1999-02-15 2000-05-15 株式会社ケーヒン 携帯用発電機
JP3863092B2 (ja) * 2002-11-20 2006-12-27 本田技研工業株式会社 車載モータの回生制御装置
JP3722810B2 (ja) * 2003-06-06 2005-11-30 ファナック株式会社 モータ駆動装置
JP3722811B2 (ja) * 2003-06-06 2005-11-30 ファナック株式会社 モータ駆動装置
KR100527184B1 (ko) * 2003-07-07 2005-11-08 현대자동차주식회사 전기자동차의 공조 시스템을 이용한 회생 제동 방법
JP4541218B2 (ja) * 2005-04-08 2010-09-08 三菱電機株式会社 指令生成装置
JP5194788B2 (ja) * 2005-04-11 2013-05-08 フジテック株式会社 昇降機の制御装置
DE102007020184B4 (de) 2006-09-01 2020-02-06 Sew-Eurodrive Gmbh & Co Kg Verfahren und Vorrichtung zur Bewegungssteuerung von Achsen
US8080953B2 (en) * 2007-08-06 2011-12-20 Seiko Epson Corporation Motor control method and device
JP4339916B2 (ja) * 2008-02-28 2009-10-07 ファナック株式会社 モータ駆動装置
BRPI0823121B1 (pt) 2008-10-08 2018-11-27 Mitsubishi Electric Corp controlador de motor
CN101722636A (zh) * 2008-10-23 2010-06-09 鸿富锦精密工业（深圳）有限公司 射出成型机
WO2010059141A1 (en) * 2008-11-21 2010-05-27 Otis Elevator Company Operation of a three-phase regenerative drive from mixed dc and single phase ac power sources
KR101662863B1 (ko) * 2009-03-31 2016-10-07 히다찌 겐끼 가부시키가이샤 전원 시스템을 구비한 건설 기계 및 산업 차량
GB0905560D0 (en) * 2009-04-01 2009-05-13 Rolls Royce Plc An electrical actuator arrangement
TWI404322B (zh) * 2009-04-14 2013-08-01 Mitsubishi Electric Corp 馬達控制裝置
JP5463179B2 (ja) 2010-03-23 2014-04-09 株式会社日立産機システム 電源装置及び電源システム
JP4917680B1 (ja) * 2010-09-16 2012-04-18 ファナック株式会社 蓄電器を用いたモータ駆動装置
JP5068877B2 (ja) * 2010-09-16 2012-11-07 ファナック株式会社 蓄電器を用いたモータ駆動装置
JP5642276B2 (ja) * 2011-06-09 2014-12-17 三菱電機株式会社 モータ制御装置

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05325446A (ja) * 1992-05-22 1993-12-10 Ricoh Co Ltd ヘッド位置決め装置
JP2000236679A (ja) * 1999-02-16 2000-08-29 Fuji Electric Co Ltd 電動機制御用電力変換装置の制御方法
JP2006054947A (ja) * 2004-08-10 2006-02-23 Fanuc Ltd コンバータ装置、インバータ装置及びｄｃリンク電圧の制御方法
JP2006238520A (ja) * 2005-02-22 2006-09-07 Ishikawajima Harima Heavy Ind Co Ltd 負荷駆動装置
JP2006321640A (ja) * 2005-05-20 2006-11-30 Ishikawajima Harima Heavy Ind Co Ltd 負荷駆動装置
WO2012093545A1 (ja) * 2011-01-05 2012-07-12 三菱電機株式会社 モータ制御装置
JP2013017305A (ja) * 2011-07-04 2013-01-24 Fanuc Ltd エネルギー蓄積部を有するモータ制御装置

Also Published As

Publication number Publication date
CN105393450A (zh) 2016-03-09
DE112014001613T5 (de) 2016-03-17
US20160306369A1 (en) 2016-10-20
DE112014001613B4 (de) 2019-09-05
US9535426B2 (en) 2017-01-03
TWI559670B (zh) 2016-11-21
JP5805353B1 (ja) 2015-11-04
KR20160016762A (ko) 2016-02-15
KR101611148B1 (ko) 2016-04-08
CN105393450B (zh) 2017-12-19
JPWO2015198455A1 (ja) 2017-04-20
TW201614949A (en) 2016-04-16

Similar Documents

Publication Publication Date Title
JP5805353B1 (ja) 位置決め制御装置
JP5931148B2 (ja) 静電容量計算部を有するｐｗｍ整流器
CN105531922B (zh) 用于在可调速驱动中控制再生能量的***以及方法
JP5164540B2 (ja) モータ駆動装置の制御方法および装置
JP5665882B2 (ja) モータ制御装置
WO2007013141A1 (ja) エレベーターの制御装置
JP2009232537A (ja) モータ制御装置
US8410744B2 (en) Motor driving apparatus
US7504796B2 (en) Inverter device
JP2012191675A (ja) モータ制御装置及びモータ制御方法
JP2011176907A5 (ja)
JP6649418B2 (ja) 蓄電装置を有するモータ駆動システム
US8400098B2 (en) Device and method of determining and defining a travel profile of a time-critical axle
US10564620B2 (en) Servo motor control apparatus for controlling servo motor and servo motor control system including the same
JP7092620B2 (ja) 電力変換システムおよびモータ制御方法
CN110086379B (zh) 具有蓄电装置的电动机驱动***
JP2014082866A (ja) 一つの被駆動体を駆動する複数のモータを制御するモータ制御装置
EP1936796A1 (en) Inverter device
JP6769246B2 (ja) 電動機制御装置
JP7111557B2 (ja) 蓄電装置を有するモータ駆動システム
JP2003230998A (ja) プレス機械のエネルギー蓄積装置及びプレス機械
JP2020182373A (ja) 蓄電装置を有するモータ駆動装置
Abrishamifar et al. Fixed frequency sliding mode controller for the buck converter
JP2012143850A (ja) ロボット及びロボット駆動方法
JP7060644B2 (ja) 射出成形機の電気回路

Legal Events

Date Code Title Description
WWE Wipo information: entry into national phase

Ref document number: 201480021861.6

Country of ref document: CN

ENP Entry into the national phase

Ref document number: 2015524521

Country of ref document: JP

Kind code of ref document: A

WWE Wipo information: entry into national phase

Ref document number: 14781348

Country of ref document: US

ENP Entry into the national phase

Ref document number: 20157029765

Country of ref document: KR

Kind code of ref document: A

WWE Wipo information: entry into national phase

Ref document number: 1120140016136

Country of ref document: DE

Ref document number: 112014001613

Country of ref document: DE

121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 14895869

Country of ref document: EP

Kind code of ref document: A1

122 Ep: pct application non-entry in european phase

Ref document number: 14895869

Country of ref document: EP

Kind code of ref document: A1