WO2013008602A1 - アクチュエータの制御方法及びアクチュエータの制御装置 - Google Patents

アクチュエータの制御方法及びアクチュエータの制御装置 Download PDF

Info

Publication number
WO2013008602A1
WO2013008602A1 PCT/JP2012/065886 JP2012065886W WO2013008602A1 WO 2013008602 A1 WO2013008602 A1 WO 2013008602A1 JP 2012065886 W JP2012065886 W JP 2012065886W WO 2013008602 A1 WO2013008602 A1 WO 2013008602A1
Authority
WO
WIPO (PCT)
Prior art keywords
time
control
output
actuator
calculation
Prior art date
Application number
PCT/JP2012/065886
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 US14/232,167 priority Critical patent/US9558897B2/en
Priority to EP12811162.2A priority patent/EP2733554B1/en
Priority to CN201280034323.1A priority patent/CN103649851B/zh
Publication of WO2013008602A1 publication Critical patent/WO2013008602A1/ja

Links

Images

Classifications

    • H—ELECTRICITY
    • H01—ELECTRIC ELEMENTS
    • H01H—ELECTRIC SWITCHES; RELAYS; SELECTORS; EMERGENCY PROTECTIVE DEVICES
    • H01H9/00—Details of switching devices, not covered by groups H01H1/00 - H01H7/00
    • 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/416—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 control of velocity, acceleration or deceleration
    • 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/39—Robotics, robotics to robotics hand
    • G05B2219/39357—Execute motion of path in minimum of time
    • 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/41—Servomotor, servo controller till figures
    • G05B2219/41086—Bang bang control
    • 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/41—Servomotor, servo controller till figures
    • G05B2219/41087—Determine switch point
    • 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/43—Speed, acceleration, deceleration control ADC
    • G05B2219/43041—Prediction, look ahead deceleration control, calculate start deceleration
    • 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/43—Speed, acceleration, deceleration control ADC
    • G05B2219/43045—Max torque, acceleration, then variable, then reverse, variable then max deceleration
    • 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/43—Speed, acceleration, deceleration control ADC
    • G05B2219/43099—Select acceleration deceleration time constants as function of weight, load, position
    • 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/43—Speed, acceleration, deceleration control ADC
    • G05B2219/43112—Using feedforward prediction of position
    • 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/43—Speed, acceleration, deceleration control ADC
    • G05B2219/43114—Detect position, speed or time of object between begin and end, adapt motion

Definitions

  • the present invention relates to an actuator control method and an actuator control device, and more particularly, in a shortest time control, a feedback element can be incorporated by using a control law that corrects an output pattern at every preset time.
  • the present invention relates to an actuator control method and an actuator control apparatus.
  • the simplest shortest time control is a control in which the control target is accelerated with the maximum thrust in half of the stroke to the target position, and the remaining half of the stroke is decelerated with the maximum deceleration, and the control target is stopped at the target position. Since this output pattern is determined before the start of control, this shortest time control can be said to be feedforward control.
  • the shortest time control is a control method in which the actuator is moved with the maximum driving force of the actuator and stopped with the maximum braking force. Theoretically, the control target can be stopped at the target in the shortest time. In other words, the shortest time control is a control method that completely meets the purpose of the control of “stopping the controlled object at the target position in the shortest time”.
  • a control device using this shortest time control a control means for controlling a servo motor and a value at no load are used as a reference.
  • Correspondence storage means for storing the relation between the controlled variable and the load weight, load estimation calculation means, and acceleration / deceleration constant determination means for determining the acceleration / deceleration constant based on the work information calculated by the load estimation calculation means If the workpiece is gripped, the acceleration time becomes longer, and the workpiece is not gripped.
  • a shortest time control device for a robot that shortens the acceleration time has been proposed.
  • the output pattern is an open control in which the initial speed, maximum acceleration, and maximum deceleration are determined in consideration of the feedback element. Therefore, when the target and the control amount do not match, there is no correction method and it is difficult to accurately match the target and the control amount. Therefore, it is rarely used for actual control. Met.
  • the present invention has been made in view of the above situation, and an object of the present invention is to provide an actuator control method and an actuator control apparatus in which an element of feedback control is incorporated in the shortest time control.
  • the actuator control method of the present invention for achieving the above object uses the shortest time control and uses the maximum acceleration ⁇ p and the maximum deceleration ⁇ m at the maximum output of the measured control force of the actuator in advance.
  • the control force of the actuator is set to the maximum acceleration output until the switching time t1, the control force of the actuator is set to the maximum deceleration output from the switching time t1 to the end time t2, and the output of the control force is ended at the end time t2.
  • a control output step, and the calculation step is repeated at predetermined time intervals to change the switching time t1 and the end time. It is a method characterized in that t2 is calculated and updated.
  • the target trajectory of control from the position of the control target object to the target position at the calculation time t0 is recalculated in consideration of the deviation and speed every predetermined period or every irregular time, and the switching time Update t1 and end time t2.
  • the switching time t1 and the end time t2 are elapsed times from the recalculated calculation time t0.
  • the maximum acceleration ⁇ p or the maximum deceleration ⁇ m is the second-order differential value of the control value or the second-order difference value of the control value, and the control value can be applied to a temperature that does not involve movement. it can.
  • the control since the control is the shortest time control, the control speed becomes high, the maximum acceleration ⁇ p and the maximum deceleration ⁇ m can be set by measurement, and there is no adjustment term other than this, so it is necessary to adjust the control gain. No. In addition, since it is ON / OFF control, there is no need to output an intermediate output, and the controller and driver can be simplified.
  • the target amount at each control time and the deviation X between the control amounts are recalculated, and the switching time t1 and the end time t2 are elapsed time display from the recalculation calculation time t0. Therefore, even if the external force changes and the control time interval is not increased, a stable control result can always be obtained. As a result, it is possible to achieve both “control speed” and “stability”, both of which are contradictory issues in the conventional control law.
  • the initial speed is represented by a combination of two quadratic curves that contact each other from the position at the calculation time t0 to the target position at the end time t2.
  • V0 and the deviation between the target position and the control amount are X
  • the switching time t1 and the end time t2 are When calculating with the formulas (1) and (2), the switching time t1 and the end time t2 can be easily calculated.
  • ⁇ 1 is the maximum acceleration ⁇ p or maximum deceleration ⁇ m from calculation time t0 to switching time t1
  • ⁇ 2 is the maximum deceleration ⁇ m or maximum acceleration ⁇ p from switching time t1 to end time t2.
  • the actuator control apparatus of the present invention for achieving the above object uses the shortest time control, and the maximum acceleration ⁇ p and the maximum deceleration ⁇ m at the maximum output of the control force of the actuator measured in advance.
  • a calculation means for calculating a switching time t1 for switching from the acceleration output to the deceleration output, an end time t2 of the deceleration output, with the elapsed time display from the calculation time t0 when the calculation for the control is performed, and the calculation time t0 From the switching time t1 to the end time t1, the control force of the actuator is set to the maximum acceleration output, from the switching time t1 to the end time t2, the control force of the actuator is set to the maximum deceleration output, and the control force is output at the end time t2.
  • a control output means for ending is provided, and the switching time t1 and the end time t2 are repeated by the calculating means at every preset time.
  • An update means for calculating, updating, and returning is configured.
  • the calculation means may represent the initial speed by expressing the trajectory from the position at the calculation time t0 to the target position at the end time t2 as a combination of two quadratic curves.
  • V0 and the deviation between the target position and the control amount are X
  • the switching time t1 and the end time t2 are (1) and (2).
  • ⁇ 1 is the maximum acceleration ⁇ p or maximum deceleration ⁇ m from calculation time t0 to switching time t1
  • ⁇ 2 is the maximum deceleration ⁇ m or maximum acceleration ⁇ p from switching time t1 to end time t2.
  • the acceleration ⁇ p between the calculation time t0 and the switching time t1 and the acceleration ⁇ m between the switching time t1 and the end time t2 are determined according to Table 1.
  • the above-described actuator control method can be implemented, and the same effects can be achieved.
  • the actuator control method and the actuator control apparatus of the present invention since the control is the shortest time control, the control speed is high, the maximum acceleration and the maximum deceleration can be set by measurement, and there is no adjustment term other than this. Therefore, there is no need to adjust the control gain. In addition, since it is ON / OFF control, there is no need to output an intermediate output, and the controller and driver can be simplified.
  • FIG. 1 is a diagram showing a shortest time control model for explaining the shortest time control used in the actuator control method according to the embodiment of the present invention.
  • FIG. 2 is a diagram for explaining the calculation conditions of the control trajectory.
  • FIG. 3 is a diagram for explaining a change in the control trajectory in the recalculation.
  • FIG. 4 is a diagram showing target trajectories that f (t) and g (t) can take.
  • FIG. 5 is a diagram illustrating an example of a control flow of the actuator control method according to the embodiment of the present invention.
  • FIG. 6 is a diagram showing a control result when there is no damping force of the mechanical system in the feedback shortest time control of the actuator control method according to the embodiment of the present invention.
  • FIG. 1 is a diagram showing a shortest time control model for explaining the shortest time control used in the actuator control method according to the embodiment of the present invention.
  • FIG. 2 is a diagram for explaining the calculation conditions of the control trajectory.
  • FIG. 3 is
  • FIG. 7 is a diagram illustrating a control result in the case where there is a damping force of the mechanical system of the feedback shortest time control of the actuator control method according to the embodiment of the present invention.
  • FIG. 8 is a diagram illustrating a simulation result of the example.
  • FIG. 9 is a diagram illustrating a simulation result of the comparative example.
  • FIG. 10 is a diagram showing a control result when there is no damping force of the mechanical system of the shortest time control according to the conventional technique.
  • FIG. 11 is a diagram showing a control result when there is a damping force of the mechanical system of the shortest time control of the prior art.
  • FIG. 12 is a diagram illustrating a PID control model for explaining PID control.
  • the actuator control apparatus uses the shortest time control and includes a calculation means, a control force output means, and an update means.
  • This calculation means displays the elapsed time from the calculation time t0 when calculation for control is performed using the maximum acceleration ⁇ p and the maximum deceleration rate ⁇ m at the maximum output of the control force of the actuator measured in advance.
  • the switching time t1 for switching to the deceleration output and the deceleration output end time t2 are calculated.
  • the control output means sets the control force of the actuator to the maximum acceleration output from the calculation time t0 to the switching time t1, sets the control force of the actuator to the maximum deceleration output from the switching time t1 to the end time t2, and at the end time t2. Ends output of control force.
  • the updating means is configured to repeatedly calculate and update the switching time t1 and the end time t2 by the calculating means at regular intervals or at predetermined time intervals that are irregular.
  • This calculation means represents the trajectory from the recalculated position at the calculation time t0 to the target position by a combination of two quadratic curves that are adjacent to each other, so that the initial speed is V0, and the deviation between the target amount and the control amount is X ,
  • the switching time t1 and the end time t2 are (1) and (2).
  • ⁇ 1 is the maximum acceleration ⁇ p or maximum deceleration ⁇ m from the calculation time t0 to the switching time t1
  • ⁇ 2 is the maximum deceleration ⁇ m or maximum acceleration ⁇ p from the switching time t1 to the end time t2.
  • the shortest time control used in the actuator control method according to the embodiment of the present invention is equivalent to a machine model in which the weight m shown in FIG.
  • the weight when the weight is lifted and released from the slope, the weight descends the slope with a constant acceleration due to gravity, and then rises on the opposite slope with a constant deceleration. If there is no energy loss such as friction, the weight m reaches zero at the same height as the beginning and stops for a moment. If gravity disappears at this time, the weight m will remain stationary at that position.
  • control object is stationary when In this way, if the position where the control object is stationary is the target position, the control ends.
  • the object to be controlled is accelerated / decelerated with the maximum thrust of the actuator and controlled to the target position, so that it can theoretically be controlled in the shortest time. Further, since the control output pattern at this time is determined before the start of control, the shortest time control is feedforward control.
  • the conventional PID control is based on the basic mass m, spring, and damper damping vibration model as shown in FIG. 12, and the role of the spring is the P term and the dash pod is the D term. Fulfill.
  • the zero point correction term is the I term, but here the I term has little physical meaning.
  • the shortest time control and the PID control are fundamentally different controls, but on the other hand, if the P gain and D gain of the PID control are greatly increased and the upper limit of the output is cut by the maximum output of the actuator, Since the control output waveform of the PID control approaches the control output waveform of the shortest time control, the shortest time control can be regarded as a control in which the PD gain of the PID control is increased to the limit.
  • the control is diverged if the PD gain is increased too much due to delays in calculation and control. This is because the PID control is feedback control, and the control output is always determined after the phenomenon. Therefore, if this delay becomes too large, the control diverges.
  • the shortest time control is feedforward control, and the control output is always determined prior to the phenomenon from the start of movement until it stops. Therefore, the control is stable, and the PD gain is increased by the shortest time control. Even if a control output equivalent to the PID control increased to the limit is output, the control does not diverge.
  • FIGS. FIG. 10 shows a case where there is no mechanical damping force
  • FIG. 11 shows a case where there is a mechanical damping force.
  • the actuator is operated toward the target with the maximum thrust from the calculation time t0, the actuator is operated with the maximum deceleration this time at the switching time t1, and then the actuator thrust is set to zero at the end time t2. Yes.
  • the switching time t1 and the end time t2 are determined.
  • the switching time t1 and the end time t2 can be determined based on the following calculation conditions.
  • the target reaches the target through two quadratic curves that are in contact with each other.
  • control trajectory is composed of two quadratic curves f (t) and g (t), and the control time t1 for switching the control output and the control based on the following conditions: An end time t2 at which output ends is obtained. Further, accelerations ⁇ 1 and ⁇ 2 are determined from Table 1. V0 is a first-order differential value (or difference value) of the controlled variable obtained during the control.
  • the calculation conditions are the following (1) to (7).
  • the maximum acceleration ⁇ p and the maximum deceleration ⁇ m that can be generated at the maximum output of the actuator are known, that is, obtained from acceleration measured in advance.
  • the velocity V0 at the calculation time t0 is known, that is, obtained by first-order differentiation (or difference) of the measured value.
  • the value of the first quadratic curve f (t0) is zero at the calculation time t0.
  • the first-order differential value of the first quadratic curve f (t0) at the calculation time t0 is the speed (initial speed) at the time t0.
  • the second quadratic curve g (t) is in contact with the first quadratic curve f (t).
  • the value of the second quadratic curve g (t2) is the target value at the end time t2.
  • the first-order differential value of the second quadratic curve g (t) is zero at the end time t2.
  • Equation (3) and Equation (5) From the equations (3), (6) and (13a), From Equations (3) and (7) From equations (4) and (12), From equations (4), (11) and (16), From equations (4), (10), (16) and (17), (18) From the expressions (3), (5), (9), (15), (16), (17) and (19), From the formulas (3), (5), (8), (15), (16), (17), (19) and (20), (21) Apply the formula of the solution of the quadratic equation to (22), Substituting equation (23) into equation (20), t2 is obtained.
  • A2 is a state in which when X> 0 and V0> 0, the target is not exceeded if the actuator is decelerated at the maximum deceleration ⁇ m generated.
  • the condition for not overshooting at time t3 is V0 2 / 2 ⁇ m ⁇ X.
  • A3 is a condition of X> 0, V0 ⁇ 0, and A4 is a condition of X ⁇ 0, V0> 0.
  • A5 is a state in which when X ⁇ 0, V0 ⁇ 0, the target will not be exceeded if the actuator is decelerated at the maximum deceleration ⁇ p generated.
  • the condition for not overshooting at time t3 is V0 2 / 2 ⁇ p> X.
  • A6 is a state in which, when X ⁇ 0, V0 ⁇ 0, the target is exceeded even if the actuator is decelerated at the maximum deceleration ⁇ p generated.
  • the condition for overshooting at time t3 is V0 2 / 2 ⁇ p ⁇ X.
  • the shortest time control used in the actuator control method according to the embodiment of the present invention can be performed by a control flow as shown in FIG.
  • this control flow starts, data of maximum acceleration ⁇ p and maximum deceleration ⁇ m are read in step S11.
  • step S12 data of the target amount (target value) Tx and the control amount (control value) x is read.
  • counting of elapsed time t and elapsed time tc for recalculation is started.
  • step S13 it is determined whether or not the period of the orbit recalculation has been reached, that is, whether or not the recalculated elapsed time tc after the orbit calculation has become equal to or greater than the orbit recalculation period tcr. If the trajectory recalculation period tcr is reached in step S13 (YES), the trajectory calculation is recalculated in step S14, and then the process goes to step S15. In step S13, the start recalculation period is not reached. (NO), the trajectory calculation of step S14 is bypassed and the process goes to step S15.
  • the orbit recalculation period tcr is preferably about 1/10 of the control period. However, even if the orbit recalculation period tcr is the same as the control period, no problem occurs.
  • step S15 it is determined whether or not the elapsed time t is smaller than the switching time t1, and if so (YES), the process goes to step S16, the output acceleration is set to ⁇ 1, and the process goes to step S20.
  • step S15 if the elapsed time t is not smaller than the switching time t1 (NO), go to step S17 to determine whether the elapsed time t is smaller than the end time t2, and if smaller (YES), Go to step S18, set the output acceleration to ⁇ 2, and then go to step S20. If the elapsed time t is not smaller than the end time t2 in step S17 (NO), the process goes to step S19, the output acceleration is set to “zero”, and the process goes to step S20.
  • step S20 an actuator thrust corresponding to the output acceleration is generated for a preset time (time related to various determination intervals), and the controlled object is controlled. Also, the elapsed time t and the recalculated elapsed time tc are counted. Thereafter, the process returns to step S12, and steps S12 to S20 are repeated.
  • the thrust of the actuator can be controlled while the recalculated elapsed time tc recalculates the trajectory calculation in step S14 for each trajectory recalculation period tcr.
  • the target trajectory is corrected at predetermined intervals or at predetermined intervals.
  • the reset signal period needs to be T / 2 or less with respect to the fluctuation period T within the allowable error.
  • FIG. 3 shows how the control trajectory changes due to this recalculation.
  • the control trajectory (dotted line) of the first calculation is actually scheduled to be X1
  • a new control trajectory (solid line) is calculated by recalculation, and the switching time t1 and The end time t2 also becomes a new value, and the control force is controlled based on the new switching time t1 and end time t2.
  • FIG. 6 and FIG. 7 show the control results when the switching time t1 and the end time t2 are recalculated at regular intervals. Recalculation is performed at the rising edge of the signal pulse.
  • a feedback (FB) shortest time control method In order to distinguish this shortest time control method from the shortest time control method of the prior art, here, it is referred to as a feedback (FB) shortest time control method.
  • FIG. 6 shows a case where there is no mechanical damping force
  • FIG. 7 shows a case where there is a mechanical damping force.
  • the control target can be matched with the target position with a typical trajectory.
  • FIG. 8 shows a simulation result of an example of feedback shortest time control
  • FIG. 9 shows a simulation result of a comparative example of PID control. Comparing these results, the control result in the comparative example of PID control shown in FIG. 9 changes greatly with respect to the load fluctuation of the control system, whereas in the embodiment of the feedback shortest time control shown in FIG. There is no disturbance in the results, and stable control results are always obtained. That is, in the comparative example of FIG. 9, the control result changes greatly with respect to the load fluctuation of the control system, whereas in the embodiment of FIG. 8, the control result is not disturbed and a stable control result is always obtained. ing.
  • the actuator control method and the actuator control device described above since the control is performed for the shortest time, the control speed becomes high, the maximum acceleration and the maximum deceleration can be set by measurement, and there is no adjustment term other than this. Therefore, there is no need to adjust the control gain. In addition, since it is ON / OFF control, there is no need to output an intermediate output, and the controller and driver can be simplified.
  • the control speed is high, and it is not necessary to adjust the control gain, and it is ON / OFF control, so there is no need to output an intermediate output.
  • the controller and the driver can be simplified, and a feedback element of updating the switching time t1 and the end time t2 by adding the target amount and the control amount deviation X at each control time at preset time intervals. Therefore, stable control results can always be obtained even if the external force changes or the control cycle is not set to high speed.
  • equipment installed in automobiles such as electric, hydraulic
  • Many actuator control methods and actuator control devices such as position control using pressure and other control objects to which PID control is applied It can be used as a.
  • two degrees of freedom can be controlled by applying the control of the present invention independently to each of the X direction and the Y direction. It can be applied to multi-degree-of-freedom control.

Landscapes

  • Engineering & Computer Science (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Feedback Control In General (AREA)

Abstract

　最短時間制御を用いると共に、予め、計測されたアクチュエータの制御力の最大出力時の最大加速度（αｐ）と最大減速度（αｍ）を用いて、制御のための計算を行う計算時刻（ｔ０）からの経過時間表示で、加速出力から減速出力へ切り替える切替時刻（ｔ１）と、減速出力の終了時刻（ｔ２）を算出する算出ステップと、計算時刻（ｔ０）から切替時刻（ｔ１）までは、アクチュエータの制御力を最大加速出力とし、切替時刻（ｔ１）から終了時刻（ｔ２）まではアクチュエータの制御力を最大減速出力とし、終了時刻（ｔ２）では制御力の出力を終了する制御出力ステップを備えると共に、前記算出ステップを予め設定した時間毎に繰り返して、切替時刻（ｔ１）と終了時刻（ｔ２）を算出して更新する更新ステップを備える。これにより、最短時間制御にフィードバック制御の要素を取り入れるアクチュエータの制御方法及びアクチュエータの制御装置を提供する。

Description

アクチュエータの制御方法及びアクチュエータの制御装置
　本発明は、アクチュエータの制御方法及びアクチュエータの制御装置に関し、より詳細には、最短時間制御において、予め設定した時間毎に出力パターンを修正する制御則を用いることでフィードバックの要素を取り入れることができるアクチュエータの制御方法及びアクチュエータの制御装置に関する。
　従来の制御ではＰＩＤ制御のフィードバック制御が一般的に用いられてきている。このＰＩＤ制御では、現象に対して必ず遅れて制御出力が決定されるため、制御速度を上げようとして、ＰＩＤの各制御ゲインを大きくすると制御が現象に対し間に合わなくなり、制御が不安定となる。特に制御対象の機械的減衰力が著しく低下すると制御が不安定になり易く、制御が発散する場合もある。この制御の不安定を避けるためのＰＩＤ制御の各制御ゲインを決定する方法として、制御の安定性を保証できるＨ∞等の制御理論を適用している。しかし、ＰＩＤ制御という制約のもとでは、負荷変動によりオーバーシュートや制御遅れが生じる。
　ＰＩＤ制御においても、スライディングモード制御を使用すると、制御ゲインを制御状態によって切り替えることで、負荷変動の影響を理論的には排除できる。しかし、制御周期が遅くなると、この制御は振動したまま収束しなくなる。そのため、負荷変動の影響を完全に排除するためには、無限に速く制御ゲインを切り替える必要があり、現象に対し無限に速いと言える程度まで、高速なコントロールが必要になる。更に、ＰＩＤ等の各制御ゲインの調整が必要であり、この制御ゲインの調整の善し悪しが制御の善し悪しを決定してしまうため、この制御ゲインの調整が非常に重要な要素となってしまっている。
　また、これらの制御理論は、ＰＩＤ制御の欠点を補うもので、「最短の時間で目標位置に制御対象を静止させる」ことを制御の目的とするために構築された手法ではない。そのため、この単純な目的に対してはＰＩＤ制御よりもむしろ、最短時間制御がより目的に合致した制御方法であるといえる。
　最も単純な最短時間制御は、目標位置までの行程の半分で制御対象を最大推力で加速し、残り半分の行程を最大減速度で減速して目標位置に制御対象を静止させる制御である。この出力パターンは制御開始前に決定されるので、この最短時間制御は、フィードフォワード制御と言える。
　言い換えれば、最短時間制御とはアクチュエータの最大駆動力で動かし、最大制動力で停止させる制御方法で、理論的には最短時間で制御対象を目標に静止させることが可能な制御である。つまり、最短時間制御は「最短の時間で目標位置に制御対象を静止させる」という制御の目的に完全に合致する制御方法である。
　例えば、日本特許出願の特開２０００－９４３７１号公報に記載されているように、この最短時間制御を用いた制御装置として、サーボモータを制御するための制御手段と、無負荷時の値を基準とした制御量と負荷重量の関係を記憶しておく対応関係記憶手段と、負荷推定計算手段と、負荷推定計算手段で計算されたワーク情報を基に加減速定数を決定する加減速定数決定手段と、決定された加減速定数を使用してサーボ制御手段に払い出す指令を作成する指令作成手段を備えて、ワークを把持した時は、加速時間が長くなり、ワークを把持していない時は、加速時間を短くするロボットの最短時間制御装置が提案されている。
　しかしながら、最短時間制御は、理論的に最短の時間で制御可能な理想的な制御である一方、出力パターンが初速や最大加速度、最大減速度を考慮して決定されるオープン制御であり、フィードバック要素が無いため、目標と制御量が合致しないときに、修正の方法がなく、正確に目標と制御量を一致させることが困難であるという問題があるため、実際の制御に採用されることは稀であった。
日本特許出願の特開２０００－９４３７１号公報
　本発明は、上記の状況を鑑みてなされたものであり、その目的は、最短時間制御にフィードバック制御の要素を取り入れたアクチュエータの制御方法及びアクチュエータの制御装置を提供することにある。
　上記のような目的を達成するための本発明のアクチュエータの制御方法は、最短時間制御を用いると共に、予め、計測されたアクチュエータの制御力の最大出力時の最大加速度αｐと最大減速度αｍを用いて、制御のための計算を行う計算時刻ｔ０からの経過時間表示で、加速出力から減速出力へ切り替える切替時刻ｔ１と、減速出力の終了時刻ｔ２を算出する算出ステップと、前記計算時刻ｔ０から前記切替時刻ｔ１までは前記アクチュエータの制御力を最大加速出力とし、前記切替時刻ｔ１から前記終了時刻ｔ２までは前記アクチュエータの制御力を最大減速出力とし、前記終了時刻ｔ２で制御力の出力を終了する制御出力ステップを備えると共に、前記算出ステップを予め設定した時間毎に繰り返し、前記切替時刻ｔ１と前記終了時刻ｔ２を算出して更新することを特徴とする方法である。
　つまり、計算時刻ｔ０の制御対象物の位置から目標位置までの制御の目標軌跡を予め設定した時間毎である一定周期毎又は不定期毎に偏差、速度を考慮して再計算して、切替時刻ｔ１と終了時刻ｔ２を更新する。この切替時刻ｔ１と終了時刻ｔ２は再計算した計算時刻ｔ０からの経過時間となる。
　なお、この最大加速度αｐ、又は、最大減速度αｍは、制御値の２階の時間微分値若しくは制御値の２階の差分値であり、制御値が運動を伴わない温度のようなものでも適用できる。
　この方法によれば、最短時間制御であるために、制御速度が高速となり、最大加速度αｐと最大減速度αｍは計測によって設定でき、これ以外に調整項が無いため、制御ゲインを調整する必要が無い。また、ＯＮ／ＯＦＦ制御であるため、中間的な出力を出す必要がなく、コントローラ、ドライバーを簡略化できる。
　その上、予め設定した時間毎に、制御の各時刻における目標量と制御量の偏差Ｘを入れて計算し直して再計算の計算時刻ｔ０からの経過時間表示である切替時刻ｔ１と終了時刻ｔ２を更新するというフィードバックの要素を取り入れているため、外力が変化しても、また、制御の時間間隔を高速にしなくても、常に安定した制御結果を得ることができる。その結果、従来の制御則では相反する大きな課題であった「制御の速度」と「安定性」を両立させることができる。
　また、上記のアクチュエータの制御方法において、前記算出ステップにおいて、前記計算時刻ｔ０での位置から前記終了時刻ｔ２の目標位置までの軌道を相接する２つの２次曲線の組み合わせで表して、初速をＶ０、目標位置と制御量の偏差をＸとした場合に、前記切替時刻ｔ１と、前記終了時刻ｔ２を、
Figure JPOXMLDOC01-appb-M000006
Figure JPOXMLDOC01-appb-M000007
 　の（１）式と（２）式で算出すると、容易に、切替時刻ｔ１と記終了時刻ｔ２を算出できる。なお、α１は計算時刻ｔ０～切替時刻ｔ１の最大加速度αｐ又は最大減速度αｍであり、α２は切替時刻ｔ１～終了時刻ｔ２の最大減速度αｍ又は最大加速度αｐである。　　　
　そして、上記のような目的を達成するための本発明のアクチュエータの制御装置は、最短時間制御を用いると共に、予め、計測されたアクチュエータの制御力の最大出力時の最大加速度αｐと最大減速度αｍを用いて、制御のための計算を行う計算時刻ｔ０からの経過時間表示で、加速出力から減速出力へ切り替える切替時刻ｔ１と、減速出力の終了時刻ｔ２を算出する算出手段と、前記計算時刻ｔ０から前記切替時刻ｔ１までは前記アクチュエータの制御力を最大加速出力とし、前記切替時刻ｔ１から前記終了時刻ｔ２までは前記アクチュエータの制御力を最大減速出力とし、前記終了時刻ｔ２で制御力の出力を終了する制御出力手段を備えると共に、予め設定した時間毎に前記算出手段により前記切替時刻ｔ１と前記終了時刻ｔ２を繰り返して算出し、更新する更新手段を備えて構成される。
　また、上記のアクチュエータの制御装置において、前記算出手段が、前記計算時刻ｔ０での位置から前記終了時刻ｔ２の目標位置までの軌道を相接する２つの２次曲線の組み合わせで表して、初速をＶ０、目標位置と制御量の偏差をＸとした場合に、前記切替時刻ｔ１と、前記終了時刻ｔ２を、
Figure JPOXMLDOC01-appb-M000008
Figure JPOXMLDOC01-appb-M000009
 　の（１）式と（２）式で算出するように構成する。なお、α１は計算時刻ｔ０～切替時刻ｔ１の最大加速度αｐ又は最大減速度αｍであり、α２は切替時刻ｔ１～終了時刻ｔ２の最大減速度αｍ又は最大加速度αｐである。
　また、上記のアクチュエータの制御装置において、計算時刻ｔ０から切替時刻ｔ１の間の加速度αｐと切替時刻ｔ１から終了時刻ｔ２の間の加速度αｍを表１によって決定する。
Figure JPOXMLDOC01-appb-T000010
　これらの構成のアクチュエータの制御装置によれば、上記のアクチュエータの制御方法を実施でき、同様の効果を奏することができる。
　本発明に係るアクチュエータの制御方法及びアクチュエータの制御装置によれば、最短時間制御であるために、制御速度が高速となり、最大加速度と最大減速度は計測によって設定でき、これ以外に調整項はないため、制御ゲインを調整する必要が無い。また、ＯＮ／ＯＦＦ制御であるため、中間的な出力を出す必要がなく、コントローラ、ドライバーを簡略化できる。
　その上、予め設定した時間毎に、制御の各時刻における目標量と制御量の偏差を入れて切替時刻と終了時刻を更新するというフィードバックの要素を取り入れているため、外力が変化しても、また、制御の時間間隔を高速にしなくても、常に安定した制御結果を得ることができる。その結果、従来の制御則では相反する大きな課題であった「制御の速度」と「安定性」を両立させることができる。
図１は、本発明の実施の形態のアクチュエータの制御方法で用いられる最短時間制御を説明するための最短時間制御モデルを示す図である。 図２は、制御軌跡の計算条件を説明するための図である。 図３は、再計算における制御軌跡の変化を説明するための図である。 図４は、ｆ（ｔ）、ｇ（ｔ）の取り得る目標軌跡を示す図である。 図５は、本発明の実施の形態のアクチュエータの制御方法の制御フローの一例を示す図である。 図６は、本発明の実施の形態のアクチュエータの制御方法のフィードバック最短時間制御の機械系の減衰力が無い場合の制御結果を示す図である。 図７は、本発明の実施の形態のアクチュエータの制御方法のフィードバック最短時間制御の機械系の減衰力が有る場合の制御結果を示す図である。 図８は、実施例のシミュレーション結果を示す図である。 図９は、比較例のシミュレーション結果を示す図である。 図１０は、従来技術の最短時間制御の機械系の減衰力が無い場合の制御結果を示す図である。 図１１は、従来技術の最短時間制御の機械系の減衰力が有る場合の制御結果を示す図である。 図１２は、ＰＩＤ制御を説明するためのＰＩＤ制御モデルを示す図である。
　以下、本発明に係る実施の形態のアクチュエータの制御方法及びアクチュエータの制御装置について、図面を参照しながら説明する。なお、ここでは、本発明の最短時間制御を明確にするために、ＰＩＤ制御との比較を行いながら説明する。
　本発明に係る実施の形態のアクチュエータの制御装置は、最短時間制御を用いると共に、算出手段と、制御力出力手段と、更新手段を備えて構成される。
　この算出手段は、予め計測されたアクチュエータの制御力の最大出力時の最大加速度αｐと最大減速度αｍを用いて、制御のための計算を行う計算時刻ｔ０からの経過時間表示で、加速出力から減速出力へ切り替える切替時刻ｔ１と、減速出力の終了時刻ｔ２を算出する。
　また、制御出力手段は、計算時刻ｔ０から切替時刻ｔ１までは、アクチュエータの制御力を最大加速出力とし、切替時刻ｔ１から終了時刻ｔ２まではアクチュエータの制御力を最大減速出力とし、終了時刻ｔ２で制御力の出力を終了する。
　更に、更新手段は、一定周期又は不定期な予め設定した時間毎に算出手段で切替時刻ｔ１と終了時刻ｔ２を繰り返し算出し、更新するように構成される。この算出手段は、再計算される計算時刻ｔ０の位置から目標位置までの軌道を相接する２つの２次曲線の組み合わせで表すことにして、初速をＶ０、目標量と制御量の偏差をＸとした場合に、切替時刻ｔ１と、終了時刻ｔ２を、
Figure JPOXMLDOC01-appb-M000011
Figure JPOXMLDOC01-appb-M000012
 　の（１）式と（２）式で算出する。ここで、α１は計算時刻ｔ０～切替時刻ｔ１の最大加速度αｐ又は最大減速度αｍであり、α２は切替時刻ｔ１～終了時刻ｔ２の最大減速度αｍ又は最大加速度αｐである。
　また、本発明の実施の形態のアクチュエータの制御方法で用いる最短時間制御は、図１に示す錘ｍが斜面を下って上がるような機械モデルと等価となる。図１のように、斜面に対し錘を持ち上げてから放すと、重力のために一定の加速度で錘は斜面を下り、続いて反対側の斜面を一定の減速度で上がる。摩擦等のエネルギー損失がなければ、錘ｍは始めと同じ高さまで登った所で速度ゼロとなり、一瞬停止する。この時に重力が無くなれば錘ｍはその位置に静止し続ける。
　これをアクチュエータで制御対象を移動させる制御システムに置き換えると、アクチュエータの最大推力で錘を押し、続いてアクチュエータの最大推力で錘を引き戻すと、推す時に入力した仕事量と、引き戻す時に入力した仕事量が釣り合った時に制御対象が静止する。この様にして制御対象が静止した位置が目標位置となっていれば制御終了となる。
　つまり、最短時間制御ではアクチュエータの最大推力で制御対象を加減速させ、目標位置に制御するため、理論的に最短の時間で制御できる。また、この時の制御出力パターンは、制御開始前に決定されるため、最短時間制御はフィードフォワード制御である。
　これに対し、従来技術のＰＩＤ制御は、図１２に示すような基本的な質量ｍ、ばね、ダンパ系の減衰振動モデルを基本としたものとなり、ばねがＰ項、ダッシュポッドがＤ項の役割を果たす。なお、ゼロ点の補正項がＩ項となるが、ここではＩ項には物理的な意味はあまりない。
　この制御をエネルギー変換で考えると、図１２の中段に示すように、目標位置を入力することで、目標変位としてばねを撓ませて、ばねの歪エネルギーを制御系に入力すると、ばね力に引かれて錘（質量ｍ）が動き始める。この時、歪エネルギーから運動エネルギーへの変換が行われる。錘ｍが運動を始めるとダッシュポッドにより運動エネルギーが熱エネルギーに変換され、系の外へエネルギーが放出される。初めに入力されたばねの歪エネルギーが全て熱エネルギーに変換されると、図１２の下段に示すように、制御対象である錘ｍは目標位置で静止することになる。なお、ＰＩＤ制御では制御対象の運動状態から制御出力が決定されるため、フィードバック制御である。
　このように最短時間制御とＰＩＤ制御は根本的に異なる制御であると言えるが、一方で、ＰＩＤ制御のＰゲイン、Ｄゲインを非常に大きくし、アクチュエータの最大出力で出力の上限をカットすると、ＰＩＤ制御の制御出力波形は最短時間制御の制御出力波形に近づいていくため、最短時間制御はＰＩＤ制御のＰＤゲインを極限まで大きくした制御であると見ることもできる。しかし、ＰＩＤ制御では、通常は計算や制御の遅れにより、ＰＤゲインをあまり大きくすると制御が発散してしまうことになる。これはＰＩＤ制御がフィードバック制御であり常に現象に遅れて制御出力が決定されるため、この遅れが大きくなりすぎると制御が発散するからである。
　これに対し、最短時間制御はフィードフォワード制御であり、動かし始めてから止めるまでを考慮した制御出力が常に現象よりも先に決定されるため、制御が安定であり、最短時間制御で、ＰＤゲインを極限まで大きくしたＰＩＤ制御と同等の制御出力を出しても制御は発散しない。
　この最短時間制御の最も単純な例を図１０及び図１１に示す。図１０は、機械系の減衰力が無い場合を、図１１は機械系の減衰力がある場合を示す。図１０及び図１１では、計算時刻ｔ０から最大推力で目標に向かってアクチュエータを作動させ、切替時刻ｔ１で今度は最大減速度でアクチュエータを作動させ、続いて終了時刻ｔ２でアクチュエータ推力をゼロにしている。このように最短時間制御では切替時刻ｔ１と終了時刻ｔ２を決定すれば制御が可能である。切替時刻ｔ１と終了時刻ｔ２は以下の計算条件を元に決定することができる。
　この計算条件では、制御対象が相接する２つの２次曲線上を通って目標に到達すると仮定する。そして、アクチュエータが発生可能な最大加速度αｐと、アクチュエータが発生可能な最大減速度αｍと、計算時刻ｔ０での目標量Ｔｘと制御量ｘの偏差Ｘ（＝目標量－制御量：目標位置と制御時の位置の差）と、計算時刻ｔ０での制御対象の速度Ｖ０を既知の値とし、切替時刻ｔ１で２つの２次曲線が接することと、終了時刻ｔ２で制御対象の速度をゼロとすること（Ｖ＝０）、終了時刻ｔ２で偏差Ｘをゼロとすること（Ｘ＝０）を拘束条件として、切替時刻ｔ１と終了時刻ｔ２を求める。
　制御軌跡は、図２に示すように、２つの２次曲線ｆ（ｔ）、ｇ（ｔ）で構成されるものと仮定し、以下の条件を元に、制御出力を切り替える切替時刻ｔ１と制御出力を終了する終了時刻ｔ２を求める。また加速度α１、α２を表１より決定する。また、Ｖ０は制御中に得られた制御量の１階の微分値（または差分値）である。
　計算条件は、次の（１）から（７）である。
（１）アクチュエータの最大出力時に発生可能な最大加速度αｐ、最大減速度αｍは既知、すなわち、予め測定した加速度より得られる。
（２）計算時刻ｔ０における速度Ｖ０は既知、すなわち、測定値の１階の微分（または差分）により得られる。
（３）計算時刻ｔ０で第１の２次曲線ｆ（ｔ０）の値がゼロである。
（４）計算時刻ｔ０で第１の２次曲線ｆ（ｔ０）の１階の微分値が時刻ｔ０での速度（初速）である。
（５）切替時刻ｔ１で第２の２次曲線ｇ（ｔ）が、１つ目の２次曲線ｆ（ｔ）に接する。（６）終了時刻ｔ２で第２の２次曲線ｇ（ｔ２）の値が目標値である。
（７）終了時刻ｔ２で第２の２次曲線ｇ（ｔ）の１階の微分値がゼロである。
　以上の条件から、下記の(３)式～（１３）式が得られる。これらを連立させて、出力の切替時刻ｔ１と終了時刻ｔ２を求め、加速度α１、α２を求める。ここでα１は計算時刻ｔ０から切替時刻ｔ１の加速度であり、α２は切替時刻ｔ１から終了時刻ｔ２の加速度で、α１＝αｐのとき、α２＝αｍ、α１＝αｍのときα２＝αｐである。
Figure JPOXMLDOC01-appb-M000013
 （３）式と（５）式より、
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
 （３）式と（５）式と（９）式と（１５）式と（１６）式と（１７）式と（１９）式より、
Figure JPOXMLDOC01-appb-M000021
 （３）式と（５）式と（８）式と（１５）式と（１６）式と（１７）式と（１９）式と（２０）式より、
Figure JPOXMLDOC01-appb-M000022
 （２１）式を変形して、
Figure JPOXMLDOC01-appb-M000023
 （２２）に２次方程式の解の公式を適用して、
Figure JPOXMLDOC01-appb-M000024
 （２３）式を（２０）式に代入してｔ２を得る。
　ここで、ｆ（ｔ）、ｇ（ｔ）の取り得る軌跡は図４に示すＡ１～Ａ６の６通りとなる。この６通りを場合分けする。
　Ａ１は、Ｘ＞０，Ｖ０＞０のとき、アクチュエータ発生最大減速度αｍで減速しても目標をオーバーする状態である。最大減速度αｍで減速した時に速度がゼロになるまでの時間をｔ３とすると、ｔ３＝Ｖ０／αｍとなり、時刻ｔ３においてオーバーシュートする条件は、Ｖ０×ｔ３／２＝Ｖ０2／２αｍ＞Ｘである。
　Ａ２は、Ｘ＞０，Ｖ０＞０のとき、アクチュエータ発生最大減速度αｍで減速すれば、目標をオーバーしない状態である。Ａ１と同様に計算すると、時刻ｔ３においてオーバーシュートしない条件は、Ｖ０2／２αｍ＜Ｘである。
　Ａ３は、Ｘ＞０，Ｖ０＜０の条件であり、Ａ４は、Ｘ＜０，Ｖ０＞０の条件である。　また、Ａ５は、Ｘ＜０，Ｖ０＜０のとき、アクチュエータ発生最大減速度αｐで減速すれば目標をオーバーしない状態である。Ａ１と同様に計算すると、時刻ｔ３においてオーバーシュートしない条件は、Ｖ０2／２αｐ＞Ｘである。
　Ａ６は、Ｘ＜０，Ｖ０＜０のとき、アクチュエータ発生最大減速度αｐで減速しても目標をオーバーする状態である。Ａ１と同様に計算すると、時刻ｔ３においてオーバーシュートする条件は、Ｖ０2／２αｐ＜Ｘである。
　Ａ１、Ａ２、Ａ３が上凸から下凸への変化であり、α１＝αｍ＜０、α２＝αｐ＞０であり、Ａ４、Ａ５、Ａ６が下凸から上凸への変化であり、α１＝αｐ＞０、α２＝αｍ＜０である。これにより、α１とα２を決定する。
　この場合分けを表１に示す。
Figure JPOXMLDOC01-appb-T000025
　この様にして求めたα１、α２に仮想質量ｍを乗じ、アクチュエータ推力を求める。つまり、計算時刻ｔ０～切替時刻ｔ１の間はアクチュエータ推力１（＝α１×仮想質量）で、切替時刻ｔ１～終了時刻ｔ２の間はアクチュエータ推力２（＝α２×仮想質量）となる。
　この本発明の実施の形態のアクチュエータの制御方法で用いる最短時間制御は、図５に示すような制御フローによって行うことができる。この制御フローがスタートすると、ステップＳ１１で、最大加速度αｐと最大減速度αｍのデータを読み込む。次のステップＳ１２で、目標量（目標値）Ｔｘと制御量（制御値）ｘのデータを読み込む。それとともに、経過時間ｔと再計算用経過時間ｔｃのカウントを始める。
　ステップＳ１３で，軌道再計算の周期になっているか否か、即ち、軌道計算してからの再計算用経過時間ｔｃが軌道再計算の周期ｔｃｒ以上になったか否かを判定する。ステップＳ１３で，軌道再計算の周期ｔｃｒになった場合には（ＹＥＳ）、ステップＳ１４で、軌道計算し直してから、ステップＳ１５に行き、ステップＳ１３で、起動再計算の周期になっていない場合には（ＮＯ）、ステップＳ１４の軌道計算を迂回してステップＳ１５に行く。なお、軌道再計算の周期ｔｃｒは、制御周期の１／１０程度の周期とするのが好ましいが、軌道再計算の周期ｔｃｒを制御周期と同じにしても問題は生じない。
　ステップＳ１４の軌道計算では、初速Ｖ０を「Ｖ０＝（ｘ－ｘ-1）／ｔｃｒ」（ｘ-1は、計算周期前の制御量）で、運動エネルギーＥを「Ｅ＝Ｖ０2／２」で算出し、表１からα１とα２を決定し、（２３）式と（２０）式より、切替時刻ｔ１と終了時刻ｔ２を計算する。また、再計算用経過時間ｔｃをリセットしてゼロにする（Ｔｃ＝０）。
　ステップＳ１５では、経過時間ｔが切替時刻ｔ１より小さいか否かを判定し、小さい場合には（ＹＥＳ）、ステップＳ１６に行き、出力加速度をα１にしてから、ステップＳ２０に行く。ステップＳ１５で、経過時間ｔが切替時刻ｔ１より小さくない場合には（ＮＯ）、ステップＳ１７に行き、経過時間ｔが終了時刻ｔ２より小さいか否かを判定し、小さい場合には（ＹＥＳ）、ステップＳ１８に行き、出力加速度をα２にしてから、ステップＳ２０に行く。また、ステップＳ１７で、経過時間ｔが終了時刻ｔ２より小さくない場合には（ＮＯ）、ステップＳ１９に行き、出力加速度を「ゼロ」にしてから、ステップＳ２０に行く。
　ステップＳ２０では、出力加速度に相当するアクチュエータ推力を予め設定された時間（各種の判定のインターバルに関係する時間）の間発生し、制御対象を制御する。また、経過時間ｔと再計算用経過時間ｔｃをカウントする。その後、ステップＳ１２に戻り、ステップＳ１２～ステップＳ２０を繰り返す。これにより、再計算用経過時間ｔｃが軌道再計算の周期ｔｃｒ毎にステップＳ１４の軌道計算を計算し直しながら、アクチュエータの推力を制御することができる。
　なお、経過時間ｔが予め設定してある時間を超えたり、制御を終了するスイッチ信号が入力されたりする等の、この図５の制御を終了すべき事情が発生すると、この制御フローのどのステップを実施していても、割り込みが発生し、リターンに行き、上位の制御フローに戻り、上位の制御フローの終了と共に、図５の制御フローも終了する。
　上記の様にして求めた切替時刻ｔ１と終了時刻ｔ２でアクチュエータの動作を切り替えることで、図１０に示すような理想的な制御結果が得られる。しかし、この結果は、摩擦や減衰、誤差などが無い理想的な状況下での結果である。制御対象に機械的な減衰力が存在すると制御結果は図１１に示すように目標と一致しなくなってしまう。
　この問題を解決するために、本発明のアクチュエータの制御方法では、一定周期又は不定期な予め設定した時間毎に目標軌跡を修正する。この一定周期等の修正用のリセットの期間は、許容誤差内の変動周期Ｔに対して、リセット信号周期はＴ／２以下とする必要がある。この再計算による制御軌跡の変化の様子を図３に示す。この図３では、最初の計算の制御軌道（点線）ではＸ１になる予定が実際にはＸ２であった場合に、再計算により、新たな制御軌道（実線）が計算されて、切替時刻ｔ１と終了時刻ｔ２も新たな値となり、この新たな切替時刻ｔ１と終了時刻ｔ２に基づいて制御力が制御されることになる。
　図６及び図７に一定周期毎に切替時刻ｔ１と終了時刻ｔ２を計算し直したときの制御結果を示す。信号パルスの立ち上がりのタイミングで再計算を実施している。この最短時間制御方法を、従来技術の最短時間制御方法と区別するために、ここでは、フィードバック（ＦＢ）最短時間制御方法ということにする。図６に機械系の減衰力が無い場合を、図７に機械系の減衰力がある場合を示すが、結果として図７に示すような制御対象に機械的な減衰力がある場合でもほぼ理想的な軌跡で制御対象を目標位置に合致させることができることが分かる。
　図８にフィードバック最短時間制御の実施例のシミュレーション結果を示し、図９にＰＩＤ制御の比較例のシミュレーション結果を示す。この結果を比較すると、図９に示すＰＩＤ制御の比較例では制御系の負荷変動に対し、制御結果が大きく変化してしまうのに対し、図８に示すフィードバック最短時間制御の実施例では、制御結果に乱れがなく常に安定した制御結果が得られている。つまり、図９の比較例では、制御系の負荷変動に対し、制御結果が大きく変化してしまうのに対し、図８の実施例では制御結果に乱れが無く、常に安定した制御結果が得られている。
　従って、上記のアクチュエータの制御方法及びアクチュエータの制御装置によれば、最短時間制御であるために、制御速度が高速となり、最大加速度と最大減速度は計測によって設定でき、これ以外に調整項はないため、制御ゲインを調整する必要が無い。また、ＯＮ／ＯＦＦ制御であるため、中間的な出力を出す必要がなく、コントローラ、ドライバーを簡略化できる。
　その上、予め設定した時間毎に、制御の各時刻における目標量と制御量の偏差Ｘを入れて切替時刻ｔ１と終了時刻ｔ２を更新するというフィードバックの要素を取り入れているため、外力が変化しても、また、制御周期を高速にしなくても、常に安定した制御結果を得ることができる。その結果、従来の制御則では相反する大きな課題であった「制御の速度」と「安定性」を両立させることができる。
　本発明のアクチュエータの制御方法及びアクチュエータの制御装置によれば、制御速度が高速となり、しかも、制御ゲインを調整する必要が無く、ＯＮ／ＯＦＦ制御であるため、中間的な出力を出す必要がなく、コントローラ、ドライバーを簡略化でき、その上、予め設定した時間毎に、制御の各時刻における目標量と制御量の偏差Ｘを入れて切替時刻ｔ１と終了時刻ｔ２を更新するというフィードバックの要素を取り入れているため、外力が変化しても、また、制御周期を高速にしなくても、常に安定した制御結果を得ることができるので、自動車等に搭載した機器など、例えば、電動、油圧、空圧を用いた位置制御や、その他ＰＩＤ制御が適用されている制御対象などの数多くのアクチュエータの制御方法及びアクチュエータの制御装置として利用できる。
　また、２自由度の場合には、Ｘ方向、Ｙ方向のそれぞれに対して独立して本発明の制御を適用することで２自由度の制御が可能になるので、１自由度の制御のみならず、多自由度の制御に適用できる。
ｔ０　計算時刻
ｔ１　切替時刻
ｔ２　終了時刻
Ｖ０　初速
Ｘ　目標量と制御量の偏差
αｐ最大加速度
αｍ最大減速度

Claims (5)

  1. 　最短時間制御を用いると共に、
    　予め、計測されたアクチュエータの制御力の最大出力時の最大加速度αｐと最大減速度αｍを用いて、制御のための計算を行う計算時刻ｔ０からの経過時間表示で、加速出力から減速出力へ切り替える切替時刻ｔ１と、減速出力の終了時刻ｔ２を算出する算出ステップと、
    　前記計算時刻ｔ０から前記切替時刻ｔ１までは前記アクチュエータの制御力を最大加速出力とし、前記切替時刻ｔ１から前記終了時刻ｔ２までは前記アクチュエータの制御力を最大減速出力とし、前記終了時刻ｔ２で制御力の出力を終了する制御出力ステップを備えると共に、
    　前記算出ステップを予め設定した時間毎に繰り返し、前記切替時刻ｔ１と前記終了時刻ｔ２を算出して更新することを特徴とするアクチュエータの制御方法。
  2. 　前記算出ステップにおいて、前記計算時刻ｔ０での位置から前記終了時刻ｔ２の目標位置までの軌道を相接する２つの２次曲線の組み合わせで表して、初速をＶ０、目標位置と制御量の偏差をＸとした場合に、前記切替時刻ｔ１と、前記終了時刻ｔ２を、
    Figure JPOXMLDOC01-appb-M000001
    Figure JPOXMLDOC01-appb-M000002
     　ここで、α１は計算時刻ｔ０～切替時刻ｔ１の最大加速度αｐ又は最大減速度αｍであり、α２は切替時刻ｔ１～終了時刻ｔ２の最大減速度αｍ又は最大加速度αｐであり、この（１）式と（２）式で算出することを特徴とする請求項１記載のアクチュエータの制御方法。
  3. 　最短時間制御を用いると共に、
    　予め、計測されたアクチュエータの制御力の最大出力時の最大加速度αｐと最大減速度αｍを用いて、制御のための計算を行う計算時刻ｔ０からの経過時間表示で、加速出力から減速出力へ切り替える切替時刻ｔ１と、減速出力の終了時刻ｔ２を算出する算出手段と、
    　前記計算時刻ｔ０から前記切替時刻ｔ１までは前記アクチュエータの制御力を最大加速出力とし、前記切替時刻ｔ１から前記終了時刻ｔ２までは前記アクチュエータの制御力を最大減速出力とし、前記終了時刻ｔ２で制御力の出力を終了する制御出力手段を備えると共に、
    　予め設定した時間毎に前記算出手段により前記切替時刻ｔ１と前記終了時刻ｔ２を繰り返して算出し、更新する更新手段を備えたことを特徴とするアクチュエータの制御装置。
  4. 　前記算出手段が、前記計算時刻ｔ０での位置から前記終了時刻ｔ２の目標位置までの軌道を相接する２つの２次曲線の組み合わせで表して、初速をＶ０、目標位置と制御量の偏差をＸとした場合に、前記切替時刻ｔ１と、前記終了時刻ｔ２を、
    Figure JPOXMLDOC01-appb-M000003
    Figure JPOXMLDOC01-appb-M000004
     　ここで、α１は計算時刻ｔ０～切替時刻ｔ１の最大加速度αｐ又は最大減速度αｍであり、α２は切替時刻ｔ１～終了時刻ｔ２の最大減速度αｍ又は最大加速度αｐであり、この（１）式と（２）式で算出することを特徴とする請求項１記載のアクチュエータの制御装置。
  5. 　計算時刻ｔ０から切替時刻ｔ１の間の加速度αｐと切替時刻ｔ１から終了時刻ｔ２の間の加速度αｍを表１によって決定する
    Figure JPOXMLDOC01-appb-T000005
     ことを特徴とする請求項１～４のいずれか１項に記載のアクチュエータの制御装置。
PCT/JP2012/065886 2011-07-12 2012-06-21 アクチュエータの制御方法及びアクチュエータの制御装置 WO2013008602A1 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
US14/232,167 US9558897B2 (en) 2011-07-12 2012-06-21 Actuator control method and actuator control device
EP12811162.2A EP2733554B1 (en) 2011-07-12 2012-06-21 Actuator control method and actuator control device
CN201280034323.1A CN103649851B (zh) 2011-07-12 2012-06-21 促动器的控制方法及促动器的控制装置

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2011153498A JP5803361B2 (ja) 2011-07-12 2011-07-12 アクチュエータの制御方法及びアクチュエータの制御装置
JP2011-153498 2011-07-12

Publications (1)

Publication Number Publication Date
WO2013008602A1 true WO2013008602A1 (ja) 2013-01-17

Family

ID=47505900

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2012/065886 WO2013008602A1 (ja) 2011-07-12 2012-06-21 アクチュエータの制御方法及びアクチュエータの制御装置

Country Status (5)

Country Link
US (1) US9558897B2 (ja)
EP (1) EP2733554B1 (ja)
JP (1) JP5803361B2 (ja)
CN (1) CN103649851B (ja)
WO (1) WO2013008602A1 (ja)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
AT516134B1 (de) 2014-07-22 2018-12-15 Ge Jenbacher Gmbh & Co Og Brennkraftmaschine mit einer Regeleinrichtung
US10396566B2 (en) 2015-09-10 2019-08-27 Cpg Technologies, Llc Geolocation using guided surface waves
JP6798227B2 (ja) 2016-10-03 2020-12-09 オムロン株式会社 制御装置、制御装置の制御方法、制御プログラム、および記録媒体

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05224702A (ja) * 1992-02-14 1993-09-03 Omron Corp バンバン制御装置
JPH07302121A (ja) * 1994-05-02 1995-11-14 Canon Inc 位置決め制御装置
JPH11296234A (ja) * 1998-04-10 1999-10-29 Matsushita Electric Ind Co Ltd モータ類の位置制御時の加重制御方法およびその装置
JP2000094371A (ja) 1998-09-18 2000-04-04 Yaskawa Electric Corp ロボットの最短時間制御装置

Family Cites Families (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS58119004A (ja) 1982-01-11 1983-07-15 Hitachi Ltd バングバング制御方法
EP0103493B1 (en) 1982-09-15 1987-12-16 Ampex Corporation Improved bang-bang controlled velocity command generator
JPS6177905A (ja) 1984-09-26 1986-04-21 Mitsubishi Electric Corp 位置決め制御回路
JPS62120515A (ja) 1985-11-20 1987-06-01 Fuji Electric Co Ltd 位置決め制御方式
US5119250A (en) * 1990-06-15 1992-06-02 International Business Machines Corporation Method and apparatus for performing a seek
EP0507907B1 (en) * 1990-09-18 1999-01-13 Rodime PLC Digital servo control system for use in disk drives
US5677609A (en) 1994-07-28 1997-10-14 National Semiconductor Corporation Intelligent servomechanism controller
US6002184A (en) * 1997-09-17 1999-12-14 Coactive Drive Corporation Actuator with opposing repulsive magnetic forces
JP2001100802A (ja) * 1999-09-30 2001-04-13 Matsushita Electric Works Ltd 加減速制御装置
US6686716B1 (en) 2001-07-18 2004-02-03 Itt Manufacturing Enterprises, Inc. Tuned open-loop switched to closed-loop method for rapid point-to-point movement of a periodic motion control system
JP3881593B2 (ja) * 2002-05-17 2007-02-14 株式会社山武 制御装置
JP4112900B2 (ja) * 2002-05-21 2008-07-02 株式会社山武 制御方法及び制御装置
JP4127039B2 (ja) * 2002-12-06 2008-07-30 トヨタ自動車株式会社 フィードバック制御装置
US8024052B1 (en) * 2007-03-30 2011-09-20 Tim Hakala Adaptive mapping of device output change to amounts of control effort
JP5445932B2 (ja) 2009-10-13 2014-03-19 横河電機株式会社 バルブ制御装置およびバルブ制御方法

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05224702A (ja) * 1992-02-14 1993-09-03 Omron Corp バンバン制御装置
JPH07302121A (ja) * 1994-05-02 1995-11-14 Canon Inc 位置決め制御装置
JPH11296234A (ja) * 1998-04-10 1999-10-29 Matsushita Electric Ind Co Ltd モータ類の位置制御時の加重制御方法およびその装置
JP2000094371A (ja) 1998-09-18 2000-04-04 Yaskawa Electric Corp ロボットの最短時間制御装置

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
See also references of EP2733554A4 *

Also Published As

Publication number Publication date
US9558897B2 (en) 2017-01-31
CN103649851A (zh) 2014-03-19
EP2733554A4 (en) 2016-01-06
EP2733554B1 (en) 2021-09-29
CN103649851B (zh) 2016-06-15
EP2733554A1 (en) 2014-05-21
US20140252885A1 (en) 2014-09-11
JP5803361B2 (ja) 2015-11-04
JP2013020464A (ja) 2013-01-31

Similar Documents

Publication Publication Date Title
JP5838681B2 (ja) アクチュエータの制御方法及びアクチュエータの制御装置
EP1291747B1 (en) Positioning servocontroller
JP4944806B2 (ja) 位置制御装置
JP6020537B2 (ja) モータ制御装置及びモータ制御方法
US10744642B2 (en) Control apparatus of motor
WO2013008602A1 (ja) アクチュエータの制御方法及びアクチュエータの制御装置
JP2016134975A (ja) 振動を抑制するモータ制御装置
Bucci et al. Nonlinear control algorithm for improving settling time in systems with friction
JP5834628B2 (ja) アクチュエータの制御方法及びアクチュエータの制御装置
Mitsantisuk et al. Parameter estimation of flexible robot using multi-encoder based on disturbance observer
JP4183057B2 (ja) 数値制御システム
JP6631745B1 (ja) リニアモータステージの制御方法及び制御装置
JP6886148B2 (ja) アクティブマスダンパおよびアクティブマスダンパの制御装置
KR101311790B1 (ko) 강성을 가지는 2차 기계 시스템을 위한 위치 제어 시스템, 방법, 및 상기 방법을 실행시키기 위한 컴퓨터 판독 가능한 프로그램을 기록한 매체
JP5870668B2 (ja) エネルギ評価制御方法及びエネルギ評価制御装置
Sievert et al. Numerical and Experimental Investigation of Time-Varying Vibration Control for Beam Subjected to Moving Masses
JP5862265B2 (ja) エネルギ評価制御方法及びエネルギ評価制御装置
JP5862264B2 (ja) エネルギ評価制御方法及びエネルギ評価制御装置
Vukosavic Digital Position Control

Legal Events

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

Ref document number: 12811162

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

WWE Wipo information: entry into national phase

Ref document number: 2012811162

Country of ref document: EP

WWE Wipo information: entry into national phase

Ref document number: 14232167

Country of ref document: US