JP2014128835A - Controller for power transmission device - Google Patents
Controller for power transmission device Download PDFInfo
- Publication number
- JP2014128835A JP2014128835A JP2012286343A JP2012286343A JP2014128835A JP 2014128835 A JP2014128835 A JP 2014128835A JP 2012286343 A JP2012286343 A JP 2012286343A JP 2012286343 A JP2012286343 A JP 2012286343A JP 2014128835 A JP2014128835 A JP 2014128835A
- Authority
- JP
- Japan
- Prior art keywords
- value
- characteristic coefficient
- variable component
- time constant
- power transmission
- Prior art date
- Legal status (The legal status 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 status listed.)
- Granted
Links
Images
Landscapes
- Manipulator (AREA)
Abstract
Description
本発明は、ロボットの関節等を駆動するための動力伝達装置の制御装置に関する。 The present invention relates to a control device for a power transmission device for driving a joint or the like of a robot.
産業用ロボットの関節等の動力伝達装置では、被動側要素(二次側要素)の変位量(回転角等)を目標値に制御する位置制御(サーボ制御)が従来より一般に行なわれている。また、その位置制御のための制御手法として、スライディングモード制御を採用すると共に、そのスライディングモード制御に用いる切換関数を、比例・積分制御の形式で決定するようにした技術が例えば特許文献1に提案されている。
In a power transmission device such as a joint of an industrial robot, position control (servo control) for controlling a displacement amount (rotation angle etc.) of a driven side element (secondary side element) to a target value is generally performed conventionally. Further, for example,
動力伝達装置における被動側要素の位置制御は、外界物の位置や形状、あるいは外乱等を事前に特定もしくは予測しておくことが困難となるような種々様々な外界環境下では柔軟性に乏しい。例えば、被動側要素が予期しない外界物に接触した場合等に、該被動側要素を適切に動かすことが困難となったり、あるいは、被動側要素に過大な外力が作用するような状況が発生しやすい。 The position control of the driven-side element in the power transmission device is poor in flexibility in various external environments where it is difficult to specify or predict the position and shape of external objects or disturbances in advance. For example, when the driven element comes into contact with an unexpected external object, it becomes difficult to move the driven element appropriately, or an excessive external force acts on the driven element. Cheap.
このため、近年は、種々様々な外界環境下で柔軟に動作し得るロボット等を実現するために、動力伝達装置の動力伝達経路中に、ばね部材等の弾性力発生機構を介して連結された一次側要素(駆動側要素)と二次側要素(被動側要素)とを備えておき、該一次側要素と二次側要素との間の相対変位に応じて弾性力発生機構が発生する弾性力によって二次側要素に付与される動力を目標値に制御するようにしたものが本願発明者等により研究されている。 For this reason, in recent years, in order to realize a robot or the like that can operate flexibly in various external environments, it has been connected to the power transmission path of the power transmission device via an elastic force generation mechanism such as a spring member. Elasticity generated by an elastic force generating mechanism according to relative displacement between the primary side element and the secondary side element, provided with a primary side element (drive side element) and a secondary side element (driven side element) The inventors of the present application have studied that the power applied to the secondary side element by the force is controlled to the target value.
このように一次側要素と二次側要素とを弾性力発生機構を介して連結した構造の動力伝達装置の動作制御(動力制御)においては、PD制御等の汎用的な制御手法では、負荷のイナーシャの変動等の種々様々な条件変動に対して、制御系の発振等を生じ難い安定した制御を行うことは一般には難しい。 In the operation control (power control) of the power transmission device having the structure in which the primary side element and the secondary side element are connected via the elastic force generation mechanism in this way, in a general control method such as PD control, In general, it is difficult to perform stable control that is unlikely to cause oscillation of the control system with respect to various condition fluctuations such as inertia fluctuations.
このため、本願発明者は、弾性変形部材を有する上記動力伝達装置の動作制御において、外乱の変動等に対してロバスト性が高いという特性を有するスライディングモード制御の手法を採用することを試みている。 For this reason, the inventor of the present application has attempted to adopt a sliding mode control method having a characteristic of high robustness against disturbance fluctuations or the like in the operation control of the power transmission device having an elastically deformable member. .
このスライディングモード制御は、切換関数により規定される切換超平面(切換関数=0という形式で表される超平面)にて、制御対象の状態量を目標値に収束させようとする制御手法である。 This sliding mode control is a control method for trying to converge the state quantity of the controlled object to the target value on the switching hyperplane (hyperplane expressed in the form of switching function = 0) defined by the switching function. .
なお、「超平面」というのは、複数次元の位相空間での平面を一般化した表現であり、二次元の位相空間では直線、三次元の位相空間では通常の平面を意味する。 The “hyperplane” is a generalized expression of a plane in a multi-dimensional phase space, and means a straight line in a two-dimensional phase space and a normal plane in a three-dimensional phase space.
ところで、上記のように、弾性力発生機構を備える動力伝達装置を、種々様々な環境下で作動し得るロボットの関節等に採用する上では、弾性力発生機構が、上記一次側要素と二次側要素との間に、当該両要素の間の相対速度に応じた粘性力を発生可能である共に、該相対速度の変化に対する粘性力の変化の比率を表す粘性特性係数(所謂、粘性係数)を可変的に設定可能であることが望ましいと考えられる。 By the way, as described above, when the power transmission device including the elastic force generation mechanism is employed in a joint of a robot that can be operated in various environments, the elastic force generation mechanism includes the primary element and the secondary element. Viscosity characteristic coefficient (so-called viscosity coefficient) representing the ratio of the change in the viscous force to the change in the relative speed, while being able to generate a viscous force according to the relative speed between the two elements between the side elements It is considered desirable to be able to set variably.
この場合、二次側要素に付与される動力をスライディングモード制御により目標値に制御するためには、該動力の値と、その時間的変化率とを逐次観測する必要がある。 In this case, in order to control the power applied to the secondary side element to the target value by the sliding mode control, it is necessary to sequentially observe the power value and its temporal change rate.
ここで、二次側要素に付与される動力は、基本的には、弾性力発生機構が発生する弾性力に起因する成分(以下、弾性力成分という)と、弾性力発生機構が発生する粘性力に起因する成分(以下、粘性力成分という)との総和となる。そして、弾性力成分は、一次側要素及び二次側要素の間の相対変位量に依存し、粘性力成分は、一次側要素及び二次側要素の間の相対速度(相対変位量の時間的変化率)に依存する。 Here, the power applied to the secondary element basically includes a component caused by the elastic force generated by the elastic force generation mechanism (hereinafter referred to as an elastic force component) and a viscosity generated by the elastic force generation mechanism. It is the sum total of components due to force (hereinafter referred to as viscous force components). The elastic force component depends on the relative displacement amount between the primary side element and the secondary side element, and the viscous force component is the relative velocity between the primary side element and the secondary side element (temporal relative displacement amount). Change rate).
従って、二次側要素に付与される動力の値を、一次側要素及び二次側要素の間の相対変位量の計測値から特定される弾性力成分と、該相対変位量の計測値の時間的変化率(微分値)から特定される粘性力成分の総和として計測し、さらに該動力の計測値の時間的変化率を、該動力の時間的変化率の計測値として算出することが考えられる。 Therefore, the value of the power applied to the secondary side element is determined by the elastic force component specified from the measured value of the relative displacement between the primary side element and the secondary side element, and the time of the measured value of the relative displacement. It is conceivable to measure the sum of the viscous force components specified from the dynamic change rate (differential value) and to calculate the temporal change rate of the measured power value as the measured value of the temporal change rate of the power. .
しかるに、一次側要素及び二次側要素の間の相対変位量の計測値の時間的変化率には、一般に、実際の相対変位量の時間的変化率(すなわち両要素間の実際の相対速度)に対して誤差が含まれやすく、また、その誤差のばらつきも生じやすい。 However, the temporal change rate of the measured value of the relative displacement amount between the primary side element and the secondary side element is generally the temporal change rate of the actual relative displacement amount (that is, the actual relative speed between the two elements). Errors are likely to be included, and variations in the errors are likely to occur.
このため、上記粘性力成分の値を、一次側要素及び二次側要素の間の相対変位量の計測値の時間的変化率から精度よく特定することは一般には難しい。さらに、このように、粘性力成分の値を精度よく特定することが困難であることから、二次側要素に付与される動力の時間的変化率の計測値を精度よく取得することも困難となる。 For this reason, it is generally difficult to accurately specify the value of the viscous force component from the temporal change rate of the measured value of the relative displacement amount between the primary side element and the secondary side element. Furthermore, since it is difficult to specify the value of the viscous force component with high accuracy in this way, it is difficult to accurately acquire the measurement value of the temporal change rate of the power applied to the secondary side element. Become.
従って、スライディングモード制御によって、二次側要素に付与される動力を目標値に制御するための制御入力を逐次決定しようとしても、その制御入力を決定するために必要となる計測値(特に二次側要素に付与される動力の時間的変化率の計測値)を精度よく取得することが困難となる。ひいては、スライディングモード制御によって決定される制御入力が、二次側要素に付与される実際の動力を制御する上で不適切なものとなる場合が頻繁に生じるようになって、当該制御のロバスト性を十分に高めることができない虞がある。 Therefore, even if it is attempted to sequentially determine the control input for controlling the power applied to the secondary side element to the target value by the sliding mode control, the measurement value (especially the secondary value) necessary for determining the control input is determined. It is difficult to accurately obtain a measurement value of a temporal change rate of power applied to the side element. As a result, the control input determined by the sliding mode control frequently becomes inappropriate for controlling the actual power applied to the secondary side element, and the robustness of the control is increased. May not be sufficiently increased.
本発明はかかる背景に鑑みてなされたものであり、一次側要素と二次側要素との間に弾性力に加えて、粘性力を発生可能な弾性力発生機構を備える動力伝達装置において、二次側要素に付与される動力を高いロバスト性で制御することができる制御装置を提供することを目的とする。 The present invention has been made in view of such a background. In a power transmission device including an elastic force generation mechanism capable of generating a viscous force in addition to an elastic force between a primary side element and a secondary side element, An object of the present invention is to provide a control device capable of controlling the power applied to the secondary element with high robustness.
本発明の動力伝達装置の制御装置は、かかる目的を達成するために、アクチュエータの駆動力により変位する一次側要素と、該一次側要素に対して相対変位可能に該一次側要素に弾性力発生機構を介して連結された二次側要素とを備え、該一次側要素及び二次側要素の間の相対変位に応じて当該両要素の間で前記弾性力発生機構により発生する弾性力によって、当該両要素の間の動力伝達を行うように構成された動力伝達装置において、前記動力伝達によって前記二次側要素に付与される動力である二次側動力を目標値に制御する制御装置であって、
前記弾性力発生機構は、前記一次側要素と二次側要素との間の相対速度に応じた粘性力を発生すると共に、当該両要素の間の相対速度の変化に対する前記粘性力の変化の比率を表す粘性特性係数を可変的に制御可能に構成されており、
前記一次側要素と前記二次側要素との間の相対変位量を計測し、該相対変位量の計測値と、該相対変位量の変化に対する前記弾性力発生機構の発生弾性力の変化の比率を表す剛性特性係数の値とから、該発生弾性力によって前記二次側要素に付与される前記二次側動力の計測値を取得する二次側動力計測手段と、
前記二次側動力の計測値と前記目標値との偏差を第1変数成分、該偏差の時間的変化率を第2変数成分として構成される切換関数を用いるスライディングモード制御の制御処理により、該切換関数により規定される切換超平面上で前記第1変数成分をゼロに収束させるように前記アクチュエータの駆動力を制御するための制御入力を逐次決定する制御入力決定手段と、
前記第1変数成分及び第2変数成分を2つの座標軸成分とする位相平面での前記切換超平面の傾きを、前記粘性特性係数の制御値に応じて変化させるように設定する切換超平面可変設定手段とを備え、
前記制御入力決定手段は、前記設定された傾きを有する前記切換超平面に対応する前記切換関数を用いて前記制御入力を決定するように構成されていることを特徴とする(第1発明)。
In order to achieve the above object, the control device for a power transmission device according to the present invention generates a primary side element that is displaced by a driving force of an actuator and generates an elastic force in the primary side element so as to be relatively displaceable with respect to the primary side element. A secondary element connected through a mechanism, and by an elastic force generated by the elastic force generation mechanism between the primary element and the secondary element according to the relative displacement between the primary element and the secondary element, In the power transmission device configured to transmit power between the two elements, the control device is configured to control the secondary power, which is the power applied to the secondary element by the power transmission, to a target value. And
The elastic force generation mechanism generates a viscous force according to a relative speed between the primary side element and the secondary side element, and a ratio of a change in the viscous force to a change in the relative speed between the two elements. The viscosity characteristic coefficient that represents is variably controllable,
The relative displacement amount between the primary side element and the secondary side element is measured, the measured value of the relative displacement amount, and the ratio of the change in the elastic force generated by the elastic force generation mechanism to the change in the relative displacement amount A secondary-side power measuring means for obtaining a measured value of the secondary-side power applied to the secondary-side element by the generated elastic force from the value of the stiffness characteristic coefficient representing
By control processing of sliding mode control using a switching function configured with a deviation between the measured value of the secondary power and the target value as a first variable component, and a temporal change rate of the deviation as a second variable component, Control input determining means for sequentially determining a control input for controlling the driving force of the actuator so that the first variable component converges to zero on a switching hyperplane defined by a switching function;
A switching hyperplane variable setting for setting the inclination of the switching hyperplane in a phase plane having the first variable component and the second variable component as two coordinate axis components according to the control value of the viscosity characteristic coefficient Means and
The control input determining means is configured to determine the control input using the switching function corresponding to the switching hyperplane having the set inclination (first invention).
かかる第1発明によれば、前記二次側動力計測手段が取得する計測値は、前記弾性力発生機構の発生弾性力によって前記二次側要素に付与される二次側動力の計測値であるので、該計測値には、弾性力発生機構が発生する粘性力に起因する成分は含まれていない。そして、該二次側動力の計測値は、前記一次側要素と前記二次側要素との間の相対変位量の計測値を用いて取得されるものであるから、弾性力発生機構の発生弾性力によって二次側要素に付与される実際の二次側動力の値としての信頼性が高いものとなる。 According to the first aspect of the invention, the measurement value acquired by the secondary power measurement unit is a measurement value of the secondary power applied to the secondary element by the elastic force generated by the elastic force generation mechanism. Therefore, the measurement value does not include a component due to the viscous force generated by the elastic force generation mechanism. And since the measured value of the secondary power is obtained using the measured value of the relative displacement amount between the primary side element and the secondary side element, the generated elasticity of the elastic force generating mechanism is obtained. The reliability as the actual value of the secondary power imparted to the secondary element by the force becomes high.
第1発明では、上記の如く二次側動力の計測値には、弾性力発生機構が発生する粘性力に起因する成分は含まれないので、弾性力発生機構が前記一次側要素及び二次側要素の間の相対速度に応じて粘性力を発生する状況では、二次側動力の計測値は、実際の二次側動力の値に対して誤差を有するものとなる。 In the first invention, since the measured value of the secondary side power does not include a component due to the viscous force generated by the elastic force generating mechanism as described above, the elastic force generating mechanism is not limited to the primary side element and the secondary side. In a situation where a viscous force is generated according to the relative speed between elements, the measured value of the secondary power has an error with respect to the actual value of the secondary power.
しかるに、第1発明では、前記切換超平面の傾きが、前記弾性力発生機構の粘性特性係数の制御値に応じて可変的に設定される。このため、前記弾性力発生機構が発生する粘性力の影響で、二次側動力の計測値が実際の値に対して過渡的に誤差を有するものとなっていても、前記制御入力決定手段は、当該誤差の影響を補償するように前記制御入力を決定できる。 However, in the first invention, the inclination of the switching hyperplane is variably set according to the control value of the viscosity characteristic coefficient of the elastic force generation mechanism. For this reason, even if the measured value of the secondary power has a transient error with respect to the actual value due to the influence of the viscous force generated by the elastic force generating mechanism, the control input determining means The control input can be determined so as to compensate for the influence of the error.
すなわち、前記第1変数成分や第2変数成分の値が過剰に変動したり振動したりすることを防止しつつ、安定した時定数で第1変数成分をゼロに収束させる(ひいては、二次側動力の計測値を前記目標値に収束させる)ようにすることができる。 That is, the first variable component is converged to zero with a stable time constant while preventing the first variable component and the second variable component from fluctuating excessively or oscillating. The power measurement value is converged to the target value).
よって、第1発明によれば、二次側要素に付与される動力を高いロバスト性で制御することができる。 Therefore, according to 1st invention, the motive power provided to a secondary side element can be controlled by high robustness.
なお、第1発明における粘性特性係数の制御値は、該粘性特性係数の制御により実現される値を意味し、その値としては例えば粘性特性係数の目標値を用いることができる。このことは、後述の他の発明においても同様である。 Note that the control value of the viscosity characteristic coefficient in the first invention means a value realized by controlling the viscosity characteristic coefficient, and for example, a target value of the viscosity characteristic coefficient can be used. The same applies to other inventions described later.
上記第1発明では、前記弾性力発生機構は、例えば前記剛性特性係数が一定値になるように構成される。この場合においては、前記切換超平面可変設定手段は、前記切換超平面上での前記第1変数成分のゼロへの収束の時定数として該切換超平面の傾きにより規定される切換超平面上収束時定数と、前記粘性特性係数との間の相関関係が次式(A)により表される関係になるように、前記粘性特性係数の制御値に応じて前記切換超平面の傾きを決定するように構成されていることが好ましい(第2発明)。 In the first aspect of the invention, the elastic force generation mechanism is configured such that, for example, the stiffness characteristic coefficient is a constant value. In this case, the switching hyperplane variable setting means converges on the switching hyperplane defined by the inclination of the switching hyperplane as a time constant of convergence of the first variable component to zero on the switching hyperplane. The inclination of the switching hyperplane is determined according to the control value of the viscosity characteristic coefficient so that the correlation between the time constant and the viscosity characteristic coefficient is represented by the following equation (A). It is preferable that it is comprised (2nd invention).
Tc=a+b・Kdp/Ksp ……(A)
ただし、
Tc:前記切換超平面上収束時定数
a,b:あらかじめ決定された定数値
Ksp:前記剛性特性係数の値
Kdp:前記粘性特性係数の値
すなわち、本願発明者の各種実験、検討によれば、前記弾性力発生機構の剛性特性係数の値が一定である場合、切換超平面の傾きにより規定される切換超平面上収束時定数と、前記粘性特性係数との間の相関関係が式(A)により表される関係になるように、前記粘性特性係数の制御値に応じて前記切換超平面の傾きを決定することで、二次側動力の計測値を安定に目標値に収束させることを好適に行うことができる。
Tc = a + b · Kdp / Ksp (A)
However,
Tc: convergence time constant on the switching hyperplane a, b: predetermined constant value Ksp: value of the stiffness characteristic coefficient Kdp: value of the viscosity characteristic coefficient
That is, according to various experiments and examinations of the present inventors, when the value of the stiffness characteristic coefficient of the elastic force generation mechanism is constant, the convergence time constant on the switching hyperplane defined by the inclination of the switching hyperplane, By determining the inclination of the switching hyperplane according to the control value of the viscosity characteristic coefficient so that the correlation between the viscosity characteristic coefficient is represented by the equation (A), the secondary power The measured value can be suitably converged to the target value.
また、第1発明において、前記弾性力発生機構は、前記粘性特性係数と前記剛性特性係数とをそれぞれ可変的に制御可能に構成されていてもよい。この場合にあっては、前記切換超平面可変設定手段は、前記切換超平面上での前記第1変数成分のゼロへの収束の時定数として該切換超平面の傾きにより規定される切換超平面上収束時定数と、前記粘性特性係数と、前記剛性特性係数との間の相関関係が次式(B)により表される関係になるように、前記粘性特性係数の制御値と前記剛性特性係数の制御値とに応じて前記切換超平面の傾きを決定するように構成されていることが好ましい(第3発明)。 In the first invention, the elastic force generation mechanism may be configured to variably control the viscosity characteristic coefficient and the rigidity characteristic coefficient. In this case, the switching hyperplane variable setting means includes a switching hyperplane defined by the inclination of the switching hyperplane as a time constant for convergence of the first variable component to zero on the switching hyperplane. The control value of the viscosity characteristic coefficient and the stiffness characteristic coefficient so that the correlation between the upper convergence time constant, the viscosity characteristic coefficient, and the stiffness characteristic coefficient is represented by the following equation (B): It is preferable that the inclination of the switching hyperplane is determined according to the control value (third invention).
Tc=(a2/sqrt(Ksp))+a1・Ksp+a0+b・Kdp/Ksp ……(B)
ただし、
Tc:前記切換超平面上収束時定数
a2,a1,a0,b:あらかじめ決定された定数値
Ksp:前記剛性特性係数の値
Kdp:前記粘性特性係数の値
すなわち、本願発明者の各種実験、検討によれば、前記弾性力発生機構の粘性特性係数と剛性特性係数とがそれぞれ可変的に制御される場合、切換超平面の傾きにより規定される切換超平面上収束時定数と、前記粘性特性係数と、前記剛性特性係数との間の相関関係が式(B)により表される関係になるように、前記粘性特性係数の制御値と前記剛性粘性係数の制御値とに応じて前記切換超平面の傾きを決定することで、二次側動力の計測値を安定に目標値に収束させることを好適に行うことができる。
Tc = (a2 / sqrt (Ksp)) + a1 * Ksp + a0 + b * Kdp / Ksp (B)
However,
Tc: convergence time constant on the switching hyperplane a2, a1, a0, b: constant values determined in advance Ksp: value of the stiffness characteristic coefficient Kdp: value of the viscosity characteristic coefficient
That is, according to various experiments and examinations by the inventors of the present application, when the viscosity characteristic coefficient and the rigidity characteristic coefficient of the elastic force generation mechanism are variably controlled, the switching hyperplane defined by the inclination of the switching hyperplane. The control value of the viscosity characteristic coefficient and the stiffness viscosity coefficient are set such that the correlation between the upper convergence time constant, the viscosity characteristic coefficient, and the stiffness characteristic coefficient is represented by the equation (B). By determining the inclination of the switching hyperplane according to the control value, it is possible to suitably converge the measured value of the secondary power to the target value.
なお、第3発明における剛性特性係数の制御値は、該剛性特性係数の制御により実現される値を意味し、その値としては例えば剛性特性係数の目標値を用いることができる。このことは、後述の他の発明においても同様である。 The control value of the stiffness characteristic coefficient in the third invention means a value realized by controlling the stiffness characteristic coefficient, and for example, a target value of the stiffness characteristic coefficient can be used. The same applies to other inventions described later.
上記第2発明又は第3発明では、前記制御入力決定手段は、より具体的には、例えば、前記切換超平面上で前記第1変数成分をゼロに収束させる機能を有する制御入力成分として次式(C)により算出される第1制御入力成分と、前記切換関数の値をゼロに収束させる機能を有する制御入力成分として該切換関数の値に応じて決定される第2制御入力成分とを合成してなる値を前記制御入力として決定するように構成される(第4発明)。 In the second invention or the third invention, more specifically, the control input determining means is, for example, the following expression as a control input component having a function of converging the first variable component to zero on the switching hyperplane: The first control input component calculated in (C) is combined with the second control input component determined according to the value of the switching function as a control input component having a function of converging the value of the switching function to zero. The value formed as described above is determined as the control input (fourth invention).
なお、本発明における動力伝達装置は、一次側要素と二次側要素との間で並進力を伝達する直動型の動力伝達装置(一次側要素と二次側要素との間の相対変位が直線的な変位となる動力伝達装置)と、一次側要素と二次側要素との間で回転力(トルク)を伝達する回転型の動力伝達装置(一次側要素と二次側要素との間の相対変位が回転変位となる動力伝達装置)とのいずれであってもよい。そして、上記Iinは、直動型の動力伝達装置では入力側慣性質量であり、回転型の動力伝達装置では入力側イナーシャである。、また、上記Ioutは、直動型の動力伝達装置では出力側慣性質量であり、回転型の動力伝達装置では出力側イナーシャである。これらのことは、後述の第14発明でも同様である。 The power transmission device according to the present invention is a linear motion type power transmission device that transmits a translational force between the primary side element and the secondary side element (the relative displacement between the primary side element and the secondary side element is A linear transmission power transmission device) and a rotary power transmission device that transmits rotational force (torque) between the primary and secondary elements (between the primary and secondary elements) The relative displacement of the power transmission device may be a rotational displacement. The Iin is the inertial mass on the input side in the direct acting power transmission device, and the inertia on the input side in the rotary power transmission device. In addition, the above-mentioned Iout is an output side inertial mass in the direct acting type power transmission device, and is an output side inertia in the rotary type power transmission device. The same applies to the 14th invention described later.
上記第4発明によれば、前記第1変数成分と第2変数成分との組が前記切換超平面上に達した後は、前記第1制御入力成分によって、安定に第1変数成分をゼロに収束させることができる。 According to the fourth aspect of the invention, after the set of the first variable component and the second variable component reaches the switching hyperplane, the first variable component is stably reduced to zero by the first control input component. It can be converged.
また、前記第1発明において、前記弾性力発生機構が、前記剛性特性係数が一定値になるように構成されている場合には、前記切換超平面可変設定手段は、前記切換超平面の傾きと、前記粘性特性係数の値との間の相関関係であって、前記粘性特性係数の複数の代表値と、該粘性特性係数の各代表値に対応してあらかじめ決定された前記切換超平面の傾きとに基づいてあらかじめ特定された相関関係に従って、前記粘性特性係数の制御値に応じて前記切換超平面の傾きを決定するように構成されており、
前記粘性特性係数の各代表値に対応する前記切換超平面の傾きは、前記弾性力発生機構の粘性特性係数を当該代表値に制御した状態で、前記第1変数成分を任意の値からゼロに収束させるときの該第1変数成分の値と前記第2変数成分の値と組の推移の軌跡を示すデータとしてあらかじめ取得された複数の応答特性データのうちの所定の要件を満たす特定の応答特性データに基づいて決定されており、
前記第1変数成分の値の大きさの許容限界値である第1許容限界値とゼロとの間で該第1許容限界値に応じて設定された第1設定値を前記位相平面において示すラインを第1設定値ライン、前記第2変数成分の値の大きさの許容限界値である第2許容限界値とゼロとの間で該第2許容限界値に応じて設定された第2設定値を前記位相平面において示すラインを第2設定値ラインと定義したとき、前記所定の要件を満たす特定の応答特性データは、該特定の応答特性データにより示される前記軌跡上での前記第1変数成分の値の大きさと前記第2変数成分の値の大きさとがそれぞれ前記第1許容限界値以下と第2許容限界値以下とに収まり、且つ、該軌跡が前記第1設定値ライン又は第2設定値ラインと交わるという要件を満たす応答特性データであり、
前記粘性特性係数の各代表値に対応する前記切換超平面の傾きは、前記位相平面において、前記特定の応答特性データのそれぞれにより示される前記軌跡と前記第1設定値ライン又は第2設定値ラインとの交点のうち、該交点と前記位相平面の原点とを結ぶライン上での前記第1変数成分のゼロへの収束の時定数が、あらかじめ定めた要求範囲内の値であるという制約条件を満たす交点と、該位相平面の原点とを結ぶラインの傾きに一致又は近似するように決定されていることが好ましい(第5発明)。
In the first invention, when the elastic force generation mechanism is configured such that the stiffness characteristic coefficient is a constant value, the switching hyperplane variable setting means is configured to determine the inclination of the switching hyperplane. A correlation between the viscosity characteristic coefficient values, a plurality of representative values of the viscosity characteristic coefficient, and a slope of the switching hyperplane determined in advance corresponding to each representative value of the viscosity characteristic coefficient According to the correlation specified in advance, and is configured to determine the inclination of the switching hyperplane according to the control value of the viscosity characteristic coefficient,
The inclination of the switching hyperplane corresponding to each representative value of the viscosity characteristic coefficient is such that the first variable component is changed from an arbitrary value to zero while the viscosity characteristic coefficient of the elastic force generation mechanism is controlled to the representative value. Specific response characteristics satisfying a predetermined requirement among a plurality of response characteristic data acquired in advance as data indicating a locus of transition of a set of the value of the first variable component and the value of the second variable component at the time of convergence Based on data,
A line indicating, on the phase plane, a first set value set according to the first allowable limit value between a first allowable limit value which is an allowable limit value of the magnitude of the value of the first variable component and zero. , A first set value line, a second set value set according to the second allowable limit value between zero and a second allowable limit value which is an allowable limit value of the value of the second variable component Is defined as a second set value line, the specific response characteristic data satisfying the predetermined requirement is the first variable component on the locus indicated by the specific response characteristic data. And the value of the second variable component fall within the first allowable limit value and the second allowable limit value, respectively, and the locus is the first set value line or the second set value. Response characteristic data that satisfies the requirement to cross the value line It is in,
The inclination of the switching hyperplane corresponding to each representative value of the viscosity characteristic coefficient is the locus indicated by each of the specific response characteristic data and the first set value line or the second set value line in the phase plane. The constraint that the time constant of convergence of the first variable component to zero on the line connecting the intersection and the origin of the phase plane is a value within a predetermined required range among It is preferable that it is determined so as to match or approximate the inclination of a line connecting the intersecting point and the origin of the phase plane (fifth invention).
上記第5発明によれば、前記切換超平面の傾きと、前記粘性特性係数との間の相関関係が前記粘性特性係数の複数の代表値と、該粘性特性係数の各代表値に対応してあらかじめ決定された前記切換超平面の傾きとに基づいてあらかじめ特定されている。 According to the fifth aspect, the correlation between the inclination of the switching hyperplane and the viscosity characteristic coefficient corresponds to a plurality of representative values of the viscosity characteristic coefficient and the representative values of the viscosity characteristic coefficient. It is specified in advance based on the inclination of the switching hyperplane determined in advance.
そして、この場合、粘性特性係数の各代表値に対応する切換超平面の傾きは、前記弾性力発生機構の粘性特性係数を該代表値に制御した状態であらかじめ取得された前記複数の応答特性データのうち、前記所定の要件を満たす特定の応答特性データに基づいて決定されている。 In this case, the inclination of the switching hyperplane corresponding to each representative value of the viscosity characteristic coefficient is the plurality of response characteristic data acquired in advance in a state where the viscosity characteristic coefficient of the elastic force generation mechanism is controlled to the representative value. Of these, it is determined based on specific response characteristic data satisfying the predetermined requirement.
従って、前記応答特性データのうち、該応答特性データにより示される前記軌跡上での前記第1変数成分の値の大きさが前記第1許容限界値を超えるような過大なものとなったり、あるいは、前記第2変数成分の値の大きさが前記第2許容限界値を超えてしまうような過大なものとなるような応答特性データは、粘性特性係数の各代表値に対応する切換超平面の傾きを決定するための特定の応答特性データとしては利用されない。 Accordingly, of the response characteristic data, the magnitude of the value of the first variable component on the locus indicated by the response characteristic data becomes excessively larger than the first allowable limit value, or The response characteristic data such that the magnitude of the value of the second variable component exceeds the second allowable limit value is the switching hyperplane corresponding to each representative value of the viscosity characteristic coefficient. It is not used as specific response characteristic data for determining the inclination.
また、前記応答特性データのうち、該応答特性データにより示される前記軌跡上での前記第1変数成分の値の大きさが、前記第1設定値よりも小さい大きさに保たれ、且つ、該軌跡上での前記第2変数成分の値の大きさが、前記第2設定値よりも小さい大きさに保たれるような応答特性データ、すなわち、該軌跡上の任意の点の第1変数成分及び第2変数成分の値の大きさが、いずれも小さ過ぎるような応答特性データは、粘性特性係数の各代表値に対応する切換超平面の傾きを決定するための特定の応答特性データとしては利用されない。 In the response characteristic data, the value of the first variable component on the locus indicated by the response characteristic data is kept smaller than the first set value, and the Response characteristic data in which the magnitude of the value of the second variable component on the locus is kept smaller than the second set value, that is, the first variable component at an arbitrary point on the locus The response characteristic data in which the values of the second variable component are both too small are specific response characteristic data for determining the inclination of the switching hyperplane corresponding to each representative value of the viscosity characteristic coefficient. Not used.
すなわち、前記軌跡上の点の第1変数成分の値の大きさが、前記第1許容限界値を超えるような過大なものとなったり、あるいは、該軌跡上の点の第2変数成分の値の大きさが、第2許容限界値を超えるような過大なものとなることがなく、しかも、第1変数成分の値の大きさが第1設定値以上の大きさ(小さすぎない大きさ)となるか、もしくは、第2変数成分の値の大きさが第2設定値以上の大きさ(小さすぎない大きさ)となるような点を軌跡上に含む応答特性データだけが、粘性特性係数の各代表値に対応する切換超平面の傾きを決定するための特定の応答特性データとして利用される。 That is, the magnitude of the value of the first variable component at the point on the trajectory exceeds the first allowable limit value, or the value of the second variable component at the point on the trajectory. The size of the first variable component does not become excessively large beyond the second allowable limit value, and the first variable component value is greater than or equal to the first set value (a size that is not too small). Or only the response characteristic data including a point on the trajectory where the magnitude of the value of the second variable component is greater than or equal to the second set value (a magnitude that is not too small). Are used as specific response characteristic data for determining the inclination of the switching hyperplane corresponding to each of the representative values.
従って、第1変数成分のゼロへの収束を良好に行い得るものとして信頼性の高い応答特性データを、粘性特性係数の各代表値に対応する切換超平面の傾きを決定するための特定の応答特性データとして用いることができる。 Therefore, the response characteristic data having high reliability is obtained as the first variable component can be favorably converged to zero, and the specific response for determining the inclination of the switching hyperplane corresponding to each representative value of the viscosity characteristic coefficient. It can be used as characteristic data.
そして、粘性特性係数の各代表値に対応する切換超平面の傾きは、前記位相平面において、前記特定の応答特性データのそれぞれにより示される前記軌跡と前記第1設定値ライン又は第2設定値ラインとの交点のうち、該交点と前記位相平面の原点とを結ぶライン上での前記第1変数成分のゼロへの収束の時定数が、あらかじめ定めた要求範囲内の値であるという制約条件を満たす交点と、該位相平面の原点とを結ぶラインの傾きに一致又は近似するように決定されている。 The inclination of the switching hyperplane corresponding to each representative value of the viscosity characteristic coefficient is the trajectory indicated by each of the specific response characteristic data and the first set value line or the second set value line in the phase plane. The constraint that the time constant of convergence of the first variable component to zero on the line connecting the intersection and the origin of the phase plane is a value within a predetermined required range among It is determined so as to coincide with or approximate the inclination of a line connecting the intersecting point and the origin of the phase plane.
この場合、上記交点は、第1変数成分の値が前記第1設定値に一致するか、又は第2変数成分の値が前記第2設定値に一致するような点であるから、第1変数成分の値の大きさ又は第2変数成分の値の大きさが、過大もしくは過小ではない適度な大きさとなるような点である。 In this case, the intersection point is a point at which the value of the first variable component matches the first set value or the value of the second variable component matches the second set value. It is a point that the magnitude of the component value or the magnitude of the value of the second variable component is an appropriate magnitude that is not too large or too small.
そして、このような交点のうち、該交点と前記位相平面の原点とを結ぶライン上での前記第1変数成分のゼロへの収束の時定数が、あらかじめ定めた要求範囲内の値であるという制約条件を満たす交点(以降、要求適合交点ということがある)を用いて、該要求適合交点と、位相平面の原点とを結ぶラインの傾きに一致又は近似するように、粘性特性係数の各代表値に対応する切換超平面の傾きが決定されている。 Of these intersections, the time constant for convergence of the first variable component to zero on the line connecting the intersection and the origin of the phase plane is a value within a predetermined required range. Using the intersection satisfying the constraint conditions (hereinafter sometimes referred to as the requirement-matching intersection), each representative of the viscosity characteristic coefficient is matched or approximated to the slope of the line connecting the requirement-matching intersection and the origin of the phase plane. The slope of the switching hyperplane corresponding to the value is determined.
このように粘性特性係数の各代表値に対応する切換超平面の傾きが決定されているので、取得した複数の応答特性データから、該切換超平面の傾きを決定することを効率よく容易に行なうことができる。 Thus, since the inclination of the switching hyperplane corresponding to each representative value of the viscosity characteristic coefficient is determined, it is possible to efficiently and easily determine the inclination of the switching hyperplane from a plurality of acquired response characteristic data. be able to.
この場合、応答特性データを取得するための制御手法は、特定の制御手法に限定されるものではないので、PD制御等の汎用的な制御手法を用いて容易に取得することができる。 In this case, the control method for acquiring the response characteristic data is not limited to a specific control method, and can be easily acquired using a general-purpose control method such as PD control.
さらに、粘性特性係数の各代表値に対応する切換超平面の傾きを、前記要求適合交点を用いて決定することは、例えば最小二乗法等の公知の統計的な同定手法によって行なうことができる。 Furthermore, the inclination of the switching hyperplane corresponding to each representative value of the viscosity characteristic coefficient can be determined by using the required fitting intersection, for example, by a known statistical identification method such as a least square method.
そして、第5発明では、粘性特性係数の複数の代表値と、その代表値のそれぞれに対応して上記の如く決定された切換超平面の傾きとに基づいて、切換超平面の傾きと、粘性特性係数との間の前記相関関係(制御入力決定手段が、粘性特性係数の制御値に応じて切換超平面の傾きを決定するために用いる相関関係)が特定されている。 In the fifth aspect of the invention, based on the plurality of representative values of the viscosity characteristic coefficient and the inclination of the switching hyperplane determined as described above corresponding to each of the representative values, the inclination of the switching hyperplane and the viscosity The correlation with the characteristic coefficient (correlation used by the control input determining means to determine the inclination of the switching hyperplane according to the control value of the viscosity characteristic coefficient) is specified.
このため、前記制御入力決定手段は、高いロバスト性と所望の収束特性とで、二次側動力の計測値を目標値に制御することができるように、スライディングモード制御の制御処理により前記制御入力を決定することができる。 For this reason, the control input determination means performs the control input by the control process of the sliding mode control so that the measured value of the secondary power can be controlled to the target value with high robustness and desired convergence characteristics. Can be determined.
なお、第5発明を前記第2発明又は第4発明と組み合わせてもよい。第5発明と第2発明とを組み合わせた場合には、前記相関関係は、前記式(A)により表されることとなる。この場合、粘性特性係数の複数の代表値と、その代表値のそれぞれに対応して上記の如く決定された切換超平面の傾きとに基づいて、最小二乗法等の統計的な同定手法によって、前記式(A)の変数a,bの値を特定することで、当該相関関係が決定されることとなる。 The fifth invention may be combined with the second invention or the fourth invention. When the fifth invention and the second invention are combined, the correlation is expressed by the formula (A). In this case, based on a plurality of representative values of the viscosity characteristic coefficient and the inclination of the switching hyperplane determined as described above corresponding to each of the representative values, by a statistical identification method such as the least square method, The correlation is determined by specifying the values of the variables a and b in the formula (A).
ただし、第5発明における相関関係は、例えば、粘性特性係数の複数の代表値と、その代表値のそれぞれに対応して上記の如く決定された切換超平面の傾きとをマップデータとして決定された相関関係であってもよい。 However, the correlation in the fifth invention is determined, for example, by using a plurality of representative values of the viscosity characteristic coefficient and the inclination of the switching hyperplane determined as described above corresponding to each of the representative values as map data. It may be a correlation.
上記第5発明では、前記第1許容限界値は、前記アクチュエータの駆動力による前記一次側要素の変位速度及び変位加速度がそれぞれあらかじめ定められた許容限界値を超えないように、該一次側要素の変位速度の許容限界値と該一次側要素の変位加速度の許容限界値と前記剛性特性係数の値とに応じて設定された値であることが好ましい(第6発明)。 In the fifth invention, the first permissible limit value is set so that the displacement speed and displacement acceleration of the primary side element due to the driving force of the actuator do not exceed predetermined permissible limit values, respectively. It is preferable that the value is set according to the allowable limit value of the displacement speed, the allowable limit value of the displacement acceleration of the primary side element, and the value of the stiffness characteristic coefficient (the sixth invention).
この第6発明によれば、粘性特性係数の各代表値毎に、前記複数の応答特性データのうち、前記一次側要素の変位速度及び変位加速度がそれぞれあらかじめ定められた許容限界値を超えることがないような応答特性データを用いて、粘性特性係数の各代表値に対応する切換超平面の傾きを決定できる。 According to the sixth aspect, for each representative value of the viscosity characteristic coefficient, the displacement speed and displacement acceleration of the primary element out of the plurality of response characteristic data exceed a predetermined allowable limit value. By using such response characteristic data, the inclination of the switching hyperplane corresponding to each representative value of the viscosity characteristic coefficient can be determined.
このため、前記動力伝達装置の動作制御時に、前記一次側要素の変位速度及び変位加速度がそれぞれあらかじめ定められた許容限界値を超えないように動力伝達装置を動作を制御することを、前記弾性力発生機構の粘性特性係数の制御状態によらずに、高い信頼性で行うようにすることができる。ひいては、前記弾性力発生機構の粘性特性係数の制御状態によらずに、前記一次側要素の変位速度あるいは変位加速度が許容限界値に近いものとなるような領域での動力伝達装置の動作を安定して行なうようにすることが可能となる。 Therefore, during the operation control of the power transmission device, the operation of the power transmission device is controlled so that the displacement speed and the displacement acceleration of the primary side element do not exceed predetermined allowable limit values, respectively. Regardless of the control state of the viscosity characteristic coefficient of the generating mechanism, it can be performed with high reliability. As a result, regardless of the control state of the viscosity characteristic coefficient of the elastic force generation mechanism, the operation of the power transmission device is stabilized in a region where the displacement speed or displacement acceleration of the primary element is close to the allowable limit value. It is possible to do so.
また、上記第5発明又は第6発明では、前記第2許容限界値は、前記アクチュエータから前記二次側要素に至る動力伝達系の固有振動に応じた該動力伝達系の振動の発生を防止するように、前記剛性特性係数の値に応じて設定された値であることが好ましい(第7発明)。 In the fifth or sixth aspect of the invention, the second allowable limit value prevents occurrence of vibration of the power transmission system according to the natural vibration of the power transmission system from the actuator to the secondary element. Thus, it is preferable that the value is set in accordance with the value of the rigidity characteristic coefficient (seventh invention).
この第7発明によれば、粘性特性係数の各代表値毎に、前記複数の応答特性データのうち、前記固有振動に応じた動力伝達系の振動が発生しないような応答特性データを用いて、前記粘性特性係数の各代表値に対応する切換超平面の傾きを決定できる。 According to the seventh aspect of the present invention, for each representative value of the viscosity characteristic coefficient, out of the plurality of response characteristic data, using response characteristic data that does not generate vibration of the power transmission system according to the natural vibration, The inclination of the switching hyperplane corresponding to each representative value of the viscosity characteristic coefficient can be determined.
このため、前記弾性力発生機構の粘性特性係数の制御状態によらずに、前記固有振動に応じた動力伝達系の振動が生じないか、もしくは生じ難いものとなるように動力伝達装置を動作を制御することを高い信頼性で行うようにすることができる。 For this reason, the power transmission device is operated so that the vibration of the power transmission system according to the natural vibration does not occur or hardly occurs regardless of the control state of the viscosity characteristic coefficient of the elastic force generation mechanism. Control can be performed with high reliability.
また、前記第1発明において、前記弾性力発生機構が、前記粘性特性係数と前記剛性特性係数とをそれぞれ可変的に制御可能に構成されている場合には、前記切換超平面可変設定手段は、前記切換超平面の傾きと、前記粘性特性係数と、前記剛性特性係数との間の相関関係であって、前記粘性特性係数の複数の代表値と、前記剛性特性係数の複数の代表値と、該粘性特性係数及び剛性特性係数の各代表値の組のそれぞれに対応してあらかじめ決定された前記切換超平面の傾きとに基づいてあらかじめ決定された相関関係に従って、前記粘性特性係数の制御値と、前記剛性特性係数の制御値とに応じて前記切換超平面の傾きを決定するように構成されており、
前記粘性特性係数及び剛性特性係数の各代表値の組のそれぞれに対応する前記切換超平面の傾きは、前記弾性力発生機構の粘性特性係数及び剛性特性係数をそれぞれ当該代表値に制御した状態で、前記第1変数成分を任意の値からゼロに収束させるときの該第1変数成分の値と前記第2変数成分の値と組の推移の軌跡を示すデータとしてあらかじめ取得された複数の応答特性データのうちの所定の要件を満たす特定の応答特性データに基づいて決定されており、
前記第1変数成分の値の大きさの許容限界値である第1許容限界値とゼロとの間で該第1許容限界値に応じて設定された第1設定値を前記位相平面において示すラインを第1設定値ライン、前記第2変数成分の値の大きさの許容限界値である第2許容限界値とゼロとの間で該第2許容限界値に応じて設定された第2設定値を前記位相平面において示すラインを第2設定値ラインと定義したとき、前記所定の要件を満たす特定の応答特性データは、該特定の応答特性データにより示される前記軌跡上での前記第1変数成分の値の大きさと前記第2変数成分の値の大きさとがそれぞれ前記第1許容限界値以下と第2許容限界値以下とに収まり、且つ、該軌跡が前記第1設定値ライン又は第2設定値ラインと交わるという要件を満たす応答特性データであり、
前記粘性特性係数及び剛性特性係数の各代表値の組のそれぞれに対応する前記切換超平面の傾きは、前記位相平面において、前記特定の応答特性データのそれぞれにより示される前記軌跡と前記第1設定値ライン又は第2設定値ラインとの交点のうち、該交点と前記位相平面の原点とを結ぶライン上での前記第1変数成分のゼロへの収束の時定数が、あらかじめ定めた要求範囲内の値であるという制約条件を満たす交点と、該位相平面の原点とを結ぶラインの傾きに一致又は近似するように決定されていることが好ましい(第8発明)。
In the first invention, when the elastic force generation mechanism is configured to be able to variably control the viscosity characteristic coefficient and the rigidity characteristic coefficient, the switching hyperplane variable setting means includes: A correlation between the inclination of the switching hyperplane, the viscosity characteristic coefficient, and the stiffness characteristic coefficient, wherein a plurality of representative values of the viscosity characteristic coefficient, a plurality of representative values of the stiffness characteristic coefficient, A control value of the viscosity characteristic coefficient according to a correlation determined in advance based on a slope of the switching hyperplane determined in advance corresponding to each of the representative value sets of the viscosity characteristic coefficient and the rigidity characteristic coefficient; The inclination of the switching hyperplane is determined according to the control value of the stiffness characteristic coefficient,
The inclination of the switching hyperplane corresponding to each set of representative values of the viscosity characteristic coefficient and the rigidity characteristic coefficient is in a state where the viscosity characteristic coefficient and the rigidity characteristic coefficient of the elastic force generation mechanism are controlled to the representative values, respectively. , A plurality of response characteristics acquired in advance as data indicating a locus of transition of a set of the value of the first variable component and the value of the second variable component when the first variable component is converged from an arbitrary value to zero Determined based on specific response characteristics data that meets certain requirements of the data,
A line indicating, on the phase plane, a first set value set according to the first allowable limit value between a first allowable limit value which is an allowable limit value of the magnitude of the value of the first variable component and zero. , A first set value line, a second set value set according to the second allowable limit value between zero and a second allowable limit value which is an allowable limit value of the value of the second variable component Is defined as a second set value line, the specific response characteristic data satisfying the predetermined requirement is the first variable component on the locus indicated by the specific response characteristic data. And the value of the second variable component fall within the first allowable limit value and the second allowable limit value, respectively, and the locus is the first set value line or the second set value. Response characteristic data that satisfies the requirement to cross the value line It is in,
The inclination of the switching hyperplane corresponding to each set of representative values of the viscosity characteristic coefficient and the rigidity characteristic coefficient is the trajectory indicated by each of the specific response characteristic data and the first setting on the phase plane. Among the intersections with the value line or the second set value line, the time constant for convergence of the first variable component to zero on the line connecting the intersection and the origin of the phase plane is within a predetermined required range. Preferably, it is determined so as to coincide with or approximate the inclination of a line connecting the intersection satisfying the constraint condition of the value and the origin of the phase plane (eighth invention).
上記第8発明によれば、前記切換超平面の傾きと、前記粘性特性係数と、前記剛性特性係数との間の相関関係が前記粘性特性係数の複数の代表値と、前記剛性特性係数の複数の代表値と、該粘性特性係数及び剛性特性係数の各代表値の組のそれぞれに対応してあらかじめ決定された前記切換超平面の傾きとに基づいてあらかじめ特定されている。 According to the eighth aspect of the present invention, the correlation among the inclination of the switching hyperplane, the viscosity characteristic coefficient, and the rigidity characteristic coefficient includes a plurality of representative values of the viscosity characteristic coefficient, and a plurality of rigidity characteristic coefficients. And a slope of the switching hyperplane determined in advance corresponding to each set of representative values of the viscosity characteristic coefficient and the rigidity characteristic coefficient.
そして、この場合、粘性特性係数及び剛性特性係数の各代表値の組のそれぞれに対応する切換超平面の傾きは、前記弾性力発生機構の粘性特性係数と剛性特性係数とを当該代表値(任意の一つの組の代表値)に制御した状態であらかじめ取得された前記複数の応答特性データのうち、前記所定の要件を満たす特定の応答特性データに基づいて決定されている。 In this case, the inclination of the switching hyperplane corresponding to each set of representative values of the viscosity characteristic coefficient and the rigidity characteristic coefficient is determined by changing the viscosity characteristic coefficient and the rigidity characteristic coefficient of the elastic force generation mechanism to the representative value (arbitrary value) In this case, it is determined based on specific response characteristic data satisfying the predetermined requirement among the plurality of response characteristic data acquired in advance in a controlled state.
従って、前記第5発明の場合と同様に、前記応答特性データのうち、該応答特性データにより示される前記軌跡上での前記第1変数成分の値の大きさが前記第1許容限界値を超えるような過大なものとなったり、あるいは、前記第2変数成分の値の大きさが前記第2許容限界値を超えてしまうような過大なものとなるような応答特性データは、粘性特性係数及び剛性特性係数の各代表値の組のそれぞれに対応する切換超平面の傾きを決定するための特定の応答特性データとしては利用されない。 Accordingly, as in the case of the fifth invention, the magnitude of the value of the first variable component on the locus indicated by the response characteristic data exceeds the first allowable limit value in the response characteristic data. The response characteristic data that is excessively large such that the magnitude of the value of the second variable component exceeds the second allowable limit value is the viscosity characteristic coefficient and It is not used as specific response characteristic data for determining the inclination of the switching hyperplane corresponding to each set of representative values of the stiffness characteristic coefficient.
また、前記応答特性データのうち、該応答特性データにより示される前記軌跡上での前記第1変数成分の値の大きさが、前記第1設定値よりも小さい大きさに保たれ、且つ、該軌跡上での前記第2変数成分の値の大きさが、前記第2設定値よりも小さい大きさに保たれるような応答特性データ、すなわち、該軌跡上の任意の点の第1変数成分及び第2変数成分の値の大きさが、いずれも小さ過ぎるような応答特性データは、粘性特性係数及び剛性特性係数の各代表値の組のそれぞれに対応する切換超平面の傾きを決定するための特定の応答特性データとしては利用されない。 In the response characteristic data, the value of the first variable component on the locus indicated by the response characteristic data is kept smaller than the first set value, and the Response characteristic data in which the magnitude of the value of the second variable component on the locus is kept smaller than the second set value, that is, the first variable component at an arbitrary point on the locus The response characteristic data whose magnitudes of the second variable component and the second variable component are both too small determine the inclination of the switching hyperplane corresponding to each of the representative value pairs of the viscosity characteristic coefficient and the rigidity characteristic coefficient. It is not used as specific response characteristic data.
すなわち、前記第5発明の場合と同様に、前記軌跡上の点の第1変数成分の値の大きさが、前記第1許容限界値を超えるような過大なものとなったり、あるいは、該軌跡上の点の第2変数成分の値の大きさが、第2許容限界値を超えるような過大なものとなることがなく、しかも、第1変数成分の値の大きさが第1設定値以上の大きさ(小さすぎない大きさ)となるか、もしくは、第2変数成分の値の大きさが第2設定値以上の大きさ(小さすぎない大きさ)となるような点を軌跡上に含む応答特性データだけが、粘性特性係数及び剛性特性係数の各代表値の組のそれぞれに対応する切換超平面の傾きを決定するための特定の応答特性データとして利用される。 That is, as in the case of the fifth invention, the magnitude of the value of the first variable component at the point on the trajectory exceeds the first allowable limit value, or the trajectory The magnitude of the value of the second variable component at the upper point does not become excessive so as to exceed the second allowable limit value, and the magnitude of the value of the first variable component is not less than the first set value. Or a point on the locus where the value of the second variable component is not less than the second set value (not too small). Only the response characteristic data that is included is used as specific response characteristic data for determining the inclination of the switching hyperplane corresponding to each of the sets of representative values of the viscosity characteristic coefficient and the stiffness characteristic coefficient.
従って、第1変数成分のゼロへの収束を良好に行い得るものとして信頼性の高い応答特性データを、粘性特性係数及び剛性特性係数の各代表値の組のそれぞれに対応する切換超平面の傾きを決定するための特定の応答特性データとして用いることができる。 Accordingly, since the first variable component can be favorably converged to zero, highly reliable response characteristic data is obtained from the inclination of the switching hyperplane corresponding to each of the representative values of the viscosity characteristic coefficient and the rigidity characteristic coefficient. Can be used as specific response characteristic data for determining.
そして、粘性特性係数及び剛性特性係数の各代表値の組のそれぞれに対応する切換超平面の傾きは、前記位相平面において、前記特定の応答特性データのそれぞれにより示される前記軌跡と前記第1設定値ライン又は第2設定値ラインとの交点のうち、該交点と前記位相平面の原点とを結ぶライン上での前記第1変数成分のゼロへの収束の時定数が、あらかじめ定めた要求範囲内の値であるという制約条件を満たす交点と、該位相平面の原点とを結ぶラインの傾きに一致又は近似するように決定されている。 The inclination of the switching hyperplane corresponding to each of the representative value pairs of the viscosity characteristic coefficient and the rigidity characteristic coefficient is the trajectory indicated by each of the specific response characteristic data and the first setting on the phase plane. Among the intersections with the value line or the second set value line, the time constant for convergence of the first variable component to zero on the line connecting the intersection and the origin of the phase plane is within a predetermined required range. It is determined so as to match or approximate the inclination of a line connecting the intersection satisfying the constraint condition that is the value of and the origin of the phase plane.
この場合、上記交点は、第1変数成分の値が前記第1設定値に一致するか、又は第2変数成分の値が前記第2設定値に一致するような点であるから、第1変数成分の値の大きさ又は第2変数成分の値の大きさが、過大もしくは過小ではない適度な大きさとなるような点である。 In this case, the intersection point is a point at which the value of the first variable component matches the first set value or the value of the second variable component matches the second set value. It is a point that the magnitude of the component value or the magnitude of the value of the second variable component is an appropriate magnitude that is not too large or too small.
そして、このような交点のうち、該交点と前記位相平面の原点とを結ぶライン上での前記第1変数成分のゼロへの収束の時定数が、あらかじめ定めた要求範囲内の値であるという制約条件を満たす交点(すなわち、前記要求適合交点)を用いて、該要求適合交点と、位相平面の原点とを結ぶラインの傾きに一致又は近似するように、粘性特性係数及び剛性特性係数の各代表値の組のそれぞれに対応する切換超平面の傾きが決定されている。 Of these intersections, the time constant for convergence of the first variable component to zero on the line connecting the intersection and the origin of the phase plane is a value within a predetermined required range. Using the intersection satisfying the constraint condition (that is, the requirement adaptation intersection), each of the viscosity characteristic coefficient and the stiffness characteristic coefficient is matched or approximated to the slope of the line connecting the requirement adaptation intersection and the origin of the phase plane. The slope of the switching hyperplane corresponding to each of the representative value sets is determined.
このように粘性特性係数及び剛性特性係数の各代表値の組のそれぞれに対応する切換超平面の傾きが決定されているので、取得した複数の応答特性データから、該切換超平面の傾きを決定することを効率よく容易に行なうことができる。 In this way, since the inclination of the switching hyperplane corresponding to each of the representative values of the viscosity characteristic coefficient and the stiffness characteristic coefficient is determined, the inclination of the switching hyperplane is determined from a plurality of acquired response characteristic data. Can be done efficiently and easily.
この場合、応答特性データを取得するための制御手法は、特定の制御手法に限定されるものではないので、PD制御等の汎用的な制御手法を用いて容易に取得することができる。 In this case, the control method for acquiring the response characteristic data is not limited to a specific control method, and can be easily acquired using a general-purpose control method such as PD control.
さらに、粘性特性係数及び剛性特性係数の各代表値の組のそれぞれに対応する切換超平面の傾きを、前記要求適合交点を用いて決定することは、例えば最小二乗法等の公知の統計的な同定手法によって行なうことができる。 Further, determining the inclination of the switching hyperplane corresponding to each of the representative value pairs of the viscosity characteristic coefficient and the stiffness characteristic coefficient using the required fitting intersection is, for example, a known statistical method such as a least square method. This can be done by an identification technique.
そして、第8発明では、粘性特性係数の複数の代表値と、剛性特性係数の複数の代表値と、それらの代表値の組のそれぞれに対応して上記の如く決定された切換超平面の傾きとに基づいて、切換超平面の傾きと、粘性特性係数と、剛性特性係数との間の前記相関関係(制御入力決定手段が、粘性特性係数の制御値と剛性特性係数の制御値とに応じて切換超平面の傾きを決定するために用いる相関関係)が特定されている。 In the eighth invention, the inclination of the switching hyperplane determined as described above corresponding to each of a plurality of representative values of the viscosity characteristic coefficient, a plurality of representative values of the stiffness characteristic coefficient, and a set of these representative values. Based on the above, the correlation between the inclination of the switching hyperplane, the viscosity characteristic coefficient, and the stiffness characteristic coefficient (the control input determining means depends on the control value of the viscosity characteristic coefficient and the control value of the stiffness characteristic coefficient). The correlation used to determine the slope of the switching hyperplane.
このため、前記制御入力決定手段は、高いロバスト性と所望の収束特性とで、二次側動力の計測値を目標値に制御することができるように、スライディングモード制御の制御処理により前記制御入力を決定することができる。 For this reason, the control input determination means performs the control input by the control process of the sliding mode control so that the measured value of the secondary power can be controlled to the target value with high robustness and desired convergence characteristics. Can be determined.
なお、第8発明を前記第3発明又は第4発明と組み合わせてもよい。第8発明と第3発明とを組み合わせた場合には、前記相関関係は、前記式(B)により表されることとなる。この場合、剛性特性係数の複数の代表値と、それらの代表値の組のそれぞれに対応して上記の如く決定された切換超平面の傾きとに基づいて、最小二乗法等の統計的な同定手法によって、前記式(B)の変数a2、a1,a0,bの値を特定することで、当該相関関係が決定されることとなる。 The eighth invention may be combined with the third invention or the fourth invention. When the eighth invention and the third invention are combined, the correlation is represented by the formula (B). In this case, statistical identification such as the least square method is performed based on a plurality of representative values of the stiffness characteristic coefficient and the inclination of the switching hyperplane determined as described above corresponding to each of the representative value sets. The correlation is determined by specifying the values of the variables a2, a1, a0, b in the formula (B) by the method.
ただし、第8発明における相関関係は、例えば、粘性特性係数の複数の代表値と、剛性特性係数の複数の代表値と、それらの代表値の組のそれぞれに対応して上記の如く決定された切換超平面の傾きとをマップデータとして決定された相関関係であってもよい。 However, the correlation in the eighth invention is determined as described above, for example, corresponding to each of a plurality of representative values of the viscosity characteristic coefficient, a plurality of representative values of the rigidity characteristic coefficient, and a set of these representative values. The correlation determined by using the inclination of the switching hyperplane as map data may be used.
上記第8発明では、前記第1許容限界値は、前記剛性特性係数の各代表値に対応して設定される値であり、該剛性特性係数の各代表値に対応する前記第1許容限界値は、前記弾性力発生機構の剛性特性係数を当該代表値に制御した状態で、前記アクチュエータの駆動力による前記一次側要素の変位速度及び変位加速度がそれぞれあらかじめ定められた許容限界値を超えないように、該一次側要素の変位速度の許容限界値と該一次側要素の変位加速度の許容限界値と前記剛性特性係数の当該代表値とに応じて設定された値であることが好ましい(第9発明)。 In the eighth aspect of the invention, the first allowable limit value is a value set corresponding to each representative value of the rigidity characteristic coefficient, and the first allowable limit value corresponding to each representative value of the rigidity characteristic coefficient. In a state where the stiffness characteristic coefficient of the elastic force generation mechanism is controlled to the representative value, the displacement speed and displacement acceleration of the primary element due to the driving force of the actuator do not exceed predetermined allowable limit values, respectively. Further, it is preferable that the value is set according to the allowable limit value of the displacement speed of the primary side element, the allowable limit value of the displacement acceleration of the primary side element, and the representative value of the stiffness characteristic coefficient (the ninth). invention).
この第9発明によれば、前記粘性特性係数及び剛性特性係数の各代表値の組のそれぞれ毎に、前記複数の応答特性データのうち、前記一次側要素の変位速度及び変位加速度がそれぞれあらかじめ定められた許容限界値を超えることがないような応答特性データを用いて、前記切換超平面の傾きを決定できる。 According to the ninth aspect of the present invention, the displacement speed and the displacement acceleration of the primary side element of the plurality of response characteristic data are respectively determined in advance for each set of representative values of the viscosity characteristic coefficient and the rigidity characteristic coefficient. The inclination of the switching hyperplane can be determined using response characteristic data that does not exceed the allowable limit value.
このため、前記動力伝達装置の動作制御時に、前記一次側要素の変位速度及び変位加速度がそれぞれあらかじめ定められた許容限界値を超えないように動力伝達装置を動作を制御することを、前記弾性力発生機構の粘性特性係数及び剛性特性係数の制御状態によらずに、高い信頼性で行うようにすることができる。ひいては、前記弾性力発生機構の粘性特性係数及び剛性特性係数の制御状態によらずに、前記一次側要素の変位速度あるいは変位加速度が許容限界値に近いものとなるような領域での動力伝達装置の動作を安定して行なうようにすることが可能となる。 Therefore, during the operation control of the power transmission device, the operation of the power transmission device is controlled so that the displacement speed and the displacement acceleration of the primary side element do not exceed predetermined allowable limit values, respectively. Regardless of the control state of the viscosity characteristic coefficient and the rigidity characteristic coefficient of the generating mechanism, it can be performed with high reliability. As a result, the power transmission device in a region where the displacement speed or displacement acceleration of the primary side element is close to the allowable limit value regardless of the control state of the viscosity characteristic coefficient and the rigidity characteristic coefficient of the elastic force generation mechanism. It is possible to perform the operation in a stable manner.
また、上記第8発明又は第9発明では、前記第2許容限界値は、前記剛性特性係数の各代表値に対応して設定される値であり、該剛性特性係数の各代表値に対応する前記第2許容限界値は、前記弾性力発生機構の剛性特性係数を当該代表値に制御した状態で、前記アクチュエータから前記二次側要素に至る動力伝達系の固有振動に応じた該動力伝達系の振動の発生を防止するように、前記剛性特性係数の当該代表値に応じて決定された値であることが好ましい(第10発明)。 In the eighth or ninth invention, the second allowable limit value is a value set corresponding to each representative value of the stiffness characteristic coefficient, and corresponds to each representative value of the stiffness characteristic coefficient. The second permissible limit value is the power transmission system corresponding to the natural vibration of the power transmission system from the actuator to the secondary element in a state where the stiffness characteristic coefficient of the elastic force generation mechanism is controlled to the representative value. It is preferable that the value is determined in accordance with the representative value of the stiffness characteristic coefficient so as to prevent the occurrence of vibration (tenth invention).
この第10発明によれば、、前記粘性特性係数及び剛性特性係数の各代表値の組のそれぞれ毎に、前記複数の応答特性データのうち、前記固有振動に応じた動力伝達系の振動が発生しないような応答特性データを用いて、前記粘性特性係数及び剛性特性係数の各代表値の組のそれぞれに対応する切換超平面の傾きを決定できる。 According to the tenth aspect, vibration of the power transmission system corresponding to the natural vibration is generated among the plurality of response characteristic data for each set of representative values of the viscosity characteristic coefficient and the rigidity characteristic coefficient. By using such response characteristic data, the inclination of the switching hyperplane corresponding to each set of representative values of the viscosity characteristic coefficient and the rigidity characteristic coefficient can be determined.
このため、前記弾性力発生機構の粘性特性係数及び剛性特性係数の制御状態によらずに、前記固有振動に応じた動力伝達系の振動が生じないか、もしくは生じ難いものとなるように動力伝達装置を動作を制御することを高い信頼性で行うようにすることができる。 Therefore, regardless of the control state of the viscosity characteristic coefficient and the rigidity characteristic coefficient of the elastic force generation mechanism, the power transmission system is designed so that the vibration of the power transmission system according to the natural vibration does not occur or hardly occurs. It is possible to control the operation of the apparatus with high reliability.
また、前記第5〜第10発明では、前記第1変数成分の値をゼロから前記第1許容限界値までステップ状に変化させると共に該第1変数成分の値のゼロへの収束を前記アクチュエータの駆動力による前記一次側要素の変位加速度が該変位加速度の許容限界値になるように行なったと仮定した場合に実現される時定数を特定時定数と定義しとき、前記制約条件は、前記第1変数成分のゼロへの収束の時定数を、前記特定時定数以上の範囲の値に制限する条件であることが好ましい(第11発明)。 In the fifth to tenth inventions, the value of the first variable component is changed stepwise from zero to the first allowable limit value, and the convergence of the value of the first variable component to zero is controlled by the actuator. When the time constant realized when it is assumed that the displacement acceleration of the primary side element due to the driving force is set to the allowable limit value of the displacement acceleration is defined as the specific time constant, the constraint condition is the first condition. It is preferable that the time constant for the convergence of the variable component to zero is a condition that limits the time constant to a value in the range equal to or greater than the specific time constant (11th invention).
すなわち、前記第1変数成分の値をゼロから、第1許容限界値以下のある値にステップ状に変化させることを想定した場合、第1変数成分の値をゼロから第1許容限界値まで変化させる場合に、前記一次側要素と二次側要素との間の相対変位量が最大となる。 That is, when it is assumed that the value of the first variable component is changed stepwise from zero to a certain value not more than the first allowable limit value, the value of the first variable component is changed from zero to the first allowable limit value. In this case, the relative displacement amount between the primary side element and the secondary side element is maximized.
この場合、二次側要素に対する一次側要素の変位は、許容限界値以下の変位加速度での変位に制限されるので、第1変数成分の値のゼロへの収束の時定数は、前記特定時定数よりも小さくなることはできない。 In this case, since the displacement of the primary side element with respect to the secondary side element is limited to the displacement at the displacement acceleration equal to or less than the allowable limit value, the time constant for convergence of the value of the first variable component to zero is the specified time. It cannot be smaller than a constant.
そこで、第11発明では、前記要求適合交点を規定する前記制約条件を、前記第1変数成分のゼロへの収束の時定数を前記特定時定数以上の範囲の値に制限する条件となるように設定した。 Accordingly, in the eleventh aspect of the invention, the constraint condition that defines the requirement-matching intersection is a condition that limits the time constant of convergence of the first variable component to zero to a value in a range greater than or equal to the specific time constant. Set.
従って、第11発明によれば、動力伝達装置の動作制御時に、該動力伝達装置の幅広い動作領域で、二次側動力を目標値に制御することを高いロバスト性で安定に行なうことができる。 Therefore, according to the eleventh aspect, at the time of controlling the operation of the power transmission device, it is possible to stably control the secondary power to the target value in a wide range of operation of the power transmission device with high robustness.
また、前記第1〜第11発明では、前記二次側動力の計測値と該二次側動力の目標値とから算出される前記第1変数成分の値である第1変数成分計測値と、該第1変数成分計測値の時間的変化率として算出される前記第2変数成分の値である第2変数成分計測値とから外乱による影響を低減してなる前記第1変数成分の推定値と前記第2変数成分の推定値とを逐次算出するオブザーバをさらに備えており、前記制御入力決定手段は、前記第1変数成分計測値と前記第2変数成分計測値との代わりに、前記オブザーバにより算出された前記第1変数成分の推定値と第2変数成分の推定値とを用いて前記切換関数の値を算出しつつ、該切換関数の値を用いて前記制御入力を逐次生成するように構成されていることが好ましい(第12発明)。 In the first to eleventh aspects of the invention, a first variable component measurement value that is a value of the first variable component calculated from the measurement value of the secondary power and the target value of the secondary power; An estimated value of the first variable component obtained by reducing the influence of disturbance from a second variable component measured value that is a value of the second variable component calculated as a rate of temporal change of the first variable component measured value; The observer further includes an observer that sequentially calculates the estimated value of the second variable component, and the control input determining means uses the observer instead of the first variable component measured value and the second variable component measured value. While calculating the value of the switching function using the calculated estimated value of the first variable component and the estimated value of the second variable component, the control input is sequentially generated using the value of the switching function. It is preferable to be configured (the twelfth invention).
この第12発明によれば、前記オブザーバにより算出された前記第1変数成分の推定値と第2変数成分の推定値とを用いて前記切換関数の値を算出しつつ、該切換関数の値を用いてスライディングモード制御の制御処理により前記制御入力を逐次生成することにより、外乱の影響が抑制される。 According to this twelfth aspect, the value of the switching function is calculated while calculating the value of the switching function using the estimated value of the first variable component and the estimated value of the second variable component calculated by the observer. By using the control input of the sliding mode control to sequentially generate the control input, the influence of disturbance is suppressed.
このため、制御入力決定手段により逐次決定される制御入力の安定性が高まる。ひいては、二次側動力の制御のロバスト性をより一層高めることができる。 For this reason, the stability of the control input sequentially determined by the control input determining means is increased. As a result, the robustness of the control of the secondary power can be further enhanced.
本発明の動力伝達装置の制御装置は、前記第1〜第11発明の形態に限らず、以下の形態を採用してもよい。 The control device for the power transmission device of the present invention is not limited to the first to eleventh aspects, and may employ the following aspects.
すなわち、本発明の動力伝達装置の制御装置は、前記の目的を達成するために、アクチュエータの駆動力により変位する一次側要素と、該一次側要素に対して相対変位可能に該一次側要素に弾性力発生機構を介して連結された二次側要素とを備え、該一次側要素及び二次側要素の間の相対変位に応じて当該両要素の間で前記弾性力発生機構により発生する弾性力によって、当該両要素の間の動力伝達を行うように構成された動力伝達装置において、前記動力伝達によって前記二次側要素に付与される動力である二次側動力を目標値に制御する制御装置であって、
前記弾性力発生機構は、前記一次側要素と二次側要素との間の相対速度に応じた粘性力を発生すると共に、当該両要素の間の相対速度の変化に対する前記粘性力の変化の比率を表す粘性特性係数を可変的に制御可能に構成されており、
前記一次側要素と前記二次側要素との間の相対変位量を計測し、該相対変位量の計測値と、該相対変位量の変化に対する前記弾性力発生機構の発生弾性力の変化の比率を表す剛性特性係数の値とから、該発生弾性力によって前記二次側要素に付与される前記二次側動力の計測値を取得する二次側動力計測手段と、
前記二次側動力の計測値と前記目標値との偏差を第1変数成分、該偏差の時間的変化率を第2変数成分として構成される切換関数を用いるスライディングモード制御の制御処理により、該切換関数により規定される切換超平面上で前記第1変数成分をゼロに収束させるように前記アクチュエータの駆動力を制御するための制御入力を逐次決定する制御入力決定手段とを備え、
前記制御入力決定手段は、前記粘性特性係数の制御値をあらかじめ決定された補正係数により補正してなる補正値と、前記第1変数成分及び第2変数成分を2つの座標軸成分とする位相平面における前記切換超平面の傾きが前記粘性特性係数の制御値の変化に依存しない傾きになるように決定された前記切換関数とを用いて前記制御入力を決定するように構成されていることを特徴とする(第13発明)。
That is, in order to achieve the above object, the control device for a power transmission device according to the present invention includes a primary side element that is displaced by a driving force of an actuator, and a primary side element that is displaceable relative to the primary side element. Elasticity generated by the elastic force generation mechanism between the primary side element and the secondary side element according to relative displacement between the primary side element and the secondary side element. In a power transmission device configured to transmit power between both elements by force, control for controlling secondary power, which is power applied to the secondary element by the power transmission, to a target value A device,
The elastic force generation mechanism generates a viscous force according to a relative speed between the primary side element and the secondary side element, and a ratio of a change in the viscous force to a change in the relative speed between the two elements. The viscosity characteristic coefficient that represents is variably controllable,
The relative displacement amount between the primary side element and the secondary side element is measured, the measured value of the relative displacement amount, and the ratio of the change in the elastic force generated by the elastic force generation mechanism to the change in the relative displacement amount A secondary-side power measuring means for obtaining a measured value of the secondary-side power applied to the secondary-side element by the generated elastic force from the value of the stiffness characteristic coefficient representing
By control processing of sliding mode control using a switching function configured with a deviation between the measured value of the secondary power and the target value as a first variable component, and a temporal change rate of the deviation as a second variable component, Control input determining means for sequentially determining a control input for controlling the driving force of the actuator so that the first variable component converges to zero on a switching hyperplane defined by a switching function;
The control input determination means is a phase plane having a correction value obtained by correcting the control value of the viscosity characteristic coefficient with a predetermined correction coefficient, and the first variable component and the second variable component as two coordinate axis components. The control input is determined using the switching function determined so that the inclination of the switching hyperplane becomes an inclination independent of a change in the control value of the viscosity characteristic coefficient. (13th invention).
かかる第13明によれば、前記二次側動力計測手段が取得する計測値は、前記第1発明と同様に、前記弾性力発生機構の発生弾性力によって前記二次側要素に付与される二次側動力の計測値であるので、該計測値には、弾性力発生機構が発生する粘性力に起因する成分は含まれていない。そして、該二次側動力の計測値は、前記一次側要素と前記二次側要素との間の相対変位量の計測値を用いて取得されるものであるから、弾性力発生機構の発生弾性力によって二次側要素に付与される実際の二次側動力の値としての信頼性が高いものとなる。 According to the thirteenth aspect, the measurement value acquired by the secondary-side power measuring means is applied to the secondary-side element by the elastic force generated by the elastic force generating mechanism, as in the first invention. Since it is the measured value of the secondary power, the measured value does not include a component due to the viscous force generated by the elastic force generating mechanism. And since the measured value of the secondary power is obtained using the measured value of the relative displacement amount between the primary side element and the secondary side element, the generated elasticity of the elastic force generating mechanism is obtained. The reliability as the actual value of the secondary power imparted to the secondary element by the force becomes high.
第13発明では、上記の如く二次側動力の計測値には、弾性力発生機構が発生する粘性力に起因する成分は含まれないので、前記第1発明と同様に、弾性力発生機構が前記一次側要素及び二次側要素の間の相対速度に応じて粘性力を発生する状況では、二次側動力の計測値は、実際の二次側動力の値に対して誤差を有するものとなる。 In the thirteenth aspect, as described above, the measured value of the secondary side power does not include a component due to the viscous force generated by the elastic force generation mechanism. In a situation where viscous force is generated according to the relative speed between the primary side element and the secondary side element, the measured value of the secondary side power has an error with respect to the actual value of the secondary side power. Become.
ここで、第13発明では、前記制御入力決定手段が前記制御入力を決定するために用いる前記切換関数により規定される前記切換超平面の傾きは、前記粘性特性係数の制御値の変化に依存しない傾きになるように決定される一方、前記粘性特性係数の制御値をあらかじめ決定された補正係数により補正してなる補正値が、前記制御入力を決定するために用いられる。 Here, in the thirteenth aspect, the inclination of the switching hyperplane defined by the switching function used by the control input determining means to determine the control input does not depend on a change in the control value of the viscosity characteristic coefficient. On the other hand, a correction value obtained by correcting the control value of the viscosity characteristic coefficient with a predetermined correction coefficient is used to determine the control input.
このため、前記弾性力発生機構が発生する粘性力の影響で、二次側動力の計測値が実際の値に対して過渡的に誤差を有するものとなっていても、前記制御入力決定手段は、当該誤差の影響を補償するように前記制御入力を決定できる。 For this reason, even if the measured value of the secondary power has a transient error with respect to the actual value due to the influence of the viscous force generated by the elastic force generating mechanism, the control input determining means The control input can be determined so as to compensate for the influence of the error.
すなわち、前記第1変数成分や第2変数成分の値が過剰に変動したり振動したりすることを防止しつつ、安定した時定数で第1変数成分をゼロに収束させる(ひいては、二次側動力の計測値を前記目標値に収束させる)ようにすることができる。 That is, the first variable component is converged to zero with a stable time constant while preventing the first variable component and the second variable component from fluctuating excessively or oscillating. The power measurement value is converged to the target value).
よって、第13発明によれば、二次側要素に付与される動力を高いロバスト性で制御することができる。 Therefore, according to the thirteenth aspect, the power applied to the secondary side element can be controlled with high robustness.
上記第13発明では、前記制御入力決定手段は、より具体的には、例えば前記切換超平面上で前記第1変数成分をゼロに収束させる機能を有する制御入力成分として次式(D)により算出される第1制御入力成分と、前記切換関数の値をゼロに収束させる機能を有する制御入力成分として該切換関数の値に応じて決定される第2制御入力成分とを合成してなる値を前記制御入力として決定するように構成されていることを特徴とする動力伝達装置の制御装置。 In the thirteenth aspect of the invention, more specifically, the control input determining means is calculated by the following equation (D) as a control input component having a function of converging the first variable component to zero on the switching hyperplane, for example. And a second control input component determined according to the value of the switching function as a control input component having a function of converging the value of the switching function to zero. A control device for a power transmission device, wherein the control input is determined as the control input.
なお、上記Iinが入力側イナーシャであるか、入力側慣性質量であるか、並びに、上記Ioutが出力側イナーシャであるか、出力側慣性質量であるかは、前記第4発明の場合と同様である。 Note that whether Iin is input side inertia or input side inertial mass, and whether Iout is output side inertia or output side inertial mass is the same as in the case of the fourth invention. is there.
上記第14発明によれば、前記粘性特性係数の制御値をあらかじめ決定された補正係数により補正してなる補正値(=b・Kdp)を、前記第1制御入力成分に適切に反映させることができる。このため、前記第1変数成分と第2変数成分との組が前記切換超平面上に達した後は、前記第1制御入力成分によって、安定に第1変数成分をゼロに収束させることができる。 According to the fourteenth aspect of the present invention, the correction value (= b · Kdp) obtained by correcting the control value of the viscosity characteristic coefficient with a predetermined correction coefficient is appropriately reflected in the first control input component. it can. For this reason, after the set of the first variable component and the second variable component reaches the switching hyperplane, the first variable component can be stably converged to zero by the first control input component. .
上記第13発明又は第14発明では、前記弾性力発生機構は、例えば前記剛性特性係数が一定値になるように構成される。この場合には、前記第1変数成分をゼロに収束させるための適正時定数と、前記粘性特性係数との間の相関関係であって、前記粘性特性係数の複数の代表値と、該粘性特性係数の各代表値に対応してあらかじめ決定された前記適正時定数の値とに基づいてあらかじめ特定された相関関係において、前記粘性特性係数の値がゼロであるときの前記適正時定数の値に、前記切換超平面上での前記第1変数成分のゼロへの収束の時定数である切換超平面上収束時定数が一致するように、前記切換超平面の傾きが決定されていると共に、該相関関係において、任意の粘性特性係数の値に対応する前記適正時定数の値が、前記粘性特性係数の値がゼロであるときの前記適正時定数の値との差が、当該任意の粘性特性係数の値を前記補正係数により補正してなる補正値の関数値となるように前記補正係数が決定されており、
前記粘性特性係数の各代表値に対応する前記適正時定数値は、前記弾性力発生機構の粘性特性係数を当該代表値に制御した状態で、前記第1変数成分を任意の値からゼロに収束させるときの該第1変数成分の値と前記第2変数成分の値と組の推移の軌跡を示すデータとしてあらかじめ取得された複数の応答特性データのうちの所定の要件を満たす特定の応答特性データに基づいて決定されており、
前記第1変数成分の値の大きさの許容限界値である第1許容限界値とゼロとの間で該第1許容限界値に応じて設定された第1設定値を前記位相平面において示すラインを第1設定値ライン、前記第2変数成分の値の大きさの許容限界値である第2許容限界値とゼロとの間で該第2許容限界値に応じて設定された第2設定値を前記位相平面において示すラインを第2設定値ラインと定義したとき、前記所定の要件を満たす特定の応答特性データは、該特定の応答特性データにより示される前記軌跡上での前記第1変数成分の値の大きさと前記第2変数成分の値の大きさとがそれぞれ前記第1許容限界値以下と第2許容限界値以下とに収まり、且つ、該軌跡が前記第1設定値ライン又は第2設定値ラインと交わるという要件を満たす応答特性データであり、
前記粘性特性係数の各代表値に対応する前記適正時定数の値は、前記位相平面において、前記特定の応答特性データのそれぞれにより示される前記軌跡と前記第1設定値ライン又は第2設定値ラインとの交点のうち、該交点と前記位相平面の原点とを結ぶライン上での前記第1変数成分のゼロへの収束の時定数が、あらかじめ定めた要求範囲内の値であるという制約条件を満たす交点と、該位相平面の原点とを結ぶライン上での前記第1変数成分のゼロへの収束の時定数に一致又は近似するように決定されていることが好ましい(第15発明)。
In the thirteenth aspect or the fourteenth aspect, the elastic force generation mechanism is configured such that, for example, the stiffness characteristic coefficient is a constant value. In this case, there is a correlation between an appropriate time constant for converging the first variable component to zero and the viscosity characteristic coefficient, and a plurality of representative values of the viscosity characteristic coefficient and the viscosity characteristic In the correlation specified in advance based on the value of the appropriate time constant determined in advance corresponding to each representative value of the coefficient, the value of the appropriate time constant when the value of the viscosity characteristic coefficient is zero The inclination of the switching hyperplane is determined so that the convergence time constant on the switching hyperplane that is the time constant of the convergence of the first variable component to zero on the switching hyperplane matches, In the correlation, the value of the appropriate time constant corresponding to the value of the arbitrary viscosity characteristic coefficient is different from the value of the appropriate time constant when the value of the viscosity characteristic coefficient is zero. The coefficient value is corrected by the correction coefficient. Said correction coefficient to be a function value of becomes the correction value has been determined,
The appropriate time constant value corresponding to each representative value of the viscosity characteristic coefficient converges the first variable component from an arbitrary value to zero with the viscosity characteristic coefficient of the elastic force generation mechanism controlled to the representative value. Specific response characteristic data satisfying a predetermined requirement among a plurality of response characteristic data acquired in advance as data indicating the trajectory of transition of the value of the first variable component and the value of the second variable component at the time of the combination Based on
A line indicating, on the phase plane, a first set value set according to the first allowable limit value between a first allowable limit value which is an allowable limit value of the magnitude of the value of the first variable component and zero. , A first set value line, a second set value set according to the second allowable limit value between zero and a second allowable limit value which is an allowable limit value of the value of the second variable component Is defined as a second set value line, the specific response characteristic data satisfying the predetermined requirement is the first variable component on the locus indicated by the specific response characteristic data. And the value of the second variable component fall within the first allowable limit value and the second allowable limit value, respectively, and the locus is the first set value line or the second set value. Response characteristic data that satisfies the requirement to cross the value line It is in,
The value of the appropriate time constant corresponding to each representative value of the viscosity characteristic coefficient is the trajectory indicated by each of the specific response characteristic data and the first set value line or the second set value line on the phase plane. The constraint that the time constant of convergence of the first variable component to zero on the line connecting the intersection and the origin of the phase plane is a value within a predetermined required range among Preferably, it is determined so as to coincide with or approximate the time constant of convergence of the first variable component to zero on a line connecting the intersection point to be satisfied and the origin of the phase plane (15th invention).
上記第15発明によれば、前記第1変数成分をゼロに収束させるための適正時定数と、前記粘性特性係数との間の相関関係が、前記粘性特性係数の複数の代表値と、該粘性特性係数の各代表値に対応してあらかじめ決定された前記適正時定数の値とに基づいてあらかじめ特定されている。 According to the fifteenth aspect of the present invention, the correlation between the appropriate time constant for converging the first variable component to zero and the viscosity characteristic coefficient includes a plurality of representative values of the viscosity characteristic coefficient and the viscosity. It is specified in advance based on the value of the appropriate time constant determined in advance corresponding to each representative value of the characteristic coefficient.
そして、この場合、粘性特性係数の各代表値に対応する適正時定数の値は、前記弾性力発生機構の粘性特性係数を該代表値に制御した状態であらかじめ取得された前記複数の応答特性データのうち、前記所定の要件を満たす特定の応答特性データに基づいて決定されている。 In this case, the value of the appropriate time constant corresponding to each representative value of the viscosity characteristic coefficient is the plurality of response characteristic data acquired in advance with the viscosity characteristic coefficient of the elastic force generation mechanism controlled to the representative value. Of these, it is determined based on specific response characteristic data satisfying the predetermined requirement.
従って、前記応答特性データのうち、該応答特性データにより示される前記軌跡上での前記第1変数成分の値の大きさが前記第1許容限界値を超えるような過大なものとなったり、あるいは、前記第2変数成分の値の大きさが前記第2許容限界値を超えてしまうような過大なものとなるような応答特性データは、粘性特性係数の各代表値に対応する適正時定数の値を決定するための特定の応答特性データとしては利用されない。 Accordingly, of the response characteristic data, the magnitude of the value of the first variable component on the locus indicated by the response characteristic data becomes excessively larger than the first allowable limit value, or The response characteristic data such that the magnitude of the value of the second variable component exceeds the second allowable limit value is an appropriate time constant corresponding to each representative value of the viscosity characteristic coefficient. It is not used as specific response characteristic data for determining a value.
また、前記応答特性データのうち、該応答特性データにより示される前記軌跡上での前記第1変数成分の値の大きさが、前記第1設定値よりも小さい大きさに保たれ、且つ、該軌跡上での前記第2変数成分の値の大きさが、前記第2設定値よりも小さい大きさに保たれるような応答特性データ、すなわち、該軌跡上の任意の点の第1変数成分及び第2変数成分の値の大きさが、いずれも小さ過ぎるような応答特性データは、粘性特性係数の各代表値に対応する適正時定数の値を決定するための特定の応答特性データとしては利用されない。 In the response characteristic data, the value of the first variable component on the locus indicated by the response characteristic data is kept smaller than the first set value, and the Response characteristic data in which the magnitude of the value of the second variable component on the locus is kept smaller than the second set value, that is, the first variable component at an arbitrary point on the locus And the response characteristic data in which the magnitudes of the values of the second variable component are both too small are specific response characteristic data for determining the value of the appropriate time constant corresponding to each representative value of the viscosity characteristic coefficient. Not used.
すなわち、前記軌跡上の点の第1変数成分の値の大きさが、前記第1許容限界値を超えるような過大なものとなったり、あるいは、該軌跡上の点の第2変数成分の値の大きさが、第2許容限界値を超えるような過大なものとなることがなく、しかも、第1変数成分の値の大きさが第1設定値以上の大きさ(小さすぎない大きさ)となるか、もしくは、第2変数成分の値の大きさが第2設定値以上の大きさ(小さすぎない大きさ)となるような点を軌跡上に含む応答特性データだけが、粘性特性係数の各代表値に対応する適正時定数の値を決定するための特定の応答特性データとして利用される。 That is, the magnitude of the value of the first variable component at the point on the trajectory exceeds the first allowable limit value, or the value of the second variable component at the point on the trajectory. The size of the first variable component does not become excessively large beyond the second allowable limit value, and the first variable component value is greater than or equal to the first set value (a size that is not too small). Or only the response characteristic data including a point on the trajectory where the magnitude of the value of the second variable component is greater than or equal to the second set value (a magnitude that is not too small). This is used as specific response characteristic data for determining the value of the appropriate time constant corresponding to each representative value.
従って、第1変数成分のゼロへの収束を良好に行い得るものとして信頼性の高い応答特性データを、粘性特性係数の各代表値に対応する適正時定数の値を決定するための特定の応答特性データとして用いることができる。 Therefore, the response characteristic data having high reliability is obtained as the first variable component can be favorably converged to zero, and the specific response for determining the value of the appropriate time constant corresponding to each representative value of the viscosity characteristic coefficient It can be used as characteristic data.
そして、粘性特性係数の各代表値に対応する適正時定数の値は、前記位相平面において、前記特定の応答特性データのそれぞれにより示される前記軌跡と前記第1設定値ライン又は第2設定値ラインとの交点のうち、該交点と前記位相平面の原点とを結ぶライン上での前記第1変数成分のゼロへの収束の時定数が、あらかじめ定めた要求範囲内の値であるという制約条件を満たす交点と、該位相平面の原点とを結ぶライン上での前記第1変数成分のゼロへの収束の時定数に一致又は近似するように決定されている。 Then, the value of the appropriate time constant corresponding to each representative value of the viscosity characteristic coefficient is the trajectory indicated by each of the specific response characteristic data and the first set value line or the second set value line on the phase plane. The constraint that the time constant of convergence of the first variable component to zero on the line connecting the intersection and the origin of the phase plane is a value within a predetermined required range among It is determined so as to coincide with or approximate the time constant of convergence of the first variable component to zero on the line connecting the satisfying intersection and the origin of the phase plane.
この場合、上記交点は、第1変数成分の値が前記第1設定値に一致するか、又は第2変数成分の値が前記第2設定値に一致するような点であるから、第1変数成分の値の大きさ又は第2変数成分の値の大きさが、過大もしくは過小ではない適度な大きさとなるような点である。 In this case, the intersection point is a point at which the value of the first variable component matches the first set value or the value of the second variable component matches the second set value. It is a point that the magnitude of the component value or the magnitude of the value of the second variable component is an appropriate magnitude that is not too large or too small.
そして、このような交点のうち、該交点と前記位相平面の原点とを結ぶライン上での前記第1変数成分のゼロへの収束の時定数が、あらかじめ定めた要求範囲内の値であるという制約条件を満たす交点(すなわち、前記要求適合交点)を用いて、該要求適合交点と、位相平面の原点とを結ぶライン上での前記第1変数成分のゼロへの収束の時定数に一致又は近似するように、粘性特性係数の各代表値に対応する適正時定数の値が決定されている。 Of these intersections, the time constant for convergence of the first variable component to zero on the line connecting the intersection and the origin of the phase plane is a value within a predetermined required range. Using the intersection satisfying the constraint condition (that is, the requirement adaptation intersection), the time constant of the convergence of the first variable component to zero on the line connecting the requirement adaptation intersection and the origin of the phase plane or As an approximation, the value of the appropriate time constant corresponding to each representative value of the viscosity characteristic coefficient is determined.
このように粘性特性係数の各代表値に対応する適正時定数の値が決定されているので、取得した複数の応答特性データから、該適正時定数の値を決定することを効率よく容易に行なうことができる。 Since the appropriate time constant value corresponding to each representative value of the viscosity characteristic coefficient is determined in this way, it is possible to easily and efficiently determine the appropriate time constant value from a plurality of acquired response characteristic data. be able to.
この場合、応答特性データを取得するための制御手法は、特定の制御手法に限定されるものではないので、PD制御等の汎用的な制御手法を用いて容易に取得することができる。 In this case, the control method for acquiring the response characteristic data is not limited to a specific control method, and can be easily acquired using a general-purpose control method such as PD control.
さらに、粘性特性係数の各代表値に対応する適正時定数の値を、前記要求適合交点を用いて決定することは、例えば最小二乗法等の公知の統計的な同定手法によって行なうことができる。 Furthermore, it is possible to determine a value of an appropriate time constant corresponding to each representative value of the viscosity characteristic coefficient by using the required fitting intersection, for example, by a known statistical identification method such as a least square method.
第15発明では、粘性特性係数の複数の代表値と、その代表値のそれぞれに対応して上記の如く決定された適正時定数の値とに基づいて、適正時定数と、粘性特性係数との間の前記相関関係が特定されている。なお、この相関関係は、前記第5発明における切換超平面の傾きと、粘性特性係数との間の相関関係に対応するものである。 In the fifteenth aspect, based on the plurality of representative values of the viscosity characteristic coefficients and the values of the appropriate time constants determined as described above corresponding to the representative values, the appropriate time constant and the viscosity characteristic coefficient The correlation between them has been identified. This correlation corresponds to the correlation between the inclination of the switching hyperplane and the viscosity characteristic coefficient in the fifth invention.
そして、第15発明では、この相関関係において、前記粘性特性係数の値がゼロであるときの前記適正時定数の値に、前記切換超平面上での前記第1変数成分のゼロへの収束の時定数である切換超平面上収束時定数が一致するように、前記切換超平面の傾きが決定されている。 In the fifteenth invention, in this correlation, the value of the appropriate time constant when the value of the viscosity characteristic coefficient is zero is changed to the convergence of the first variable component to zero on the switching hyperplane. The inclination of the switching hyperplane is determined so that the time constants of convergence on the switching hyperplane coincide with each other.
また、該相関関係において、任意の粘性特性係数の値に対応する前記適正時定数の値が、前記粘性特性係数の値がゼロであるときの前記適正時定数の値との差が、当該任意の粘性特性係数の値を前記補正係数により補正してなる補正値の関数値となるように前記補正係数が決定されている。 In the correlation, the value of the appropriate time constant corresponding to the value of the arbitrary viscosity characteristic coefficient is different from the value of the appropriate time constant when the value of the viscosity characteristic coefficient is zero. The correction coefficient is determined so as to be a function value of a correction value obtained by correcting the value of the viscosity characteristic coefficient by the correction coefficient.
このため、前記制御入力決定手段は、切換超平面の傾きを粘性特性係数の制御値に応じて変化させずとも、高いロバスト性と所望の収束特性とで、二次側動力の計測値を目標値に制御することができるように、適切な補正係数により粘性特性係数の制御値を補正してなる補正値を用いて、スライディングモード制御の制御処理により前記制御入力を決定することができる。 For this reason, the control input determination means can target the measured value of the secondary power with high robustness and desired convergence characteristics without changing the inclination of the switching hyperplane according to the control value of the viscosity characteristic coefficient. The control input can be determined by the control process of the sliding mode control using a correction value obtained by correcting the control value of the viscosity characteristic coefficient by an appropriate correction coefficient so that the value can be controlled to a value.
上記第15発明では、前記相関関係は、例えば次式(E)により表される関係とされる(第16発明)。 In the fifteenth aspect, the correlation is, for example, a relation represented by the following formula (E) (the sixteenth aspect).
Tc=a+b・Kdp/Ksp ……(E)
ただし、
Tc:前記適正時定数
Ksp:前記剛性特性係数の値
Kdp:前記粘性特性係数の値
a:あらかじめ決定された所定値
b:前記補正係数としてあらかじめ決定された所定値
すなわち、本願発明者の各種実験、検討によれば、前記弾性力発生機構の剛性特性係数の値が一定である場合、前記第1変数成分をゼロに収束させるための適正時定数と、前記粘性特性係数との間の相関関係は、式(E)により近似できる。
Tc = a + b · Kdp / Ksp (E)
However,
Tc: the appropriate time constant Ksp: the value of the stiffness characteristic coefficient Kdp: the value of the viscosity characteristic coefficient a: a predetermined value determined in advance b: a predetermined value determined in advance as the correction coefficient
That is, according to various experiments and examinations of the present inventors, when the value of the stiffness characteristic coefficient of the elastic force generation mechanism is constant, an appropriate time constant for causing the first variable component to converge to zero, and the viscosity The correlation between the characteristic coefficients can be approximated by equation (E).
この場合、式(E)の相関関係において、上記aの値が、前記粘性特性係数の値がゼロであるときの前記適正時定数の値であるから、このaの値が第16発明における切換超平面上収束時定数として決定されることとなる。 In this case, in the correlation of the equation (E), the value a is the value of the appropriate time constant when the value of the viscosity characteristic coefficient is zero. It is determined as the convergence time constant on the hyperplane.
また、式(E)の相関関係において、上記bの値が、前記補正係数として決定される。すなわち、式(E)の相関関係において、任意の粘性特性係数の値と、上記aの値との差に、弾性力発生機構の剛性特性係数の値を乗じてなる値に、当該粘性特性係数の値を係数bにより補正してなる値(=b・Kdp)が一致するように補正係数bの値が決定される。 Further, in the correlation of the equation (E), the value b is determined as the correction coefficient. That is, in the correlation of the equation (E), the value obtained by multiplying the difference between the value of the arbitrary viscosity characteristic coefficient and the value a by the value of the rigidity characteristic coefficient of the elastic force generation mechanism is the viscosity characteristic coefficient. The value of the correction coefficient b is determined so that the value obtained by correcting the value of the above by the coefficient b (= b · Kdp) matches.
このように切換超平面の傾きと、補正係数とを決定しておくことで、二次側動力の計測値を安定に目標値に収束させることを好適に行うことができる。 By determining the inclination of the switching hyperplane and the correction coefficient in this way, it is possible to suitably converge the measured value of the secondary power to the target value.
上記第15発明又は第16発明では、前記第1許容限界値は、前記アクチュエータの駆動力による前記一次側要素の変位速度及び変位加速度がそれぞれあらかじめ定められた許容限界値を超えないように、該一次側要素の変位速度の許容限界値と該一次側要素の変位加速度の許容限界値と前記剛性特性係数の値とに応じて決定された値であることが好ましい(第17発明)。 In the fifteenth aspect or the sixteenth aspect, the first permissible limit value is set so that the displacement speed and displacement acceleration of the primary side element due to the driving force of the actuator do not exceed predetermined permissible limit values. It is preferably a value determined according to the allowable limit value of the displacement speed of the primary side element, the allowable limit value of the displacement acceleration of the primary side element, and the value of the stiffness characteristic coefficient (17th invention).
この第17発明によれば、粘性特性係数の各代表値毎に、前記複数の応答特性データのうち、前記一次側要素の変位速度及び変位加速度がそれぞれあらかじめ定められた許容限界値を超えることがないような応答特性データを用いて、粘性特性係数の各代表値に対応する前記適正時定数の値を決定できる。 According to the seventeenth aspect, for each representative value of the viscosity characteristic coefficient, among the plurality of response characteristic data, the displacement speed and displacement acceleration of the primary side element may exceed predetermined allowable limit values. By using such response characteristic data, the appropriate time constant value corresponding to each representative value of the viscosity characteristic coefficient can be determined.
このため、前記動力伝達装置の動作制御時に、前記一次側要素の変位速度及び変位加速度がそれぞれあらかじめ定められた許容限界値を超えないように動力伝達装置を動作を制御することを、前記弾性力発生機構の粘性特性係数の制御状態によらずに、高い信頼性で行うようにすることができる。ひいては、前記弾性力発生機構の粘性特性係数の制御状態によらずに、前記一次側要素の変位速度あるいは変位加速度が許容限界値に近いものとなるような領域での動力伝達装置の動作を安定して行なうようにすることが可能となる。 Therefore, during the operation control of the power transmission device, the operation of the power transmission device is controlled so that the displacement speed and the displacement acceleration of the primary side element do not exceed predetermined allowable limit values, respectively. Regardless of the control state of the viscosity characteristic coefficient of the generating mechanism, it can be performed with high reliability. As a result, regardless of the control state of the viscosity characteristic coefficient of the elastic force generation mechanism, the operation of the power transmission device is stabilized in a region where the displacement speed or displacement acceleration of the primary element is close to the allowable limit value. It is possible to do so.
また、上記第15〜第17発明において、前記第2許容限界値は、前記アクチュエータから前記二次側要素に至る動力伝達系の固有振動に応じた該動力伝達系の振動の発生を防止するように、前記剛性特性係数の値に応じて決定された値であることが好ましい(第18発明)。 In the fifteenth to seventeenth aspects of the present invention, the second permissible limit value prevents the occurrence of vibration of the power transmission system in accordance with the natural vibration of the power transmission system from the actuator to the secondary side element. Further, it is preferable that the value is determined according to the value of the stiffness characteristic coefficient (18th invention).
この第18発明によれば、粘性特性係数の各代表値毎に、前記複数の応答特性データのうち、前記固有振動に応じた動力伝達系の振動が発生しないような応答特性データを用いて、前記粘性特性係数の各代表値に対応する前記適正時定数の値を決定できる。 According to the eighteenth aspect of the present invention, for each representative value of the viscosity characteristic coefficient, among the plurality of response characteristic data, using response characteristic data that does not cause vibration of the power transmission system according to the natural vibration, The appropriate time constant value corresponding to each representative value of the viscosity characteristic coefficient can be determined.
このため、前記弾性力発生機構の粘性特性係数の制御状態によらずに、前記固有振動に応じた動力伝達系の振動が生じないか、もしくは生じ難いものとなるように動力伝達装置を動作を制御することを高い信頼性で行うようにすることができる。 For this reason, the power transmission device is operated so that the vibration of the power transmission system according to the natural vibration does not occur or hardly occurs regardless of the control state of the viscosity characteristic coefficient of the elastic force generation mechanism. Control can be performed with high reliability.
また、前記第13発明又は第14発明において、前記弾性力発生機構は、前記粘性特性係数と前記剛性特性係数とをそれぞれ可変的に制御可能に構成されており、
前記切換超平面の傾きを前記剛性特性係数の制御値に応じて変化させるように設定する切換超平面可変設定手段とを備え、
該切換超平面可変設定手段は、前記第1変数成分をゼロに収束させるための適正時定数と、前記粘性特性係数と、前記剛性特性係数との間の相関関係であって、前記粘性特性係数の複数の代表値と、前記剛性特性係数の複数の代表値と、該粘性特性係数及び剛性特性係数の各代表値の組のそれぞれに対応してあらかじめ決定された前記適正時定数の値とに基づいてあらかじめ特定された相関関係において、前記粘性特性係数の値をゼロとし、且つ、前記剛性特性係数の値を該剛性特性係数の制御値に一致させたときの前記適正時定数の値に、前記切換超平面上での前記第1変数成分のゼロへの収束の時定数である切換超平面上収束時定数が一致するように、前記剛性特性係数の制御値に応じて前記切換超平面の傾きを決定するように構成されており、
さらに、前記相関関係において、任意の粘性特性係数の値に対応する前記適正時定数の値と前記粘性特性係数の値がゼロであるときの前記適正時定数の値との差が、当該任意の粘性特性係数の値を前記補正係数により補正してなる補正値の関数値となるように前記補正係数があらかじめ決定されており、
前記粘性特性係数及び剛性特性係数の各代表値の組のそれぞれに対応する前記適正時定数の値は、前記弾性力発生機構の粘性特性係数及び剛性特性係数をそれぞれ当該代表値に制御した状態で、前記第1変数成分を任意の値からゼロに収束させるときの該第1変数成分の値と前記第2変数成分の値と組の推移の軌跡を示すデータとしてあらかじめ取得された複数の応答特性データのうちの所定の要件を満たす特定の応答特性データに基づいて決定されており、
前記第1変数成分の値の大きさの許容限界値である第1許容限界値とゼロとの間で該第1許容限界値に応じて設定された第1設定値を前記位相平面において示すラインを第1設定値ライン、前記第2変数成分の値の大きさの許容限界値である第2許容限界値とゼロとの間で該第2許容限界値に応じて設定された第2設定値を前記位相平面において示すラインを第2設定値ラインと定義したとき、前記所定の要件を満たす特定の応答特性データは、該特定の応答特性データにより示される前記軌跡上での前記第1変数成分の値の大きさと前記第2変数成分の値の大きさとがそれぞれ前記第1許容限界値以下と第2許容限界値以下とに収まり、且つ、該軌跡が前記第1設定値ライン又は第2設定値ラインと交わるという要件を満たす応答特性データであり、
前記粘性特性係数及び剛性特性係数の各代表値の組のそれぞれに対応する前記適正時定数の値は、前記位相平面において、前記特定の応答特性データのそれぞれにより示される前記軌跡と前記第1設定値ライン又は第2設定値ラインとの交点のうち、該交点と前記位相平面の原点とを結ぶライン上での前記第1変数成分のゼロへの収束の時定数が、あらかじめ定めた要求範囲内の値であるという制約条件を満たす交点と、該位相平面の原点とを結ぶライン上での前記第1変数成分のゼロへの収束の時定数に一致又は近似するように決定されていることが好ましい(第19発明)。
In the thirteenth or fourteenth aspect, the elastic force generation mechanism is configured to be able to variably control the viscosity characteristic coefficient and the rigidity characteristic coefficient,
Switching hyperplane variable setting means for setting the inclination of the switching hyperplane to change according to the control value of the stiffness characteristic coefficient,
The switching hyperplane variable setting means is a correlation between an appropriate time constant for converging the first variable component to zero, the viscosity characteristic coefficient, and the stiffness characteristic coefficient, wherein the viscosity characteristic coefficient A plurality of representative values, a plurality of representative values of the stiffness characteristic coefficient, and a value of the appropriate time constant determined in advance corresponding to each set of representative values of the viscosity characteristic coefficient and the stiffness characteristic coefficient. Based on the correlation specified in advance, the value of the viscosity characteristic coefficient is set to zero, and the value of the appropriate time constant when the value of the rigidity characteristic coefficient matches the control value of the rigidity characteristic coefficient, Depending on the control value of the stiffness characteristic coefficient, the switching hyperplane has a convergence time constant on the switching hyperplane that is a time constant for convergence of the first variable component to zero on the switching hyperplane. Configured to determine the tilt Cage,
Further, in the correlation, the difference between the value of the appropriate time constant corresponding to the value of the arbitrary viscosity characteristic coefficient and the value of the appropriate time constant when the value of the viscosity characteristic coefficient is zero is the arbitrary time constant. The correction coefficient is determined in advance to be a function value of a correction value obtained by correcting the value of the viscosity characteristic coefficient with the correction coefficient,
The value of the appropriate time constant corresponding to each set of representative values of the viscosity characteristic coefficient and the rigidity characteristic coefficient is the state in which the viscosity characteristic coefficient and the rigidity characteristic coefficient of the elastic force generation mechanism are controlled to the representative values, respectively. , A plurality of response characteristics acquired in advance as data indicating a locus of transition of a set of the value of the first variable component and the value of the second variable component when the first variable component is converged from an arbitrary value to zero Determined based on specific response characteristics data that meets certain requirements of the data,
A line indicating, on the phase plane, a first set value set according to the first allowable limit value between a first allowable limit value which is an allowable limit value of the magnitude of the value of the first variable component and zero. , A first set value line, a second set value set according to the second allowable limit value between zero and a second allowable limit value which is an allowable limit value of the value of the second variable component Is defined as a second set value line, the specific response characteristic data satisfying the predetermined requirement is the first variable component on the locus indicated by the specific response characteristic data. And the value of the second variable component fall within the first allowable limit value and the second allowable limit value, respectively, and the locus is the first set value line or the second set value. Response characteristic data that satisfies the requirement to cross the value line It is in,
The value of the appropriate time constant corresponding to each set of representative values of the viscosity characteristic coefficient and the stiffness characteristic coefficient is the trajectory indicated by each of the specific response characteristic data and the first setting on the phase plane. Among the intersections with the value line or the second set value line, the time constant for convergence of the first variable component to zero on the line connecting the intersection and the origin of the phase plane is within a predetermined required range. It is determined so as to match or approximate the time constant of convergence of the first variable component to zero on a line connecting the intersection satisfying the constraint condition of the value of the value and the origin of the phase plane. Preferred (19th invention).
上記第19発明によれば、前記第1変数成分をゼロに収束させるための適正時定数と、前記粘性特性係数と、前記剛性特性係数との間の相関関係が、前記粘性特性係数の複数の代表値と、前記剛性特性係数の複数の代表値と、該粘性特性係数及び剛性特性係数の各代表値の組のそれぞれに対応してあらかじめ決定された前記適正時定数の値とに基づいてあらかじめ特定されている。 According to the nineteenth aspect of the present invention, a correlation between an appropriate time constant for converging the first variable component to zero, the viscosity characteristic coefficient, and the rigidity characteristic coefficient is a plurality of viscosity characteristic coefficients. Based on a representative value, a plurality of representative values of the stiffness characteristic coefficient, and a value of the appropriate time constant determined in advance corresponding to each of the representative value sets of the viscosity characteristic coefficient and the stiffness characteristic coefficient. Have been identified.
そして、この場合、粘性特性係数及び剛性特性係数の各代表値の組のそれぞれに対応する適正時定数の値は、前記弾性力発生機構の粘性特性係数及び剛性特性係数をそれぞれ当該代表値に制御した状態であらかじめ取得された前記複数の応答特性データのうち、前記所定の要件を満たす特定の応答特性データに基づいて決定されている。 In this case, the values of the appropriate time constants corresponding to the respective sets of the representative values of the viscosity characteristic coefficient and the rigidity characteristic coefficient are controlled so that the viscosity characteristic coefficient and the rigidity characteristic coefficient of the elastic force generation mechanism are respectively set to the representative values. It is determined based on specific response characteristic data satisfying the predetermined requirement among the plurality of response characteristic data acquired in advance.
従って、前記応答特性データのうち、該応答特性データにより示される前記軌跡上での前記第1変数成分の値の大きさが前記第1許容限界値を超えるような過大なものとなったり、あるいは、前記第2変数成分の値の大きさが前記第2許容限界値を超えてしまうような過大なものとなるような応答特性データは、粘性特性係数及び剛性特性係数の各代表値の組のそれぞれに対応する適正時定数の値を決定するための特定の応答特性データとしては利用されない。 Accordingly, of the response characteristic data, the magnitude of the value of the first variable component on the locus indicated by the response characteristic data becomes excessively larger than the first allowable limit value, or The response characteristic data such that the magnitude of the value of the second variable component exceeds the second allowable limit value is a set of representative values of the viscosity characteristic coefficient and the rigidity characteristic coefficient. It is not used as specific response characteristic data for determining the value of the appropriate time constant corresponding to each.
また、前記応答特性データのうち、該応答特性データにより示される前記軌跡上での前記第1変数成分の値の大きさが、前記第1設定値よりも小さい大きさに保たれ、且つ、該軌跡上での前記第2変数成分の値の大きさが、前記第2設定値よりも小さい大きさに保たれるような応答特性データ、すなわち、該軌跡上の任意の点の第1変数成分及び第2変数成分の値の大きさが、いずれも小さ過ぎるような応答特性データは、粘性特性係数及び剛性特性係数の各代表値の組のそれぞれに対応する適正時定数の値を決定するための特定の応答特性データとしては利用されない。 In the response characteristic data, the value of the first variable component on the locus indicated by the response characteristic data is kept smaller than the first set value, and the Response characteristic data in which the magnitude of the value of the second variable component on the locus is kept smaller than the second set value, that is, the first variable component at an arbitrary point on the locus And response characteristic data in which the magnitudes of the values of the second variable component are both too small are for determining appropriate time constant values corresponding to the respective sets of representative values of the viscosity characteristic coefficient and the rigidity characteristic coefficient. It is not used as specific response characteristic data.
すなわち、前記軌跡上の点の第1変数成分の値の大きさが、前記第1許容限界値を超えるような過大なものとなったり、あるいは、該軌跡上の点の第2変数成分の値の大きさが、第2許容限界値を超えるような過大なものとなることがなく、しかも、第1変数成分の値の大きさが第1設定値以上の大きさ(小さすぎない大きさ)となるか、もしくは、第2変数成分の値の大きさが第2設定値以上の大きさ(小さすぎない大きさ)となるような点を軌跡上に含む応答特性データだけが、粘性特性係数及び剛性特性係数の各代表値の組のそれぞれに対応する適正時定数の値を決定するための特定の応答特性データとして利用される。 That is, the magnitude of the value of the first variable component at the point on the trajectory exceeds the first allowable limit value, or the value of the second variable component at the point on the trajectory. The size of the first variable component does not become excessively large beyond the second allowable limit value, and the first variable component value is greater than or equal to the first set value (a size that is not too small). Or only the response characteristic data including a point on the trajectory where the magnitude of the value of the second variable component is greater than or equal to the second set value (a magnitude that is not too small). And appropriate response characteristic data for determining a value of an appropriate time constant corresponding to each set of representative values of stiffness characteristic coefficients.
従って、第1変数成分のゼロへの収束を良好に行い得るものとして信頼性の高い応答特性データを、粘性特性係数及び剛性特性係数の各代表値の組のそれぞれに対応する適正時定数の値を決定するための特定の応答特性データとして用いることができる。 Therefore, the response characteristic data with high reliability is obtained as a value that can successfully converge the first variable component to zero, and the value of the appropriate time constant corresponding to each of the representative value sets of the viscosity characteristic coefficient and the rigidity characteristic coefficient. Can be used as specific response characteristic data for determining.
そして、粘性特性係数及び剛性特性係数の各代表値の組のそれぞれに対応する適正時定数の値は、前記位相平面において、前記特定の応答特性データのそれぞれにより示される前記軌跡と前記第1設定値ライン又は第2設定値ラインとの交点のうち、該交点と前記位相平面の原点とを結ぶライン上での前記第1変数成分のゼロへの収束の時定数が、あらかじめ定めた要求範囲内の値であるという制約条件を満たす交点と、該位相平面の原点とを結ぶライン上での前記第1変数成分のゼロへの収束の時定数に一致又は近似するように決定されている。 Then, the values of the appropriate time constants corresponding to the respective representative value sets of the viscosity characteristic coefficient and the stiffness characteristic coefficient are the trajectory indicated by each of the specific response characteristic data and the first setting on the phase plane. Among the intersections with the value line or the second set value line, the time constant for convergence of the first variable component to zero on the line connecting the intersection and the origin of the phase plane is within a predetermined required range. It is determined so as to coincide with or approximate the time constant of convergence of the first variable component to zero on a line connecting the intersection satisfying the constraint condition of the value and the origin of the phase plane.
この場合、上記交点は、第1変数成分の値が前記第1設定値に一致するか、又は第2変数成分の値が前記第2設定値に一致するような点であるから、第1変数成分の値の大きさ又は第2変数成分の値の大きさが、過大もしくは過小ではない適度な大きさとなるような点である。 In this case, the intersection point is a point at which the value of the first variable component matches the first set value or the value of the second variable component matches the second set value. It is a point that the magnitude of the component value or the magnitude of the value of the second variable component is an appropriate magnitude that is not too large or too small.
そして、このような交点のうち、該交点と前記位相平面の原点とを結ぶライン上での前記第1変数成分のゼロへの収束の時定数が、あらかじめ定めた要求範囲内の値であるという制約条件を満たす交点(すなわち、前記要求適合交点)と、該位相平面の原点とを結ぶライン上での前記第1変数成分のゼロへの収束の時定数に一致又は近似するように、粘性特性係数及び剛性特性係数の各代表値の組のそれぞれに対応する適正時定数の値が決定されている。 Of these intersections, the time constant for convergence of the first variable component to zero on the line connecting the intersection and the origin of the phase plane is a value within a predetermined required range. Viscosity characteristics so as to coincide with or approximate the time constant of convergence of the first variable component to zero on a line connecting the intersection satisfying the constraint condition (that is, the required matching intersection) and the origin of the phase plane. A value of an appropriate time constant corresponding to each set of representative values of the coefficient and the stiffness characteristic coefficient is determined.
このように粘性特性係数及び剛性特性係数の各代表値の組のそれぞれに対応する適正時定数の値が決定されているので、取得した複数の応答特性データから、該適正時定数の値を決定することを効率よく容易に行なうことができる。 As described above, the appropriate time constant value corresponding to each representative value set of the viscosity characteristic coefficient and the stiffness characteristic coefficient is determined, and therefore, the appropriate time constant value is determined from a plurality of acquired response characteristic data. Can be done efficiently and easily.
この場合、応答特性データを取得するための制御手法は、特定の制御手法に限定されるものではないので、PD制御等の汎用的な制御手法を用いて容易に取得することができる。 In this case, the control method for acquiring the response characteristic data is not limited to a specific control method, and can be easily acquired using a general-purpose control method such as PD control.
さらに、粘性特性係数及び剛性特性係数の各代表値の組のそれぞれに対応する適正時定数の値を、前記要求適合交点を用いて決定することは、例えば最小二乗法等の公知の統計的な同定手法によって行なうことができる。 Further, the determination of the appropriate time constant value corresponding to each of the representative value pairs of the viscosity characteristic coefficient and the stiffness characteristic coefficient using the required fitting intersection is, for example, a known statistical method such as a least square method. This can be done by an identification technique.
第19発明では、粘性特性係数の複数の代表値と、剛性特性係数の複数の代表値と、それらの代表値の組のそれぞれに対応して上記の如く決定された適正時定数の値とに基づいて、適正時定数と、粘性特性係数と、剛性特性係数との間の前記相関関係が特定されている。なお、この相関関係は、前記第8発明における切換超平面の傾きと、粘性特性係数との間の相関関係に対応するものである。 In the nineteenth invention, a plurality of representative values of the viscosity characteristic coefficient, a plurality of representative values of the rigidity characteristic coefficient, and a value of the appropriate time constant determined as described above corresponding to each of the set of the representative values. Based on this, the correlation among the appropriate time constant, the viscosity characteristic coefficient, and the rigidity characteristic coefficient is specified. This correlation corresponds to the correlation between the inclination of the switching hyperplane and the viscosity characteristic coefficient in the eighth invention.
そして、第19発明では、動力伝達装置の動作制御時に、前記切換超平面可変設定手段によって、上記相関関係において、前記粘性特性係数の値をゼロとし、且つ、前記剛性特性係数の値を該剛性特性係数の制御値に一致させたときの前記適正時定数の値に、前記切換超平面上での前記第1変数成分のゼロへの収束の時定数である切換超平面上収束時定数が一致するように、前記剛性特性係数の制御値に応じて前記切換超平面の傾きが決定される。 In the nineteenth aspect of the invention, during the operation control of the power transmission device, the switching hyperplane variable setting means sets the value of the viscosity characteristic coefficient to zero in the correlation and sets the value of the rigidity characteristic coefficient to the rigidity. The value of the appropriate time constant when matched with the control value of the characteristic coefficient matches the convergence time constant on the switching hyperplane that is the time constant of convergence of the first variable component to zero on the switching hyperplane. Thus, the inclination of the switching hyperplane is determined according to the control value of the stiffness characteristic coefficient.
また、該相関関係において、任意の粘性特性係数の値に対応する前記適正時定数の値と前記粘性特性係数の値がゼロであるときの前記適正時定数の値との差が、当該任意の粘性特性係数の値を前記補正係数により補正してなる補正値の関数値となるように前記補正係数があらかじめ決定されている。 Further, in the correlation, a difference between the value of the appropriate time constant corresponding to the value of the arbitrary viscosity characteristic coefficient and the value of the appropriate time constant when the value of the viscosity characteristic coefficient is zero is the arbitrary time constant. The correction coefficient is determined in advance so as to be a function value of a correction value obtained by correcting the value of the viscosity characteristic coefficient with the correction coefficient.
このため、前記制御入力決定手段は、切換超平面の傾きを粘性特性係数の制御値に応じて変化させずとも、高いロバスト性と所望の収束特性とで、二次側動力の計測値を目標値に制御することができるように、適切な補正係数により粘性特性係数の制御値を補正してなる補正値を用いて、スライディングモード制御の制御処理により前記制御入力を決定することができる。 For this reason, the control input determination means can target the measured value of the secondary power with high robustness and desired convergence characteristics without changing the inclination of the switching hyperplane according to the control value of the viscosity characteristic coefficient. The control input can be determined by the control process of the sliding mode control using a correction value obtained by correcting the control value of the viscosity characteristic coefficient by an appropriate correction coefficient so that the value can be controlled to a value.
上記第19発明では、前記相関関係は、例えば次式(F)により表される関係とされる(第20発明)。 In the nineteenth aspect, the correlation is, for example, a relation represented by the following equation (F) (20th aspect).
Tc=(a2/sqrt(Ksp))+a1・Ksp+a0+b・Kdp/Ksp ……(F)
ただし、
Tc:前記適正時定数
Ksp:前記剛性特性係数の値
Kdp:前記粘性特性係数の値
a2,a1,a0:あらかじめ決定された所定値
b:前記補正係数としてあらかじめ決定された所定値
すなわち、本願発明者の各種実験、検討によれば、前記弾性力発生機構の粘性特性係数と剛性特性係数とがそれぞれ可変的に制御される場合、前記第1変数成分をゼロに収束させるための適正時定数と、前記粘性特性係数と、前記剛性特性係数との間の相関関係は、式(F)により近似できる。
Tc = (a2 / sqrt (Ksp)) + a1 · Ksp + a0 + b · Kdp / Ksp (F)
However,
Tc: the appropriate time constant Ksp: the value of the stiffness characteristic coefficient Kdp: the value of the viscosity characteristic coefficient a2, a1, a0: a predetermined value determined in advance b: a predetermined value determined in advance as the correction coefficient
That is, according to various experiments and examinations of the inventors of the present application, when the viscosity characteristic coefficient and the rigidity characteristic coefficient of the elastic force generation mechanism are variably controlled, the first variable component is converged to zero. The correlation between the appropriate time constant, the viscosity characteristic coefficient, and the rigidity characteristic coefficient can be approximated by Expression (F).
この場合、式(F)の相関関係において、上記(a2/sqrt(Ksp))+a1・Ksp+a0の値が、前記粘性特性係数の値がゼロであるときの前記適正時定数の値であるから、この(a2/sqrt(Ksp))+a1・Ksp+a0の値が第20発明における切換超平面上収束時定数として、剛性特性係数の制御値に応じて決定されることとなる。 In this case, in the correlation of the formula (F), the value of (a2 / sqrt (Ksp)) + a1 · Ksp + a0 is the value of the appropriate time constant when the value of the viscosity characteristic coefficient is zero. The value of (a2 / sqrt (Ksp)) + a1 · Ksp + a0 is determined according to the control value of the stiffness characteristic coefficient as the convergence time constant on the switching hyperplane in the twentieth invention.
また、式(F)の相関関係において、上記bの値が、前記補正係数として決定される。すなわち、式(F)の相関関係において、任意の粘性特性係数の値と、上記(a2/sqrt(Ksp))+a1・Ksp+a0の値との差に、弾性力発生機構の剛性特性係数の値を乗じてなる値に、当該粘性特性係数の値を係数bにより補正してなる値(=b・Kdp)が一致するように補正係数bの値が決定される。 Further, in the correlation of the formula (F), the value b is determined as the correction coefficient. That is, in the correlation of the formula (F), the value of the stiffness characteristic coefficient of the elastic force generation mechanism is set to the difference between the value of an arbitrary viscosity characteristic coefficient and the value of (a2 / sqrt (Ksp)) + a1 · Ksp + a0. The value of the correction coefficient b is determined so that the value obtained by correcting the value of the viscosity characteristic coefficient by the coefficient b (= b · Kdp) matches the value obtained by multiplication.
このように切換超平面の傾きと、補正係数とを決定しておくことで、二次側動力の計測値を安定に目標値に収束させることを好適に行うことができる。 By determining the inclination of the switching hyperplane and the correction coefficient in this way, it is possible to suitably converge the measured value of the secondary power to the target value.
上記第19発明又は第20発明では、前記第1許容限界値は、前記剛性特性係数の各代表値に対応して設定される値であり、該剛性特性係数の各代表値に対応する前記第1許容限界値は、前記弾性力発生機構の剛性特性係数を当該代表値に制御した状態で、前記アクチュエータの駆動力による前記一次側要素の変位速度及び変位加速度がそれぞれあらかじめ定められた許容限界値を超えないように、該一次側要素の変位速度の許容限界値と該一次側要素の変位加速度の許容限界値と前記剛性特性係数の当該代表値とに応じて決定された値であることが好ましい(第21発明)。 In the nineteenth or twentieth invention, the first allowable limit value is a value set corresponding to each representative value of the stiffness characteristic coefficient, and the first limit value corresponding to each representative value of the stiffness characteristic coefficient. 1 allowable limit value is a predetermined allowable limit value in which the displacement speed and the displacement acceleration of the primary element due to the driving force of the actuator are respectively determined in a state where the stiffness characteristic coefficient of the elastic force generation mechanism is controlled to the representative value. So as not to exceed the allowable limit value of the displacement speed of the primary side element, the allowable limit value of the displacement acceleration of the primary side element, and the representative value of the stiffness characteristic coefficient. Preferred (21st invention).
この第21発明によれば、前記粘性特性係数及び剛性特性係数の各代表値の組のそれぞれ毎に、前記複数の応答特性データのうち、前記一次側要素の変位速度及び変位加速度がそれぞれあらかじめ定められた許容限界値を超えることがないような応答特性データを用いて、前記適正時定数の値を決定できる。 According to the twenty-first aspect, for each of the sets of representative values of the viscosity characteristic coefficient and the rigidity characteristic coefficient, a displacement speed and a displacement acceleration of the primary side element among the plurality of response characteristic data are respectively determined in advance. The value of the appropriate time constant can be determined using response characteristic data that does not exceed the allowable limit value.
このため、前記動力伝達装置の動作制御時に、前記一次側要素の変位速度及び変位加速度がそれぞれあらかじめ定められた許容限界値を超えないように動力伝達装置を動作を制御することを、前記弾性力発生機構の粘性特性係数及び剛性特性係数の制御状態によらずに、高い信頼性で行うようにすることができる。ひいては、前記弾性力発生機構の粘性特性係数及び剛性特性係数の制御状態によらずに、前記一次側要素の変位速度あるいは変位加速度が許容限界値に近いものとなるような領域での動力伝津装置の動作を安定して行なうようにすることが可能となる。 Therefore, during the operation control of the power transmission device, the operation of the power transmission device is controlled so that the displacement speed and the displacement acceleration of the primary side element do not exceed predetermined allowable limit values, respectively. Regardless of the control state of the viscosity characteristic coefficient and the rigidity characteristic coefficient of the generating mechanism, it can be performed with high reliability. As a result, power transmission in a region where the displacement speed or displacement acceleration of the primary element is close to the allowable limit value, regardless of the control state of the viscosity characteristic coefficient and the rigidity characteristic coefficient of the elastic force generation mechanism. It becomes possible to perform the operation of the apparatus stably.
また、上記第19〜第21発明では、前記第2許容限界値は、前記剛性特性係数の各代表値に対応して設定される値であり、該剛性特性係数の各代表値に対応する前記第2許容限界値は、前記弾性力発生機構の剛性特性係数を当該代表値に制御した状態で、前記アクチュエータから前記二次側要素に至る動力伝達系の固有振動に応じた該動力伝達系の振動の発生を防止するように、前記剛性特性係数の当該代表値に応じて決定された値であることが好ましい(第22発明)。 In the nineteenth to twenty-first inventions, the second allowable limit value is a value set corresponding to each representative value of the stiffness characteristic coefficient, and the second value corresponding to each representative value of the stiffness characteristic coefficient. The second allowable limit value is a value of the power transmission system corresponding to the natural vibration of the power transmission system from the actuator to the secondary element in a state where the stiffness characteristic coefficient of the elastic force generation mechanism is controlled to the representative value. It is preferable that the value is determined according to the representative value of the stiffness characteristic coefficient so as to prevent the occurrence of vibration (22nd invention).
この第22発明によれば、、前記粘性特性係数及び剛性特性係数の各代表値の組のそれぞれ毎に、前記複数の応答特性データのうち、前記固有振動に応じた動力伝達系の振動が発生しないような応答特性データを用いて、前記粘性特性係数及び剛性特性係数の各代表値の組のそれぞれに対応する適正時定数の値を決定できる。 According to the twenty-second aspect, vibration of the power transmission system corresponding to the natural vibration is generated among the plurality of response characteristic data for each set of representative values of the viscosity characteristic coefficient and the rigidity characteristic coefficient. By using such response characteristic data, an appropriate time constant value corresponding to each set of representative values of the viscosity characteristic coefficient and the rigidity characteristic coefficient can be determined.
このため、前記弾性力発生機構の粘性特性係数及び剛性特性係数の制御状態によらずに、前記固有振動に応じた動力伝達系の振動が生じないか、もしくは生じ難いものとなるように動力伝達装置を動作を制御することを高い信頼性で行うようにすることができる。 Therefore, regardless of the control state of the viscosity characteristic coefficient and the rigidity characteristic coefficient of the elastic force generation mechanism, the power transmission system is designed so that the vibration of the power transmission system according to the natural vibration does not occur or hardly occurs. It is possible to control the operation of the apparatus with high reliability.
また、前記第15〜第22発明では、前記第1変数成分の値をゼロから前記第1許容限界値までステップ状に変化させると共に該第1変数成分の値のゼロへの収束を前記アクチュエータの駆動力による前記一次側要素の変位加速度が該変位加速度の許容限界値になるように行なったと仮定した場合に実現される時定数を特定時定数と定義しとき、前記制約条件は、前記第1変数成分のゼロへの収束の時定数を、前記特定時定数以上の範囲の値に制限する条件であることが好ましい(第23発明)。 In the fifteenth to twenty-second inventions, the value of the first variable component is changed stepwise from zero to the first allowable limit value, and the convergence of the value of the first variable component to zero is controlled by the actuator. When the time constant realized when it is assumed that the displacement acceleration of the primary side element due to the driving force is set to the allowable limit value of the displacement acceleration is defined as the specific time constant, the constraint condition is the first condition. It is preferable that the time constant for convergence of the variable component to zero is a condition that limits the time constant to a value in the range equal to or greater than the specific time constant (23rd invention).
すなわち、前記第1変数成分の値をゼロから、第1許容限界値以下のある値にステップ状に変化させることを想定した場合、第1変数成分の値をゼロから第1許容限界値まで変化させる場合に、前記一次側要素と二次側要素との間の相対変位量が最大となる。 That is, when it is assumed that the value of the first variable component is changed stepwise from zero to a certain value not more than the first allowable limit value, the value of the first variable component is changed from zero to the first allowable limit value. In this case, the relative displacement amount between the primary side element and the secondary side element is maximized.
この場合、二次側要素に対する一次側要素の変位は、許容限界値以下の変位加速度での変位に制限されるので、第1変数成分の値のゼロへの収束の時定数は、前記特定時定数よりも小さくなることはできない。 In this case, since the displacement of the primary side element with respect to the secondary side element is limited to the displacement at the displacement acceleration equal to or less than the allowable limit value, the time constant for convergence of the value of the first variable component to zero is the specified time. It cannot be smaller than a constant.
そこで、第23発明では、前記要求適合交点を規定する前記制約条件を、前記第1変数成分のゼロへの収束の時定数を前記特定時定数以上の範囲の値に制限する条件となるように設定した。 Therefore, in the twenty-third aspect of the invention, the constraint condition that defines the requirement-matching intersection is a condition that limits a time constant for convergence of the first variable component to zero to a value in a range equal to or greater than the specific time constant. Set.
従って、第23発明によれば、動力伝達装置の動作制御時に、該動力伝達装置の幅広い動作領域で、二次側動力を目標値に制御することを高いロバスト性で安定に行なうことができる。 Therefore, according to the twenty-third aspect, at the time of controlling the operation of the power transmission device, it is possible to stably control the secondary power to the target value in a wide range of operation of the power transmission device with high robustness.
また、前記第13〜第23発明では、前記二次側動力の計測値と該二次側動力の目標値とから算出される前記第1変数成分の値である第1変数成分計測値と、該第1変数成分計測値の時間的変化率として算出される前記第2変数成分の値である第2変数成分計測値とから外乱による影響を低減してなる前記第1変数成分の推定値と前記第2変数成分の推定値とを逐次算出するオブザーバをさらに備えており、前記制御入力決定手段は、前記第1変数成分計測値と前記第2変数成分計測値との代わりに、前記オブザーバにより算出された前記第1変数成分の推定値と第2変数成分の推定値とを用いて前記切換関数の値を算出しつつ、該切換関数の値を用いて前記制御入力を逐次生成するように構成されていることが好ましい(第24発明)。 In the thirteenth to twenty-third inventions, a first variable component measurement value that is a value of the first variable component calculated from the measurement value of the secondary power and the target value of the secondary power; An estimated value of the first variable component obtained by reducing the influence of disturbance from a second variable component measured value that is a value of the second variable component calculated as a rate of temporal change of the first variable component measured value; The observer further includes an observer that sequentially calculates the estimated value of the second variable component, and the control input determining means uses the observer instead of the first variable component measured value and the second variable component measured value. While calculating the value of the switching function using the calculated estimated value of the first variable component and the estimated value of the second variable component, the control input is sequentially generated using the value of the switching function. Preferably, it is configured (24th invention).
この第24発明によれば、前記オブザーバにより算出された前記第1変数成分の推定値と第2変数成分の推定値とを用いて前記切換関数の値を算出しつつ、該切換関数の値を用いてスライディングモード制御の制御処理により前記制御入力を逐次生成することにより、外乱の影響が抑制される。 According to this twenty-fourth aspect, the value of the switching function is calculated while calculating the value of the switching function using the estimated value of the first variable component and the estimated value of the second variable component calculated by the observer. By using the control input of the sliding mode control to sequentially generate the control input, the influence of disturbance is suppressed.
このため、制御入力決定手段により逐次決定される制御入力の安定性が高まる。ひいては、二次側動力の制御のロバスト性をより一層高めることができる。 For this reason, the stability of the control input sequentially determined by the control input determining means is increased. As a result, the robustness of the control of the secondary power can be further enhanced.
[第1実施形態]
本発明の第1実施形態を以下に図1〜図9を参照して説明する。
[First Embodiment]
A first embodiment of the present invention will be described below with reference to FIGS.
図1に示すように、本実施形態の動力伝達装置1は、一次側要素としての駆動プーリ2と、二次側要素としての被動プーリ3と、これらのプーリ2,3の間に弾性力と粘性力とを発生させる弾性力発生機構4と、駆動プーリ2に回転駆動力を付与するアクチュエータとしての電動モータ5と、被動プーリ3と一体に回転するように該被動プーリ3に固定された負荷部材6とを備える。
As shown in FIG. 1, the
なお、負荷部材6は、図1では一体の構造物として記載されているが、一体の構造物でなくてもよい。例えば、負荷部材6は、1つ以上の関節を含むリンク機構であってもよい。 Although the load member 6 is illustrated as an integral structure in FIG. 1, the load member 6 may not be an integral structure. For example, the load member 6 may be a link mechanism including one or more joints.
駆動プーリ2は、電動モータ5の回転駆動軸5aに減速機7を介して接続されている。そして、駆動プーリ2は、電動モータ5の回転駆動軸5aから減速機7を介して付与される回転駆動力(トルク)によって、電動モータ5の回転駆動軸5aの回転に連動して回転するようになっている。
The
なお、減速機7は、任意の構造のものでよく、例えば、ハーモニックドライブ(登録商標)もしくは複数のギヤにより構成される減速機を採用することができる。あるいは、減速機7は、直動を回転運動に変換する機構を備えるものであってもよい。その場合には、アクチュエータとして、例えば、電動モータ及びボールネジにより構成される直動アクチュエータ、あるいは、電動式のリニアモータ等を採用してもよい。
Note that the
また、図1では、電動モータ5と駆動プーリ2とが同軸心に配置されているが、それらの回転軸心は、同軸心でなくてもよい。
In FIG. 1, the
被動プーリ3は、その回転軸心が駆動プーリ2の回転軸心と平行になるようにして、該駆動プーリ2の側方に並設されている。
The driven
弾性力発生機構4は、駆動プーリ2及び被動プーリ3の間に架け渡されたワイヤ11と、両プーリ2,3間の剛性及び粘性を変更するための剛性/粘性可変機構12とを備える。
The elastic force generation mechanism 4 includes a wire 11 laid between the driving
ワイヤ11は、図2に示すように、両プーリ2,3の間で延在する二条の張設部分11a,11bを有し、該張設部分11a,11b以外の部分が両プーリ2,3の外周のうちの内端側の部分(駆動プーリ2の外周のうちの被動プーリ3に臨む部分、及び被動プーリ3の外周のうちの駆動プーリ2に臨む部分)を除く箇所に滑らないように巻き掛けられている。なお、ワイヤ11は、多少の伸縮性を有する。
As shown in FIG. 2, the wire 11 has two extending
剛性/粘性可変機構12は、例えば図2〜図4に示すように構成されている。すなわち、剛性/粘性可変機構12は、両端部にローラ13a,13bが回転自在に枢着された回転バー14を備えている。この回転バー14は、その中央部に固定された回転軸15の軸心まわりに該回転軸15と一体に回転可能とされている。回転軸15は、駆動プーリ2及び被動プーリ3の間の位置で、両プーリ2,3の回転軸心と平行な姿勢で配置されている。
The stiffness /
回転バー14の両端部のローラ13a,13bは、それぞれの回転軸心が駆動プーリ2及び被動プーリ3の回転軸心と平行な方向に向けられている。
The
そして、ローラ13a,13bのうちの一方のローラ13aの内端側(他方のローラ13bに臨む側)の外周部が、ワイヤ11の二条の張設部分11a,11bのうちの一方の張設部分11aに圧接され、他方のローラ13bの内端側(一方のローラ13aに臨む側)の外周部が、ワイヤ11の他方の張設部分11bに圧接されている。この場合、ワイヤ11の張設部分11a,11bは、それぞれ、ローラ13a,13bの圧接箇所で湾曲されている。
And the outer peripheral part of the inner end side (side facing the
剛性/粘性可変機構12は、さらに、回転バー14に回転軸15を介して連結されて該回転バー14と一体に回転可能に設けられたギヤ(平歯車)16と、このギヤ16に噛合されたスプリングウォーム17と、このスプリングウォーム17を回転駆動する電動モータ18と、粘性オイルが内部に封入されたシリンダ19とを備えている。
The variable stiffness /
スプリングウォーム17は、ウォームギヤとして機能可能にコイルスプリング状に形成されたばね部材であり、電動モータ18の回転駆動軸18aに外挿されている。そして、スプリングウォーム17の電動モータ18の本体寄りの一端は、回転駆動軸18aに固定されたバネ座部材20aに固定されている。従って、スプリングウォーム17は、電動モータ18の回転駆動軸18aと一体に回転し、このスプリングウォーム17の回転に伴い、ギヤ16が回転するようになっている。
The
シリンダ19は、スプリングウォーム17の他端側で回転駆動軸18aと同軸心に配置された筒部21を有する。この筒部21の内部を電動モータ18の回転駆動軸18aが貫通し、該筒部21が、回転駆動軸18aに沿って、その軸心方向に摺動可能とされている。そして、筒部21のスプリングウォーム17側の端面に固定されたバネ座部材20bにスプリングウォーム17の他端が固定されている。従って、スプリングウォーム17の伸縮に伴い、シリンダ19の筒部21が電動モータ18の回転駆動軸18aの軸心方向に摺動するようになっている。
The
また、筒部21の内部には、回転駆動軸18aに固定されたピストン22が設けられており、このピストン22の外周面が筒部21の内周面に摺接されている。
In addition, a
そして、筒部21の内部でピストン22により画成された2つの油室23a,23bに粘性オイルが封入されている。これらの油室23a,23bは、オリフィス部24を有する連通管25により連通されている。この場合、オリフィス部24は、図示しない弁機構等により開口面積を変化させることが可能となっている。
Then, viscous oil is enclosed in two
ここで、以上の構成の弾性力発生機構4の動作を説明しておく。電動モータ18により、スプリングウォーム17を回転駆動することで、該スプリングウォーム17に噛合されたギヤ16を介して回転バー14が回転する。従って、電動モータ18のサーボ制御によって、回転バー14の回転角度(位相角)を制御することができる。ここで、以降の説明では、回転バー14の位相角を、図2に示すように、回転バー14の延在方向(ローラ13a,13bの間隔方向)が駆動プーリ2及び被動プーリ3の間隔方向と直交する状態からの該回転バー14の回転角度φとして定義する。
Here, the operation of the elastic force generation mechanism 4 having the above configuration will be described. When the
両プーリ2,3間の動力伝達(回転駆動力の伝達)を行っていない状態で、回転バー14の位相角φをある既定の角度値(例えば図2のφ0)に制御し、その状態で電動モータ18の回転駆動軸18aの回転(ひいては、スプリングウォーム17の回転)を停止させた状態(以降、この状態を基準状態という)を想定する。
In a state where power transmission between the
この基準状態において、前記電動モータ5から駆動プーリ2に回転駆動力(トルク)を付与すると、ワイヤ11の張設部分11a,11bの一方に、当該回転駆動力に比例した張力が発生し、その張力を介して、駆動プーリ2から被動プーリ3に回転駆動力が伝達される。
In this reference state, when a rotational driving force (torque) is applied from the
同時に、ワイヤ11の張設部分11a,11bの一方に発生する上記張力に起因して、ローラ13a,13bのうちの該張設部分11a又は11bに接触するローラ13a又は13bに、両プーリ2,3の間隔方向とほぼ直交する方向の並進力が作用する。
At the same time, due to the tension generated in one of the stretched
例えば、図2に示すように、駆動プーリ2に反時計まわり方向のトルクτdを付与すると、ワイヤ11の張設部分11aにトルクτdに比例する張力Te(=τd/駆動プーリ2の有効回転半径)が発生し、この張力Teによってローラ13aに並進力Fが作用する。なお、この並進力Fの大きさは、トルクτdにほぼ比例する。また、図2中の張力Teは、ローラ13aに対して作用する張力を示している。
For example, as shown in FIG. 2, when a torque τd in the counterclockwise direction is applied to the
基準姿勢状態での回転バー14の位相角がゼロでない場合(例えば図2に示す状況)では、ローラ13a又は13bに作用する上記並進力(以降、これをFと表記する)に起因して、回転バー14に回転駆動力(トルク)が作用することとなる。これにより、駆動プーリ2が被動プーリ3に対して相対回転すると共に、回転バー14が回転する。ひいては、前記スプリングウォーム17に噛合しているギヤ16が回転バー14と一体に回転する。
When the phase angle of the rotating
この場合、ローラ13a又は13bに作用する上記並進力Fに起因して回転バー14に作用するトルク(以降、τaと表記する)は、上記並進力Fに対して、次式(1)の関係を有する。なお、図2に示す如く、φ0は、基準姿勢状態での回転バー14の位相角φの値、Raは、回転軸15の軸心まわりでのローラ13a,13bの軸心部の回転半径である。
In this case, the torque (hereinafter referred to as τa) acting on the rotating
τa=F・sin(φ0)・Ra ……(1)
このように回転バー14にトルクτaが作用している状況で、スプリングウォーム17は回転しないので、ギヤ16の回転によってスプリングウォーム17の一部(詳しくは、ギヤ16の噛合部分と前記電動モータ18側のバネ座部材19aとの間の部分)が伸長又は短縮され、その伸縮量に応じた弾性力をスプリングウォーム17が発生する。
τa = F ・ sin (φ0) ・ Ra (1)
Since the
この場合、スプリングウォーム17の基準状態からの伸縮量、ひいては、回転バー14の基準状態からの回転量(位相角の変化量)は、該スプリングウォーム17の弾性力(並進力)によってギヤ16に作用するトルクと、ワイヤ11の張力によってローラ13a又は13bに作用する上記並進力Fに起因して回転バー14に作用するトルク(=ギヤ16に作用するトルク)とが釣り合う状態で平衡する。この平衡状態で、駆動プーリ2に付与されるトルクτdが弾性力発生機構4を介して被動プーリ3に伝達されることとなる。
In this case, the amount of expansion and contraction of the
上記平衡状態での回転バー14の基準状態からの回転量をΔφ[rad]、ギヤ16の回転半径をRb、スプリングウォーム17の剛性(スプリングウォーム17の伸縮量の単位変化量あたりに発生する弾性力の変化量)をKsp_wとおくと、上記平衡状態でのスプリングウォーム17の弾性力によってギヤ16に作用するトルク(以降、これをτbと表記する)は、次式(2)により与えられる。
The rotation amount of the rotating
τb=Ksp_w・sin(Δφ)・Rb≒Ksp_w・Δφ・Rb ……(2)
この式(2)と前記式(1)とから、上記平衡状態における並進力Fと、回転バー14の基準状態からの回転量Δφとの関係は、次式(3)により与えられる。
τb = Ksp_w · sin (Δφ) · Rb≈Ksp_w · Δφ · Rb (2)
From this equation (2) and the above equation (1), the relationship between the translational force F in the equilibrium state and the rotation amount Δφ from the reference state of the rotating
F=(Ksp_w・Rb/(sin(φ0)・Ra)・Δφ ……(3)
従って、ワイヤ11の張力によってローラ13a又は13bに作用する並進力Fは、回転バー14の基準状態からの回転量Δφに比例するものとなる。
F = (Ksp_w · Rb / (sin (φ0) · Ra) · Δφ (3)
Therefore, the translational force F acting on the
ここで、ワイヤ11の張力によってローラ13a又は13bに作用する並進力Fは、駆動プーリ2に付与されるトルク(ひいては被動プーリ3に伝達されるトルク)が大きいほど、大きくなる。また、被動プーリ3に対する駆動プーリ2の相対回転量(基準状態からの相対回転量)は、上記平衡状態での回転バー14の基準状態からの回転量が大きいほど、大きくなる。
Here, the translational force F acting on the
従って、両プーリ2,3間の相対回転量が一定に維持される定常状態で、駆動プーリ2から被動プーリ3に伝達されるトルク(被動プーリ3に付与されるトルク)をτspと表記し、両プーリ2,3間の相対回転量をΔθと表記すると、τspとΔθとの間には、近似的に次式(4)の比例関係が成立する。
Accordingly, the torque transmitted from the
τsp=Ksp・Δθ ……(4)
よって、弾性力発生機構4は、駆動プーリ2と被動プーリ3との動力伝達を行うバネ部材として機能する。そして、上記トルクτspは、弾性力発生機構4によって両プーリ2,3間に発生する弾性力によって伝達されるトルク(以降、弾性力トルクτspという)に相当する。この場合、式(4)におけるKspは、両プーリ2,3間の相対回転量Δθ(以降、プーリ間回転角度差Δθという)の変化に対する弾性力トルクτspの変化の比率であり、以降、剛性特性係数Kspという。
τsp = Ksp · Δθ (4)
Therefore, the elastic force generation mechanism 4 functions as a spring member that transmits power between the driving
この剛性特性係数Kspは、両プーリ2,3間の剛性を示しており、Kspの値が大きいほど、両プーリ2,3間の剛性が高い(両プーリ2,3間の回転量の差が発生しにくくなる)ことを意味する。そして、本実施形態における弾性力発生機構4の剛性特性係数Kspの値は、基本的には、基準状態での回転バー14の位相角φ0に応じたものとなり、φ0が大きいほど、Kspの値が小さくなる。
The stiffness characteristic coefficient Ksp indicates the stiffness between the
また、本実施形態の弾性力発生機構4では、回転バー14が基準状態から回転するとき、スプリングウォーム17の伸縮に伴い、シリンダ19の筒部21がピストン22に対して相対的に摺動する。
Further, in the elastic force generation mechanism 4 of the present embodiment, when the
このとき、油室23a,23b間で、オリフィス部24を有する連通管25を介して粘性オイルが流通することで、筒部21の摺動に対する抵抗力となる粘性力が発生する。これにより、回転バー14の基準状態からの回転、ひいては、被動プーリ3に対する駆動プーリ2の相対回転に対する抵抗力となる粘性力が、両プーリ2,3間で発生することとなる。そして、この粘性力は、オリフィス部24の開口面積を変化させることで、変化することとなる。
At this time, when viscous oil flows between the
この場合、オリフィス部24の開口面積を一定に維持した場合にシリンダ19で発生する粘性力は、ピストン22に対する筒部21の移動速度、ひいては、スプリングウォーム17の伸縮速度に比例する。そして、スプリングウォーム17の伸縮速度は、回転バー14の回転速度にほぼ比例する。
In this case, the viscous force generated in the
また、両プーリ2,3間の相対回転量の時間的変化率、すなわち、両プーリ2,3間の相対回転速度(両プーリ2,3のそれぞれの回転角度の差)は、回転バー14の回転速度に応じたものとなり、回転バー14の回転速度が大きいほど、両プーリ2,3間の相対回転速度が大きいものとなる。
Further, the temporal change rate of the relative rotation amount between the
従って、両プーリ2,3間の相対回転速度をΔω[rad/s]と表記し、両プーリ2,3間の粘性力によって被動プーリ3に付与されるトルク(以降、粘性力トルクという)をτdpと表記すると、Δωとτdpとの間には、近似的に次式(5)の関係が成立する。
Therefore, the relative rotational speed between the
τdp=Kdp・Δω ……(5)
よって、弾性力発生機構4は、駆動プーリ2と被動プーリ3との間に粘性力を発生する機能も有する。この場合、式(5)におけるKdpは、両プーリ2,3間の相対回転速度Δω(以降、プーリ間回転速度差Δωという)の変化に対する粘性力トルクτdpの変化の比率であり、以降、粘性特性係数Kdpという。
τdp = Kdp · Δω (5)
Therefore, the elastic force generation mechanism 4 also has a function of generating a viscous force between the driving
この粘性特性係数Kdpは、両プーリ2,3間の粘性の度合を示しており、Kdpの値が大きいほど、両プーリ2,3間の粘性が高い(両プーリ2,3間に発生する粘性力が大きくなりやすい)ことを意味する。そして、本実施形態における弾性力発生機構4の粘性特性係数Kdpの値は、基本的には、オリフィス部24の開口面積に応じたものとなり、該開口面積が大きいほど、Kdpの値が小さくなる。
The viscosity characteristic coefficient Kdp indicates the degree of viscosity between the
以上が、本実施形態の動力伝達装置1の機構的な構成である。
The above is the mechanical configuration of the
本実施形態は、さらに動力伝達装置1の動作制御のための構成として、制御装置30と、駆動プーリ2の回転角度θin及び被動プーリ3の回転角度θoutをそれぞれ検出する角度検出器31,32と、剛性/粘性可変機構12の電動モータ18の回転駆動軸18aの回転角度θwを検出する角度検出器33とを備える。
In the present embodiment, as a configuration for controlling the operation of the
角度検出器31,32,33は、例えばロータリエンコーダにより構成される。そして、角度検出器31,32は、それぞれ駆動プーリ2、被動プーリ3に対向して設けられ、角度検出器33は、電動モータ18に装着されている。なお、角度検出器31,32,33は、それぞれ、ポテンショメータ等、ロータリエンコーダ以外の角度センサにより構成されていてもよい。
The
制御装置30は、CPU、RAM、ROM、インターフェース回路等を含む電子回路ユニットにより構成され、角度検出器31,32,33の出力信号(検出信号)が入力される。また、制御装置30には、駆動プーリ2から被動プーリ3への回転駆動力の伝達によって該被動プーリ3に付与されるトルク(以降、二次側トルクτという)の目標値τ_cmd(以降、二次側目標トルクτ_cmdという)と、前記剛性特性係数Kspの目標値Ksp_cmd(以降、目標剛性特性係数Kspという)と、前記粘性特性係数Kdpの目標値Kdp_dmp(以降、目標粘性特性係数Kdpという)とが外部の他の制御装置もしくはサーバ等から逐次入力される。
The
上記二次側目標トルクτ_cmd、目標剛性特性係数Ksp、及び目標粘性特性係数Kdpは、負荷部材6の所望の動作を行なうための目標値である。本実施形態では、二次側目標トルクτ_cmd及び目標粘性特性係数Kdpは、それぞれ既定の範囲内で任意に可変的に設定される目標値である。一方、目標剛性特性係数Ksp_cmdは、本実施形態では、既定の一定値(固定値)の目標値である。 The secondary target torque τ_cmd, the target stiffness characteristic coefficient Ksp, and the target viscosity characteristic coefficient Kdp are target values for performing a desired operation of the load member 6. In the present embodiment, the secondary target torque τ_cmd and the target viscosity characteristic coefficient Kdp are target values that are arbitrarily variably set within a predetermined range. On the other hand, the target stiffness characteristic coefficient Ksp_cmd is a predetermined fixed value (fixed value) target value in the present embodiment.
なお、本実施形態における目標剛性特性係数Kspは、より詳しくは、弾性力発生機構4の前記基準状態での剛性特性係数Kspの目標値である。 The target stiffness characteristic coefficient Ksp in the present embodiment is more specifically the target value of the stiffness characteristic coefficient Ksp in the reference state of the elastic force generation mechanism 4.
制御装置30は、角度検出器31,32,33から入力される検出信号と二次側目標トルクτ_cmd、目標剛性特性係数Ksp、及び目標粘性特性係数Kdpとを用いて前記電動モータ5(以降、動力源モータ5という)、弾性力発生機構4の電動モータ18(以降、剛性可変用モータ18という)及びオリフィス部24を制御するように構成されている。
The
より詳しくは、制御装置30は、実装されるプログラムを実行することにより実現される機能(ソフトウェアにより実現される機能)又はハードウェア構成により実現される機能として、実際の二次側トルクτ(観測値)を二次側目標トルクτ_cmdに追従させるように、動力源モータ5の作動制御用の制御入力を逐次決定する制御入力決定部34と、該制御入力に応じて図示しないモータドライブ回路を介して動力源モータ5の通電電流(ひいては出力トルク)を制御するモータ制御部35を備える。
More specifically, the
上記制御入力は、本実施形態では、例えば、動力源モータ5の目標トルク(出力トルクの目標値)である。ただし、上記制御入力は、動力源モータ5の目標トルクを規定できるものであればよく、該目標トルク以外のものであってもよい。例えば、該制御入力として、駆動プーリ2自体に動力源モータ5側から付与されるトルクの目標値、あるいは、動力源モータ5の通電電流の目標値等を用いることも可能である。
In the present embodiment, the control input is, for example, a target torque (target value of output torque) of the
制御入力決定部34は、詳細は後述するが、実際の二次側トルクτ(観測値)を二次側目標トルクτ_cmdに追従させるための制御入力を、スライディングモード制御の制御処理によって逐次決定する。
Although details will be described later, the control
また、モータ制御部35は、上記制御入力により規定される目標トルクを、動力源モータ5に出力させるように、動力源モータ5の通電電流を制御する。例えば、目標トルクに応じて動力源モータ5の通電電流の目標値を決定し、その通電電流の目標値に実際の通電電流(観測値)をフィードバック制御する。
Further, the
さらに、制御装置30は、その機能として、前記目標剛性特性係数Ksp_cmdに応じて剛性可変用モータ18を制御する(ひいては、両プーリ2,3間の剛性を制御する)剛性制御部36と、前記目標粘性特性係数Kdp_cmdに応じて、オリフィス部24を制御する(ひいては、両プーリ2,3間の粘性を制御する)粘性制御部37とを備える。
Further, the
剛性制御部36は、基準状態での回転バー14の位相角φを、目標剛性特性係数Ksp_cmdに対応する角度値にするための剛性可変用モータ18の回転駆動軸18aの回転角度の目標値を、Ksp_cmdから既定のマップ又は演算式により決定する。そして、剛性制御部36は、回転駆動軸18aの実際の回転角度(角度検出器33の出力により示される観測値)を、サーボ制御によって、Ksp_cmdから決定した目標値に制御する。
The
粘性制御部37は、目標粘性特性係数Kdp_cmdに対応するオリフィス部24の開口面積の目標値を、Kdp_cmdから既定のマップ又は演算式により決定する。そして、粘性制御部37は、オリフィス部24の実際の開口面積を、決定した目標値に図示しない弁機構等を介して制御する。
The
補足すると、弾性力発生機構4の剛性特性係数Kspは、基準状態での前記回転バー14の位相角φの値に応じて規定されるので、目標剛性特性係数Ksp_cmdの代わりに、回転バー14の位相角φの目標値(Ksp_cmdに対応する回転バー14の位相角φの値)、あるいは、剛性可変用モータ18の回転駆動軸18aの回転角度の目標値(Ksp_cmdに対応する回転駆動軸18aの回転角度の値)を制御装置30に入力するようにしてもよい。
Supplementally, since the stiffness characteristic coefficient Ksp of the elastic force generation mechanism 4 is defined according to the value of the phase angle φ of the
さらに、本実施形態のように、動力伝達装置1の動作時に使用する目標剛性特性係数Ksp_cmdが一定値である場合、剛性可変用モータ18及び剛性制御部36を省略し、スプリングウォーム17の一端(シリンダ19と反対側の一端)を、駆動プーリ2及び被動プーリ3等を回転自在に軸支する部材(図示省略)に固定しておくと共に、両プーリ2,3間の動力伝達を行わない状態(基準状態)での回転バー14の位相角φが、目標剛性特性係数Ksp_cmdに対応する位相角となるように、ギヤ16をスプリングウォーム17に噛合させておくようにしてもよい。この場合は、スプリングウォーム17は、ウォームギヤとしての機能を持たない単なるスプリングとして機能するものとなる。
Furthermore, when the target stiffness characteristic coefficient Ksp_cmd used during the operation of the
また、弾性力発生機構4の粘性特性係数Kdpは、前記オリフィス部24の開口面積に応じて規定されるので、目標粘性特性係数Kdp_cmdの代わりに、オリフィス部24の開口面積の目標値(Kdp_cmdに対応するオリフィス部24の開口面積の値)を制御装置30に入力するようにしてもよい。
Further, since the viscosity characteristic coefficient Kdp of the elastic force generating mechanism 4 is defined according to the opening area of the
また、二次側目標トルクτ_cmd、目標剛性特性係数Ksp、及び目標粘性特性係数Kdpは、制御装置30で逐次決定するようにしてもよい。
Further, the secondary target torque τ_cmd, the target stiffness characteristic coefficient Ksp, and the target viscosity characteristic coefficient Kdp may be sequentially determined by the
次に、制御入力決定部34における制御処理に関する基礎的な事項について説明しておく。
Next, basic matters regarding the control processing in the control
本実施形態における制御対象の系としての動力伝達装置1の挙動は、離散系において、次式(10)の状態方程式によりモデル化される。
The behavior of the
ここで、θinは駆動プーリ2の回転角度、θoutは被動プーリ3の回転角度、dθinはθinの時間的変化率(すなわち、駆動プーリ2の回転角速度)、dθoutはθoutの時間的変化率(すなわち、被動プーリ3の回転角速度)、DTは制御処理周期、Kspは前記剛性特性係数、Kdpは前記粘性特性係数、Iinは駆動プーリ2側の系(ここでは、駆動プーリ2、減速機7及び電動モータ5により構成される系)のイナーシャ(入力側イナーシャ)、Ioutは、被動プーリ3側の系(ここでは、被動プーリ3及び負荷部材6により構成される系)のイナーシャ(出力側イナーシャ)、uは駆動プーリ2側の入力トルク(例えば動力源モータ5の出力トルク)である。また、括弧付きの添え字n、n-1は、離散系の時刻を表す番数である。
Here, θin is the rotation angle of the
一方、二次側トルクτは、弾性力発生機構4により両プーリ2,3間に発生する弾性力に起因するトルク成分(すなわち、前記式(4)により表される弾性力トルクτsp)と、弾性力発生機構4により両プーリ2,3間に発生する粘性力に起因するトルク成分(すなわち、前記式(5)により表される粘性力トルクτdp)との合成トルクとなる。
On the other hand, the secondary torque τ is a torque component caused by the elastic force generated between the
従って、二次側トルクτと、その時間的変化率dτ(以降、二次側トルク変化速度dτという)とに関して、次式(11a),(11b)が成立する。 Therefore, the following expressions (11a) and (11b) are established with respect to the secondary torque τ and its temporal change rate dτ (hereinafter referred to as secondary torque change rate dτ).
τ(n)=Ksp・Δθ(n)+Kdp・Δω(n) ……(11a)
dτ(n)=Ksp・Δω(n)+Kdp・dΔω(n) ……(11b)
ただし、
Δθ(n)≡θin(n)−θout(n) ……(12a)
Δω(n)≡ωin(n)−ωout(n)=dθin(n)−dθout(n) ……(12b)
dΔω(n)≡dωin(n)−dωout(n) ……(12c)
なお、式(11b)におけるdΔωは、式(12b)により表されるプーリ間回転速度差Δω(両プーリ2,3のそれぞれの回転角速度ωin(=dθin),ωout(=dθout)の差)の時間的変化率、ただし書きの式(12c)におけるdωinは、駆動プーリ2の回転角速度ωin(=dθin)の時間的変化率(=回転角加速度)、dωoutは、被動プーリ3の回転角速度ωout(=dθout)の時間的変化率(=回転角加速度)である。
τ (n) = Ksp · Δθ (n) + Kdp · Δω (n) (11a)
dτ (n) = Ksp · Δω (n) + Kdp · dΔω (n) (11b)
However,
Δθ (n) ≡θin (n) −θout (n) (12a)
Δω (n) ≡ωin (n) −ωout (n) = dθin (n) −dθout (n) (12b)
dΔω (n) ≡dωin (n) −dωout (n) (12c)
Note that dΔω in the equation (11b) is the difference between the pulley rotation speeds Δω expressed by the expression (12b) (the difference between the rotation angular velocities ωin (= dθin) and ωout (= dθout) of the
ここで、二次側トルクτをフィードバック制御するために、該二次側トルクτと、その時間的変化率である二次側トルク変化速度dτとを計測(観測)することを考える。この場合、Δθを計測するようにすれば、Δωの計測値は、Δθの計測値の時間的変化率(微分値)として算出することができ、dΔωの計測値は、Δωの計測値の時間的変化率(微分値)として算出することができる。 Here, in order to feedback-control the secondary side torque τ, it is considered to measure (observe) the secondary side torque τ and the secondary side torque change rate dτ which is a temporal change rate thereof. In this case, if Δθ is measured, the measured value of Δω can be calculated as a temporal change rate (differential value) of the measured value of Δθ, and the measured value of dΔω is the time of the measured value of Δω. It can be calculated as a dynamic change rate (differential value).
従って、原理的には、角度検出器31,32の出力により示されるθin,θoutの計測値から得られるΔθの計測値に基づいて、前記式(11a),(11b)によりτ及びdτをそれぞれ計測することができる。
Therefore, in principle, τ and dτ are respectively expressed by the equations (11a) and (11b) based on the measured values of Δθ obtained from the measured values of θin and θout indicated by the outputs of the
ただし、この場合、Δωの計測値は、Δθの計測値の時間的変化率(微分値)として算出されるものであるので、一般に、実際の値(真値)に対して誤差が生じやすい。ひいては、このΔωの計測値の時間的変化率(微分値)として算出されるdΔωの計測値はさらに誤差が生じやすい。また、弾性力発生機構4のシリンダ19の粘性オイルの粘性は環境温度等の影響を受けやすいことから、前記式(5)における粘性特性係数Kdpの実際の値は、目標粘性特性係数Kdp_cmdに対して誤差を生じやすい。
However, in this case, since the measured value of Δω is calculated as a temporal change rate (differential value) of the measured value of Δθ, in general, an error is likely to occur with respect to an actual value (true value). As a result, the measurement value of dΔω calculated as the temporal change rate (differential value) of the measurement value of Δω is more likely to cause an error. Further, since the viscosity of the viscous oil in the
これらのことから、特に、式(11a)の右辺第2項(=粘性力トルクτdp)の計測値と、式(11b)の右辺第2項(=τdpの時間的変化率)の計測値とを精度よく取得することは困難である。ひいては、前記式(11a),(11b)をそのまま用いてτ、dτを計測しようとしても、信頼性の高い計測値を取得することは困難である。また、このようなτ、dτの計測値を用いて、実際の二次側トルクτを二次側目標トルクτ_cmdに制御しようとしても、安定性の高い制御を適切に行うことは難しい。 From these facts, in particular, the measured value of the second term (= viscous force torque τdp) of the equation (11a) and the measured value of the second term (= time change rate of τdp) of the equation (11b) It is difficult to accurately obtain As a result, even if it is going to measure (tau) and (dτ) using said Formula (11a) and (11b) as it is, it is difficult to acquire a reliable measured value. Further, even if an attempt is made to control the actual secondary torque τ to the secondary target torque τ_cmd using such measured values of τ and dτ, it is difficult to appropriately perform highly stable control.
一方、前記式(4)における剛性特性係数Kspの実際の値(前記基準状態での値)は、比較的精度よく目標剛性特性係数Ksp_cmdに制御することが可能である。従って、式(11a)の右辺第1項(=弾性力トルクτsp)の計測値と、式(11b)の右辺第1項(=τspの時間的変化率)の計測値とは、粘性力トルクτdpやその時間的変化率の計測値に比べて、精度よく取得することが可能である。また、プーリ間回転角度差Δθが一定に維持される定常状態では、粘性力トルクτdpはゼロとなるので、実際の二次側トルクτは、弾性力トルクτspに一致する。 On the other hand, the actual value of the stiffness characteristic coefficient Ksp in the equation (4) (value in the reference state) can be controlled to the target stiffness characteristic coefficient Ksp_cmd with relatively high accuracy. Therefore, the measured value of the first term (= elastic force torque τsp) of the equation (11a) and the measured value of the first term (= time change rate of τsp) of the equation (11b) are the viscous force torque. Compared to the measured value of τdp and its temporal change rate, it can be obtained with higher accuracy. Further, in a steady state where the inter-pulley rotation angle difference Δθ is kept constant, the viscous force torque τdp is zero, so the actual secondary torque τ matches the elastic force torque τsp.
そこで、本実施形態では、角度検出器31,32の出力により示されるθin、θoutの計測値の差として得られるΔθの計測値から、式(11a)の右辺の第2項を除去した次式(13a)と、式(11b)の右辺の第2項を除去した次式(13b)とに基づいて、τ、dτの計測値を取得する。
Therefore, in the present embodiment, the following equation is obtained by removing the second term on the right side of equation (11a) from the measured value of Δθ obtained as the difference between the measured values of θin and θout indicated by the outputs of the
換言すれば、両プーリ2,3間の実際の粘性力トルクτdp及びその時間的変化率dτdpがゼロであると仮定して(τ=τspであると仮定して)、τ、dτの計測値をそれぞれ、次式(13a),(13b)に基づいて取得する。
In other words, assuming that the actual viscous force torque τdp between the
τ(n)=Ksp・Δθ(n)=Ksp・(θin(n)−θout(n)) ……(13a)
dτ(n)=Ksp・Δω(n) =Ksp・(dθin(n)−dθout(n))……(13b)
なお、これらの式(13a),(13b)によりτ、dτの計測値を取得するために必要となるKspの値としては、目標剛性特性係数Ksp_cmdが使用される。
τ (n) = Ksp · Δθ (n) = Ksp · (θin (n) −θout (n)) (13a)
dτ (n) = Ksp · Δω (n) = Ksp · (dθin (n) −dθout (n)) (13b)
Note that the target stiffness characteristic coefficient Ksp_cmd is used as the value of Ksp required to obtain the measured values of τ and dτ by these equations (13a) and (13b).
そして、本実施形態では、このように取得されるτ、dτの計測値を使用しつつ、これらの計測値には反映されていない両プーリ2,3間の粘性力(弾性力発生機構4によってが発生する粘性力)による影響を補償するように、スライディングモード制御の処理を実行することで、実際の二次側トルクτを二次側目標トルクτにフィードバック制御するための制御入力を決定する。
In this embodiment, while using the measured values of τ and dτ acquired in this way, the viscous force between the
本実施形態では、スライディングモード制御の手法により制御入力を決定するための演算処理は、前記弾性力発生機構4の粘性特性係数Kdpがゼロであると仮定した場合、すなわち、両プーリ2,3間に粘性力が発生しないと仮定した場合における動力伝達装置1の挙動を表現するモデルに基づいて構築される。
In the present embodiment, the calculation process for determining the control input by the sliding mode control method assumes that the viscosity characteristic coefficient Kdp of the elastic force generation mechanism 4 is zero, that is, between the
この場合の動力伝達装置1の挙動は、前記式(10)のCin、Coutをゼロとした状態方程式、すなわち、次式(14)の状態方程式により表される。
The behavior of the
この状態方程式を、前記式(13a),(13b)を用いて整理すると、弾性力発生機構4の粘性特性係数Kdpがゼロであると仮定した場合におけるτ、dτに関する挙動を表現するモデルとして、次式(15)の状態方程式が得られる。 When this equation of state is rearranged using the above equations (13a) and (13b), as a model expressing the behavior regarding τ and dτ when the viscosity characteristic coefficient Kdp of the elastic force generation mechanism 4 is assumed to be zero. The following equation (15) is obtained.
本実施形態におけるスラディングモード制御では、この式(15)の状態方程式(モデル)を基礎として、制御入力を決定するための制御処理が構築されている。 In the sliding mode control in the present embodiment, a control process for determining a control input is constructed based on the state equation (model) of the equation (15).
さらに詳細には、本実施形態では、スライディングモード制御の制御対象の状態変数として、次式(16)で示す如く、二次側トルクτの計測値と目標二次側トルクτ_cmdとの偏差である二次側トルク偏差τ_errと、該偏差τ_errの時間的変化率(微分値)である二次側トルク偏差速度dτ_errとを2成分として構成される状態変数X(2行1列の縦ベクトル)が用いられる。なお、式(16)の上付き添え字“T”は転置を意味する。 More specifically, in this embodiment, as a state variable to be controlled in the sliding mode control, as shown by the following equation (16), the deviation between the measured value of the secondary torque τ and the target secondary torque τ_cmd. A state variable X (vertical vector of 2 rows and 1 column) composed of a secondary torque deviation τ_err and a secondary torque deviation speed dτ_err which is a temporal change rate (differential value) of the deviation τ_err is two components. Used. Note that the superscript “T” in equation (16) means transposition.
X=[τ_err,dτ_err]T ……(16)
ただし、τ_err=τ−τ_cmd、 dτ_err=τ_errの時間的変化率(微分値)
この場合、スライディングモード制御による制御入力としての動力源モータ5の目標トルクτm_cmd(制御処理周期毎に決定する新たな目標トルク)は、前記式(15)のただし書きで定義される行列A及び列ベクトルBと、次式(18)により表される切換関数σとを用いて、例えば次式(17)により決定することができる。
X = [τ_err, dτ_err] T (16)
However, τ_err = τ−τ_cmd, dτ_err = τ_err temporal change rate (differential value)
In this case, the target torque τm_cmd (new target torque determined for each control processing cycle) of the
τm_cmd(n)=−(S・B)-1・(S・A・X(n)
+Ksld・(σ(n)/(|σ(n)|+δ)))
……(17)
σ(n)=S・X(n)=s1・τ_err(n)+s2・dτ_err(n) ……(18)
ただし、S=[s1,s2] (:1行2列の行ベクトル)
この式(17),(18)が本実施形態において、制御入力としての動力源モータ5の目標トルクτm_cmdを決定するための基本式である。
τm_cmd (n) =-(S ・ B) -1・ (S ・ A ・ X (n)
+ Ksld · (σ (n) / (| σ (n) | + δ)))
...... (17)
σ (n) = S · X (n) =
However, S = [s1, s2] (: 1 row by 2 column row vector)
These formulas (17) and (18) are basic formulas for determining the target torque τm_cmd of the
この場合、式(18)のτ_err、dτ_errを算出するために必要なτ、dτの計測値は、前記したように式(13a),(13b)に基づいて取得される計測値である。 In this case, the measured values of τ and dτ necessary for calculating τ_err and dτ_err in Expression (18) are measured values acquired based on Expressions (13a) and (13b) as described above.
また、式(17)の右辺の演算に必要な行列A及び列ベクトルBの各成分は、前記式(15)のただし書きの定義式に基づいて算出される値である。A、Bの各成分を算出するために必要となる、制御処理周期DT、駆動プーリ2側のイナーシャ(入力側イナーシャ)Iin、被動プーリ3側のイナーシャ(出力側イナーシャ)Ioutの値は、本実施形態では、それぞれ、あらかじめ決定された所定値(一定値)である。
In addition, each component of the matrix A and the column vector B necessary for the calculation of the right side of the equation (17) is a value calculated based on the proviso definition equation of the equation (15). The values of the control processing period DT, the inertia on the driving
また、剛性特性係数Kspの値としては、目標剛性特性係数Ksp_cmdの値(本実施形態では一定値)が使用される。 Further, as the value of the stiffness characteristic coefficient Ksp, the value of the target stiffness characteristic coefficient Ksp_cmd (a constant value in the present embodiment) is used.
一方、Sの各成分(切換関数σを構成する係数成分)s1,s2は、後述する如く、目標粘性特性係数Kdp_cmdに応じて可変的に決定される所定値である。 On the other hand, each component of S (coefficient components constituting the switching function σ) s1, s2 is a predetermined value variably determined according to the target viscosity characteristic coefficient Kdp_cmd, as will be described later.
ここで、式(17)、(18)の技術的な意味合いについて説明すると、式(17)の右辺の第1項は、τ_err、dτ_errの値の組が、切換超平面上に存在する状態で、τ_errをゼロに収束させるように機能する制御入力成分を意味する。 Here, the technical meaning of the equations (17) and (18) will be described. The first term on the right side of the equation (17) is a state in which a pair of values of τ_err and dτ_err exists on the switching hyperplane. , Τ_err means a control input component that functions to converge to zero.
上記切換超平面は、σ=0という式により表されるものである。従って、τ_err、dτ_errを2つの座標軸成分とする位相平面における切換超平面σ=0(ここでは直線)の傾きは、Sの各成分s1,s2の比によって規定されることとなる。 The switching hyperplane is represented by the equation σ = 0. Therefore, the inclination of the switching hyperplane σ = 0 (in this case, a straight line) in the phase plane having τ_err and dτ_err as two coordinate axis components is defined by the ratio of the S components s1 and s2.
例えば図5に示すように、二次側トルク偏差速度dτ_errの座標軸を縦軸、二次側トルク偏差τ_errの座標軸を横軸とする位相平面を想定した場合、該位相平面における切換超平面σ=0(直線)の傾きは−s1/s2となる。なお、二次側トルク偏差速度dτ_errの座標軸を横軸、二次側トルク偏差τ_errの座標軸を縦軸とする位相平面を想定した場合には、該位相平面での切換超平面σ=0の傾きは、−s2/s1となる。 For example, as shown in FIG. 5, assuming a phase plane in which the coordinate axis of the secondary torque deviation speed dτ_err is the vertical axis and the coordinate axis of the secondary torque deviation τ_err is the horizontal axis, the switching hyperplane σ = The slope of 0 (straight line) is -s1 / s2. In addition, assuming a phase plane in which the coordinate axis of the secondary torque deviation speed dτ_err is the horizontal axis and the coordinate axis of the secondary torque deviation τ_err is the vertical axis, the gradient of the switching hyperplane σ = 0 in the phase plane Becomes -s2 / s1.
そして、切換超平面σ=0上では、dτ_err=(−s1/s2)・τ_errとなるので、(−s1/s2)が負の値に設定されておれば、切換超平面σ=0上でのτ_errはゼロに収束することとなる。この場合、切換超平面σ=0上でのτ_errの収束の時定数Tc(以降、収束時定数Tcという)は、次式(19)により与えられる。また、切換超平面σ=0上でのτ_errとdτ_errとの間の関係は、式(19)の収束時定数Tcを用いて、次式(20)により表される。 On the switching hyperplane σ = 0, dτ_err = (− s1 / s2) · τ_err. Therefore, if (−s1 / s2) is set to a negative value, the switching hyperplane σ = 0. Τ_err will converge to zero. In this case, the time constant Tc of convergence of τ_err on the switching hyperplane σ = 0 (hereinafter referred to as the convergence time constant Tc) is given by the following equation (19). Further, the relationship between τ_err and dτ_err on the switching hyperplane σ = 0 is expressed by the following equation (20) using the convergence time constant Tc of equation (19).
Tc=s2/s1 ……(19)
τ_err=−Tc・dτ_err ……(20)
このように切換超平面σ=0の傾き、あるいは、収束時定数Tcは、係数成分s1,s2の比により規定される。
Tc = s2 / s1 (19)
τ_err = −Tc · dτ_err (20)
Thus, the inclination of the switching hyperplane σ = 0 or the convergence time constant Tc is defined by the ratio of the coefficient components s1, s2.
補足すると、二次側トルク偏差速度dτ_errの座標軸を縦軸、二次側トルク偏差τ_errの座標軸を横軸とする位相平面を想定した場合、該位相平面における切換超平面σ=0の傾きは、−s1/s2であるので、この傾きと収束時定数Tcとの間の関係は、傾き=−1/Tcとなる。 Supplementally, assuming a phase plane in which the coordinate axis of the secondary torque deviation speed dτ_err is the vertical axis and the coordinate axis of the secondary torque deviation τ_err is the horizontal axis, the slope of the switching hyperplane σ = 0 in the phase plane is Since -s1 / s2, the relationship between the slope and the convergence time constant Tc is slope = -1 / Tc.
一方、二次側トルク偏差速度dτ_errの座標軸を横軸、二次側トルク偏差τ_errの座標軸を縦軸とする位相平面を想定した場合、該位相平面における切換超平面σ=0の傾きは、−s2/s1であるので、この傾きと収束時定数Tcとの間の関係は、傾き=−Tcとなる。
On the other hand, assuming a phase plane in which the coordinate axis of the secondary torque deviation speed dτ_err is the horizontal axis and the coordinate axis of the secondary torque deviation τ_err is the vertical axis, the gradient of the switching hyperplane σ = 0 in the phase plane is − Since
このように切換超平面σ=0の傾きと、切換超平面σ=0上での収束時定数Tcとは、1対1に対応している。従って、切換超平面σ=0の傾きを決定するということは、切換超平面σ=0上での収束時定数Tcの値を決定することと等価である。 Thus, the inclination of the switching hyperplane σ = 0 and the convergence time constant Tc on the switching hyperplane σ = 0 have a one-to-one correspondence. Therefore, determining the inclination of the switching hyperplane σ = 0 is equivalent to determining the value of the convergence time constant Tc on the switching hyperplane σ = 0.
本実施形態では、前記式(17),(18)により目標トルクτm_cmdを決定するために用いるτ、dτの計測値は、前記式(13a),(13b)に基づく計測値であるので、弾性力発生機構4により両プーリ2,3間に粘性力が発生する状況では、τ、dτの計測値は、実際の値に対して誤差を有するものとなる。
In the present embodiment, since the measured values of τ and dτ used for determining the target torque τm_cmd by the equations (17) and (18) are measured values based on the equations (13a) and (13b), the elasticity In a situation where a viscous force is generated between the
また、前記式(17)の基礎となる状態方程式(15)では、両プーリ2,3間の粘性が無視されており、前記行列Aに、弾性力発生機構4の粘性特性係数Kdpに依存する成分が含まれない。さらに、本実施形態では、弾性力発生機構4の粘性特性係数Kdpは可変的に制御される。
In the state equation (15) that is the basis of the equation (17), the viscosity between the
このため、弾性力発生機構4で粘性力が発生する状況では、仮に切換超平面σ=0の傾き(又は切換超平面σ=0上の収束時定数Tc)を、弾性力発生機構4の粘性特性係数Kdpに依存させないように設定すると、τ_errを適切な時定数で安定にゼロに収束させることができないものとなりやすい。例えば、τ_errの振動等が生じやすくなる。 Therefore, in a situation where viscous force is generated in the elastic force generating mechanism 4, suppose that the gradient of the switching hyperplane σ = 0 (or the convergence time constant Tc on the switching hyperplane σ = 0) is the viscosity of the elastic force generating mechanism 4. If it is set not to depend on the characteristic coefficient Kdp, τ_err cannot be stably converged to zero with an appropriate time constant. For example, vibration of τ_err is likely to occur.
そこで、本実施形態では、前記式(13a),(13b)に基づく計測値と、式(15)の状態方程式とに反映されていない弾性力発生機構4の粘性力(両プーリ2,3間の粘性力)の影響を補償するために、切換超平面σ=0の傾き(又は切換超平面σ=0上の収束時定数Tc)と、弾性力発生機構4の粘性特性係数Kdpの制御値(制御により実現する値)としての目標粘性特性係数Kdp_cmdとの間の相関関係をあらかじめ決定しておき、その相関関係に従って、目標粘性特性係数Kdp_cmdに応じて切換超平面σ=0の傾き(又は切換超平面σ=0上の収束時定数Tc)を可変的に決定するようにした。
Therefore, in this embodiment, the viscous force (between the
ここで、本願発明者の各種実験、検討によれば、弾性力発生機構4の剛性特性係数Kspが一定もしくはほぼ一定に保たれている場合、τ_errが安定にゼロに収束する場合におけるτ_errとdτ_errとの間の関係は、次式(21)の関係で近似される。 Here, according to various experiments and examinations by the inventors of the present application, when the stiffness characteristic coefficient Ksp of the elastic force generation mechanism 4 is kept constant or substantially constant, τ_err and dτ_err when τ_err stably converges to zero. Is approximated by the relationship of the following equation (21).
τ_err=−(a+(b・Kdp_cmd)/Ksp_cmd)・dτ_err ……(21)
そこで、本実施形態では切換超平面σ=0上でのτ_errとdτ_errとの間の関係が、式(21)の関係となるように、切換超平面σ=0上の傾き(又は切換超平面σ=0上の収束時定数Tc)を目標粘性特性係数Kdp_cmdに応じて決定する。
τ_err = − (a + (b · Kdp_cmd) / Ksp_cmd) · dτ_err (21)
Therefore, in the present embodiment, the slope on the switching hyperplane σ = 0 (or the switching hyperplane so that the relationship between τ_err and dτ_err on the switching hyperplane σ = 0 becomes the relationship of Expression (21). The convergence time constant Tc) over σ = 0 is determined according to the target viscosity characteristic coefficient Kdp_cmd.
換言すれば、切換超平面σ=0上の収束時定数Tcと、Kdp_cmdとの間の相関関係が、次式(22)により表されるように、切換超平面σ=0の傾き(又は切換超平面σ=0上の収束時定数Tc)を目標粘性特性係数Kdp_cmdに応じて決定する。 In other words, as the correlation between the convergence time constant Tc on the switching hyperplane σ = 0 and Kdp_cmd is expressed by the following equation (22), the slope (or switching) of the switching hyperplane σ = 0: The convergence time constant Tc) on the hyperplane σ = 0 is determined according to the target viscosity characteristic coefficient Kdp_cmd.
Tc=(a+(b・Kdp_cmd)/Ksp_cmd) ……(22)
式(21)及び式(22)における変数aは、弾性力発生機構4の粘性特性係数Kdpがゼロである場合(Kdp_cmd=0である場合)における切換超平面σ=0上の収束時定数Tcの値を意味する。
Tc = (a + (b · Kdp_cmd) / Ksp_cmd) (22)
The variable a in the equations (21) and (22) is the convergence time constant Tc on the switching hyperplane σ = 0 when the viscosity characteristic coefficient Kdp of the elastic force generation mechanism 4 is zero (when Kdp_cmd = 0). Means the value of
また、式(21)及び式(22)における変数bは、目標粘性特性係数Kdp_cmdに対して実際の粘性特性係数Kdpの誤差が生じやすいことから、目標粘性特性係数Kdp_cmdを、弾性力発生機構4の実際の粘性特性係数Kdpの推定値(=b・Kdp_cmd)に補正するための補正係数を意味する。 Further, since the variable b in the equations (21) and (22) is likely to cause an error in the actual viscosity characteristic coefficient Kdp with respect to the target viscosity characteristic coefficient Kdp_cmd, the target viscosity characteristic coefficient Kdp_cmd is set to the elastic force generation mechanism 4. Is a correction coefficient for correcting to an estimated value (= b · Kdp_cmd) of the actual viscosity characteristic coefficient Kdp.
ここで、粘性力トルクτdpと、弾性力トルクτspの時間的変化率dτspとの間の関係は、前記式(4),(5)によって次式(23)により表される。 Here, the relationship between the viscous force torque τdp and the temporal change rate dτsp of the elastic force torque τsp is expressed by the following equation (23) using the equations (4) and (5).
τdp=(Kdp/Ksp)・dτsp ……(23)
従って、式(21)の右辺は、弾性力発生機構4の実際の粘性特性係数Kdpがゼロである場合(両プーリ2,3間の粘性力がゼロである場合)には、実際の二次側トルクτとしての弾性力トルクτspと二次側目標トルクτ_cmdとの偏差としての意味を持つ。また、弾性力発生機構4の実際の粘性特性係数Kdpがゼロでない場合には、該弾性力トルクτspと粘性力トルクτdpとを合成してなる実際の二次側トルクτと二次側目標トルクτ_cmdとの偏差としての意味を持つ。
τdp = (Kdp / Ksp) · dτsp (23)
Therefore, the right side of the equation (21) shows the actual secondary when the actual viscosity characteristic coefficient Kdp of the elastic force generating mechanism 4 is zero (when the viscous force between the
本実施形態では、式(22)の変数a,bの値を後述するようにあらかじめ決定しておくことで、切換超平面σ=0上の収束時定数Tcと、弾性力発生機構4の目標粘性特性係数Kdp_cmdとの間の相関関係(ひいては、切換超平面σ=0の傾きとKdp_cmdとの間の相関関係)が、式(22)の関係としてあらかじめ決定されている。そして、この相関関係に基づいてKdp_cmdに応じて決定される収束時定数Tcに対応して、式(17)、(18)の演算に必要な係数成分s1,s2の値が決定される。 In this embodiment, the values of the variables a and b in the equation (22) are determined in advance as will be described later, so that the convergence time constant Tc on the switching hyperplane σ = 0 and the target of the elastic force generation mechanism 4 are obtained. The correlation between the viscosity characteristic coefficient Kdp_cmd (and hence the correlation between the inclination of the switching hyperplane σ = 0 and Kdp_cmd) is determined in advance as the relationship of Expression (22). Then, the values of the coefficient components s1, s2 necessary for the calculations of the equations (17), (18) are determined corresponding to the convergence time constant Tc determined according to Kdp_cmd based on this correlation.
この場合、s1,s2の一方の値は、定数値でよく、例えばs1=1(又はs2=1)とされる。その場合には、切換超平面σ=0の傾き(又は切換超平面σ=0上の収束時定数Tc)を決定することによって、係数成分s2(又は係数成分s1)の値が一義的に決定されることとなる。 In this case, one value of s1, s2 may be a constant value, for example, s1 = 1 (or s2 = 1). In that case, the value of the coefficient component s2 (or coefficient component s1) is uniquely determined by determining the slope of the switching hyperplane σ = 0 (or the convergence time constant Tc on the switching hyperplane σ = 0). Will be.
前記式(17)の右辺の第2項は、切換関数σの値を、ゼロに収束させる(換言すれば、τ_err、dτ_errの値の組を切換超平面σ=0上に収束させる)ように機能する制御入力成分を意味する。そして、Ksld、δは、それぞれ、切換関数σの値の収束特性を規定するパラメータである。 The second term on the right side of the equation (17) converges the value of the switching function σ to zero (in other words, converges the set of values of τ_err and dτ_err on the switching hyperplane σ = 0). Means a functioning control input component. Ksld and δ are parameters that define the convergence characteristics of the value of the switching function σ.
この場合、δは、本実施形態では、あらかじめ実験等に基づいて設定した所定値(定数値)とされる。 In this case, in this embodiment, δ is a predetermined value (constant value) set in advance based on experiments or the like.
また、Ksldの値は、例えば次のような指針で、所定値(一定値)に決定され、又は切換関数σの値に応じて決定される。 Further, the value of Ksld is determined to be a predetermined value (a constant value), for example, according to the following guidelines, or is determined according to the value of the switching function σ.
すなわち、切換関数σの値をゼロに収束させるためには、σのリアプノフ関数σ2の微分値(時間的変化率)が負の値となることが必要となる。 That is, in order to converge the value of the switching function σ to zero, the differential value (temporal change rate) of the Lyapunov function σ 2 of σ needs to be a negative value.
この必要条件は、離散系において、(σ(n))2−(σ(n-1))2<0を満たすという条件と同等である。そして、この条件と、前記式(17)、(18)とから、Ksldに関する次式(24)の条件が得られる。 This necessary condition is equivalent to the condition that (σ (n)) 2 − (σ (n−1)) 2 <0 in the discrete system. From this condition and the expressions (17) and (18), the condition of the following expression (24) regarding Ksld is obtained.
|Ksld|<|σ(n)|+δ ……(24)
従って、Ksldの値は、上記式(24)の条件を満たすように設定されていればよい。
| Ksld | <| σ (n) | + δ (24)
Therefore, the value of Ksld only needs to be set so as to satisfy the condition of the above formula (24).
本実施形態では、Ksldの値は、制御処理周期毎の切換関数σの絶対値が大きいほど、Ksldの大きさが大きくなるように、σの値に応じて可変的に決定される。 In the present embodiment, the value of Ksld is variably determined according to the value of σ so that the magnitude of Ksld increases as the absolute value of the switching function σ for each control processing cycle increases.
例えば、Ksldは、制御処理周期毎に、次式(25)で示すように、|σ(n)|に比例する値となるように決定される。 For example, Ksld is determined to be a value proportional to | σ (n) | as shown in the following equation (25) at each control processing cycle.
Ksld=(1/K0)・|σ(n)| ……(25)
式(25)のK0は、σ(n)が取り得る実際の値の範囲内で、式(24)の条件を満たすようにあらかじめ設定した定数値(例えば3以上の整数値)である。
Ksld = (1 / K0) · | σ (n) | (25)
K0 in Expression (25) is a constant value (for example, an integer value of 3 or more) set in advance so as to satisfy the condition of Expression (24) within the range of actual values that can be taken by σ (n).
なお、Ksldの値は、一定値であってもよい。また、|Ksld|<δとなるようにKsldの値を設定してもよい。 The value of Ksld may be a constant value. Alternatively, the value of Ksld may be set so that | Ksld | <δ.
次に、切換超平面σ=0の傾き(又は切換超平面σ=0上の収束時定数Tc)と、目標粘性特性係数Kdp_cmdとの間の相関関係を決定するための事前準備処理について説明する。この事前準備処理は、本実施形態では、次のような手順で行なわれる。 Next, a preparatory process for determining the correlation between the gradient of the switching hyperplane σ = 0 (or the convergence time constant Tc on the switching hyperplane σ = 0) and the target viscosity characteristic coefficient Kdp_cmd will be described. . In this embodiment, this advance preparation process is performed in the following procedure.
(手順1)まず、目標粘性特性係数Kdp_cmdのあらかじめ定めた複数の代表値のうちから選択した1つの代表値に応じて弾性力発生機構4のオリフィス部24の開口面積を制御した状態で、適宜の制御手法(例えばPD制御等)によって、動力伝達装置1の二次側トルクτを、該動力伝達装置1の種々様々な任意の初期状態から種々様々な任意の目標値(ステップ状に変化させた目標値)に収束させる制御を行う実験(もしくはシミュレーション)が行なわれる。
(Procedure 1) First, in a state in which the opening area of the
この実験では、二次側トルクτの目標値と計測値(前記式(13a)に基づく計測値)との偏差に応じて、PD制御則等の汎用的な制御則により該偏差をゼロに収束させるように動力源モータ5の出力トルクを操作する。なお、この場合、剛性可変用モータ18の回転駆動軸18aの回転角度(=スプリングウォーム17の回転角度)は、目標剛性特性係数Ksp_cmd(本実施形態では一定値)に対応する回転角度で一定に保持される。
In this experiment, according to the deviation between the target value of the secondary torque τ and the measured value (measured value based on the equation (13a)), the deviation is converged to zero by a general control law such as a PD control law. The output torque of the
また、動力源モータ5及び剛性可変用モータ18の作動制御は、適宜のコンピュータ等を使用して行なうようにすればよい。
The operation control of the
そして、上記収束制御の各実験における二次側トルク偏差τ_errの値(前記式(13a)に基づくτの計測値を用いて算出される値)及び二次側トルク偏差速度dτ_errの値(前記式(13b)に基づくdτの計測値を用いて算出される値)の組の推移(時間的な変化)が計測される。さらに、その計測データを、τ_err及びdτ_errを2つの座標軸成分とする位相平面上にプロットすることで、τ_err及びdτ_errの値の組の推移の軌跡を示す応答特性データが作成される。 Then, the value of the secondary torque deviation τ_err (the value calculated using the measured value of τ based on the equation (13a)) and the value of the secondary torque deviation speed dτ_err (the above equation) in each experiment of the convergence control. The transition (temporal change) of the pair of values calculated using the measured value of dτ based on (13b) is measured. Further, by plotting the measurement data on a phase plane having τ_err and dτ_err as two coordinate axis components, response characteristic data indicating the transition trajectory of a set of values of τ_err and dτ_err is created.
このようにして初期状態や二次側トルクτの目標値等の条件を種々様々に異ならせた複数の応答特性データ(目標粘性特性係数Kdp_cmdの選択中の代表値に対応する応答特性データ)が作成される。 In this way, a plurality of response characteristic data (response characteristic data corresponding to representative values during selection of the target viscosity characteristic coefficient Kdp_cmd) in which the conditions such as the initial state and the target value of the secondary torque τ are variously varied are obtained. Created.
このように作成された応答特性データのいくつかの代表例を図6に示した。図6中の参照符号a1〜a6を付した軌跡のそれぞれが応答特性データの例を示している。 Some typical examples of the response characteristic data created in this way are shown in FIG. Each of the trajectories marked with reference signs a1 to a6 in FIG. 6 shows an example of response characteristic data.
(手順2)次に、上記のように作成された複数の応答特性データのうちの所定の要件を満たす応答特性データが、位相平面における切換超平面σ=0の傾き(目標粘性特性係数Kdp_cmdの選択中の代表値に対応する傾き)を決定するための特定の応答特性データ(以降、傾き決定用応答特性データという)として選出される。 (Procedure 2) Next, the response characteristic data satisfying a predetermined requirement among the plurality of response characteristic data created as described above is an inclination of the switching hyperplane σ = 0 in the phase plane (the target viscosity characteristic coefficient Kdp_cmd It is selected as specific response characteristic data (hereinafter referred to as inclination determination response characteristic data) for determining (slope corresponding to the representative value being selected).
ここで選出される傾き決定用応答特性データは、該傾き決定用応答特性データにより示される軌跡上での二次側トルク偏差τ_errの値の大きさ(絶対値)が、所定の第1許容限界値τ_err_lim以下の大きさとなると共に、該軌跡上での二次側トルク偏差速度dτ_errの値の大きさ(絶対値)が、所定の第2許容限界値dτ_err_lim以下の大きさとなるという要件(以下、選出要件1という)と、τ_err,dτ_errを2つの座標軸成分とする位相平面において、τ_errの値の大きさ(絶対値)があらかじめ設定された第1設定値τ_err_aに一致するライン(当該位相平面においてτ_err=+τ_err_a又はτ_err=−τ_err_aという式により表されるライン)と、dτ_errの値の大きさ(絶対値)があらかじめ設定された第2設定値dτ_err_aに一致するライン(当該位相平面においてdτ_err=+dτ_err_a又はdτ_err=−dτ_err_aという式により表されるライン)とのうちのいずれかのラインに当該軌跡が交わるという要件(以下、選出要件2という)を満たす応答特性データである。 The inclination determination response characteristic data selected here is such that the magnitude (absolute value) of the secondary torque deviation τ_err on the locus indicated by the inclination determination response characteristic data is a predetermined first allowable limit. Requirement that the magnitude (absolute value) of the secondary torque deviation speed dτ_err on the locus is equal to or smaller than a predetermined second allowable limit value dτ_err_lim (hereinafter, (Referred to as selection requirement 1) and a line in which the magnitude (absolute value) of τ_err coincides with a preset first set value τ_err_a in the phase plane having τ_err and dτ_err as two coordinate axis components (in the phase plane) τ_err = + τ_err_a or τ_err = −τ_err_a) and a line in which the magnitude (absolute value) of dτ_err matches a preset second setting value dτ_err_a (in the phase plane) The response characteristic data satisfying the requirement that the trajectory intersects one of the lines (hereinafter, referred to as selection requirement 2) of dτ_err = + dτ_err_a or dτ_err = −dτ_err_a).
上記選出要件1は、換言すれば、応答特性データにより示される軌跡上の任意の点におけるτ_err及びdτ_errの値が、−τ_err_lim≦τ_err≦+τ_err_lim、且つ、−τ_err_lim≦dτ_err≦dτ_err_limという条件を満たすという要件である。
In other words, the
また、上記選出要件2は、換言すれば、応答特性データにより示される軌跡上に|τ_err|=|τ_err_a|又は|dτ_err|=|dτ_err_a|となる点が少なくとも1つ存在するという要件である。
The
手順2では、具体的には、まず、前記選出要件1に関する第1許容限界値τ_err_lim(>0)及び第2許容限界値dτ_err_lim(>0)が決定される。(手順2−1)。
Specifically, in the
第1許容限界値τ_err_limは、二次側トルク偏差τ_errの値の大きさの許容限界値を意味し、第2許容限界値dτ_err_limは、二次側トルク偏差速度dτ_errの値の大きさの許容限界値を意味する。。 The first allowable limit value τ_err_lim means the allowable limit value of the value of the secondary torque deviation τ_err, and the second allowable limit value dτ_err_lim is the allowable limit of the value of the secondary torque deviation speed dτ_err. Mean value. .
ここで、τ_errの大きさが大き過ぎると、該τ_errをゼロに収束させるように動力源モータ5の出力トルクを制御しようとしたときに、駆動プーリ2(一次側要素)の回転角速度又は回転角加速度がそれぞれの許容限界値を超えてしまう場合がある。上記第1許容限界値τ_err_limは、駆動プーリ2(一次側要素)の回転角速度及び回転角加速度がそれぞれの許容限界値を超えることがないようにするためのτ_errの大きさの限界値である。
Here, if the magnitude of τ_err is too large, the rotational angular velocity or the rotational angle of the drive pulley 2 (primary element) when the output torque of the
なお、駆動プーリ2の回転角速度及び回転角加速度のそれぞれの許容限界値は、動力源モータ5の能力、あるいは、動力伝達装置1の機構的な制約等の条件下であらあじめ設計的に定められる値である。その値は、実際の許容限界に対してある程度のマージンを見込んだものであってもよい。
The permissible limit values of the rotational angular velocity and the rotational angular acceleration of the
本実施形態では、第1許容限界値τ_err_limは、駆動プーリ2の回転角速度の許容限界値ω1_lim(以降、一次側速度限界値ω1_limという)と、駆動プーリ2の回転角加速度の許容限界値dω1_lim(以降、一次側加速度限界値dω1_limという)と、弾性力発生機構4の剛性特性係数Kspとに応じて次のように決定されている。 In the present embodiment, the first permissible limit value τ_err_lim includes the permissible limit value ω1_lim of the rotational angular velocity of the drive pulley 2 (hereinafter referred to as the primary side speed limit value ω1_lim) and the permissible limit value dω1_lim of the rotational angular acceleration of the drive pulley 2 ( Hereinafter, it is determined as follows according to the primary acceleration limit value dω1_lim) and the stiffness characteristic coefficient Ksp of the elastic force generation mechanism 4.
二次側トルク偏差τ_errがある値τ_err_0(≠0)となっている初期状態からτ_errをゼロに収束させる場合に必要なプーリ間回転角度差Δθの変化量は、τ_err_0/Kspである。 The amount of change in the inter-pulley rotation angle difference Δθ required to converge τ_err to zero from the initial state where the secondary torque deviation τ_err is a certain value τ_err_0 (≠ 0) is τ_err_0 / Ksp.
ここで、図7(c)に示すように、プーリ間回転角度差をτ_err_0/Kspだけ変化させるのに要する時間をtaとおく。そして、例えば図7(a)に示すように、時間taの前半期間(0からta/2までの期間)で、一次側加速度限界値dω1_limの大きさを有する正の向きの回転角加速度で駆動プーリ2を増速させるように被動プーリ3に対して相対回転させ、続いて、時間taの後半期間(ta/2からtaまでの期間)で、一次側加速度限界値dω1_limの大きさを有する負の向きの回転角加速度で駆動プーリ2を減速させるように被動プーリ3に対して相対回転させる場合を想定する。
Here, as shown in FIG. 7C, the time required to change the inter-pulley rotation angle difference by τ_err — 0 / Ksp is set to ta. Then, for example, as shown in FIG. 7A, in the first half period (period from 0 to ta / 2) of the time ta, driving is performed with a positive rotational angular acceleration having the magnitude of the primary acceleration limit value dω1_lim. The
換言すれば、一次側加速度限界値dω1_limの大きさの回転角加速度で駆動プーリ2の回転角速度の増速及び減速を順次行なって、駆動プーリ2をτ_err_0/Kspの回転角度だけ被動プーリ3に対して相対回転させると共に、被動プーリ3に対する駆動プーリ2の相対的な回転角度がτ_err_0/Kspに達した時に、被動プーリ3に対する駆動プーリ2の相対回転を停止させる場合を想定する。
In other words, the rotational angular velocity of the driving
この場合、τ_err_0/Kspとdω1_limとtaとの間の関係は、次式(26)により表される。 In this case, the relationship among τ_err_0 / Ksp, dω1_lim, and ta is expressed by the following equation (26).
(1/4)・dω1_lim・ta2=τ_err_0/Ksp ……(26)
そして、この場合の駆動プーリ2の最大の回転角速度は、図7(b)に示す如く、(1/2)・dω1_lim・taであるから、次式(27)の条件が成立する必要がある。
(1/4) · dω1_lim · ta 2 = τ_err_0 / Ksp (26)
In this case, the maximum rotational angular velocity of the
(1/2)・dω1_lim・ta≦ω1_lim ……(27)
上記式(26)及び式(27)から、τ_err_0の大きさ(絶対値)に関する次式(28)の条件が得られる。
(1/2) ・ dω1_lim ・ ta ≦ ω1_lim (27)
From the above equations (26) and (27), the condition of the following equation (28) regarding the magnitude (absolute value) of τ_err_0 is obtained.
|τ_err_0|≦(ω1_lim2/dω1_lim)・Ksp ……(28)
そこで、本実施形態では、二次側トルク偏差τ_errの値の大きさの許容限界値である第1許容限界値τ_err_limを、次式(29)により決定した。
| Τ_err_0 | ≦ (ω1_lim 2 / dω1_lim) · Ksp (28)
Therefore, in the present embodiment, the first allowable limit value τ_err_lim, which is the allowable limit value of the value of the secondary torque deviation τ_err, is determined by the following equation (29).
τ_err_lim=(ω1_lim2/dω1_lim)・Ksp ……(29)
この場合、Kspの値としては、目標剛性特性係数Ksp_cmd(本実施形態ではあらかじめ定めれた一定値)が用いられる。
τ_err_lim = (ω1_lim 2 / dω1_lim) · Ksp (29)
In this case, the target stiffness characteristic coefficient Ksp_cmd (a constant value determined in advance in the present embodiment) is used as the value of Ksp.
このように決定されるτ_err_limは、剛性特性係数Kspが大きいほど、大きな値になる。なお、τ_err_limは、式(29)により決定される値よりも若干小さい値であってもよい。 Τ_err_lim determined in this way becomes a larger value as the stiffness characteristic coefficient Ksp is larger. Note that τ_err_lim may be a value slightly smaller than the value determined by Expression (29).
また、二次側トルク偏差速度dτ_errの大きさが大き過ぎると、二次側トルク偏差τ_errをゼロに収束させるように電動モータ5の出力トルクを制御しようとしたときに、電動モータ5から被動プーリ3への動力伝達系の固有振動に起因する共振現象によって、該動力伝達系の発振が発生しやすくなる。前記第2許容限界値dτ_err_limは、かかる発振の発生を防止するようにするためのdτ_errの大きさの限界値である。
Further, if the secondary torque deviation speed dτ_err is too large, the driven pulley from the
この場合、電動モータ5から被動プーリ3への動力伝達系の固有振動数(角周波数の次元での固有振動数)をω_vbとおくと、この固有振動数ω_vbで駆動プーリ2の回転角度が被動プーリ3に対して相対的に振動したときの二次側トルク変化速度dτ_vbは、次式(30)により与えられる。
In this case, if the natural frequency of the power transmission system from the
dτ_vb=Ksp・ωvb ……(30)
そこで、本実施形態では、二次側トルク偏差速度dτ_errの値の大きさの許容限界値である第2許容限界値dτ_err_limを、次式(31)により決定した。
dτ_vb = Ksp · ωvb (30)
Therefore, in the present embodiment, the second allowable limit value dτ_err_lim, which is the allowable limit value of the magnitude of the secondary torque deviation speed dτ_err, is determined by the following equation (31).
dτ_err_lim=Ksp・ωvb ……(31)
このように決定されるdτ_err_limは、剛性特性係数Kspが大きいほど、大きな値になる。
dτ_err_lim = Ksp · ωvb (31)
The dτ_err_lim determined in this way becomes a larger value as the stiffness characteristic coefficient Ksp is larger.
この場合、式(31)の右辺の演算に用いるKspの値としては、目標剛性特性係数Ksp_cmd(本実施形態ではあらかじめ定めれた一定値)が用いられる。 In this case, the target stiffness characteristic coefficient Ksp_cmd (predetermined constant value in the present embodiment) is used as the value of Ksp used for the calculation of the right side of Expression (31).
また、固有振動数ωvbの値は、例えば実験及び測定に基づいて特定することができる。あるいは、ωvbの値を、次式(32)により近似的に決定してもよい。 The value of the natural frequency ωvb can be specified based on, for example, experiments and measurements. Alternatively, the value of ωvb may be approximately determined by the following equation (32).
ωvb=sqrt((Ksp/(Iin+Iout)) ……(32)
上式(32)におけるsqrt( )は、平方根関数である。また、Iin,Ioutはそれぞれ、前記式(10)に示した駆動プーリ2側の系のイナーシャ、被動プーリ3側の系のイナーシャである。
ωvb = sqrt ((Ksp / (Iin + Iout)) (32)
In the above equation (32), sqrt () is a square root function. Further, Iin and Iout are the inertia of the system on the side of the driving
なお、第2許容限界値dτ_err_limは、式(31)により決定される値よりも若干小さい値に決定するようにしてもよい。 Note that the second allowable limit value dτ_err_lim may be determined to be slightly smaller than the value determined by the equation (31).
図6の位相平面において、第1許容限界値τ_err_limにより規定される正側及び負側のライン(τ_err=+τ_err_limという式及びτ_err=−τ_err_limという式によりそれぞれ示されるライン)の例が、ラインL1p,L1nであり、第2許容限界値dτ_err_limにより規定される正側及び負側のライン(dτ_err=+dτ_err_limという式及びdτ_err=−dτ_err_limという式によりそれぞれ示されるライン)の例が、ラインL2p,L2nである。 In the phase plane of FIG. 6, examples of positive and negative lines defined by the first allowable limit value τ_err_lim (lines indicated by the expression τ_err = + τ_err_lim and τ_err = −τ_err_lim, respectively) are shown as lines L1p, Examples of positive and negative lines defined by the second allowable limit value dτ_err_lim (lines indicated by dτ_err = + dτ_err_lim and dτ_err = −dτ_err_lim, respectively) are lines L2p and L2n. .
手順2では、次に、前記選出要件2に関する第1設定値τ_err_a(>0)及び第2設定値dτ_err_a(>0)が決定される(手順2−2)。
In the
第1設定値τ_err_aは、ゼロと第1許容限界値τ_err_limとの間の値(0<τ_err_a<τ_err_limとなる値)で、ゼロに近づき過ぎないように、第1許容限界値τ_err_limに応じて決定される。例えば、τ_err_aは、τ_err_limのMa1倍の値(=Ma1・τ_err_lim)に決定される。ただし、Ma1は、1よりも小さい正の定数で、例えば0.25〜0.75程度の範囲内の値である。 The first set value τ_err_a is a value between zero and the first allowable limit value τ_err_lim (a value satisfying 0 <τ_err_a <τ_err_lim) and is determined according to the first allowable limit value τ_err_lim so as not to approach zero. Is done. For example, τ_err_a is determined to be a value Ma1 times τ_err_lim (= Ma1 · τ_err_lim). However, Ma1 is a positive constant smaller than 1, for example, a value in the range of about 0.25 to 0.75.
同様に、第2設定値dτ_err_aは、ゼロと第2許容限界値dτ_err_limとの間の値(0<dτ_err_a<dτ_err_limとなる値)で、ゼロに近づき過ぎないように、第2許容限界値dτ_err_limに応じて決定される。例えば、dτ_err_aは、dτ_err_limのMa2倍の値(=Ma2・dτ_err_lim)に決定される。ただし、Ma2は、1よりも小さい正の定数で、例えば1/4〜1/6程度の範囲内の値である。 Similarly, the second set value dτ_err_a is a value between zero and the second allowable limit value dτ_err_lim (a value satisfying 0 <dτ_err_a <dτ_err_lim), and is set to the second allowable limit value dτ_err_lim so as not to approach zero. Will be decided accordingly. For example, dτ_err_a is determined to be a value Ma2 times dτ_err_lim (= Ma2 · dτ_err_lim). However, Ma2 is a positive constant smaller than 1, for example, a value within a range of about 1/4 to 1/6.
図6の位相平面において、第1設定値τ_err_aより規定される正側及び負側のライン(τ_err=+τ_err_aという式及びτ_err=−τ_err_aという式によりそれぞれ示されるライン)の例が、ラインLL1p,LL1nであり、第2設定値dτ_err_a(dτ_err=+dτ_err_aという式及びdτ_err=−dτ_err_aという式によりそれぞれ示されるライン)の例が、ラインLL2p,LL2nである。 In the phase plane of FIG. 6, examples of positive and negative lines defined by the first set value τ_err_a (lines indicated by the expressions τ_err = + τ_err_a and τ_err = −τ_err_a, respectively) are shown as lines LL1p and LL1n. Examples of the second set value dτ_err_a (lines indicated by an expression dτ_err = + dτ_err_a and an expression dτ_err = −dτ_err_a, respectively) are lines LL2p and LL2n.
手順2では、次に、上記の如く決定した第1許容限界値τ_err_lim及び第2許容限界値dτ_err_limと、第1設定値τ_err_a及び第2設定値dτ_err_aとを用いて、前記選出要件1、2を満たす傾き決定用応答特性データが選出される(手順2−3)。
In the
例えば図6に示す例では、参照符号a1〜a6を付した応答特性データは、いずれも選出要件1を満たす。一方、参照符号a1〜a5を付した応答特性データは、選出要件2を満たすものの、参照符号a6を付した応答特性データは、選出要件2を満たさない。
For example, in the example shown in FIG. 6, the response characteristic data given the reference signs a1 to a6 satisfy the
従って、a6の応答特性データを除く応答特性データ(a1〜a5の応答特性データ)が傾き決定用応答特性データとして選出される。 Accordingly, response characteristic data (response characteristic data of a1 to a5) excluding the response characteristic data of a6 is selected as the response characteristic data for determining the inclination.
以上のようにして、手順2では傾き決定用応答特性データが選出される。
As described above, in the
(手順3)次に、上記のように選出された傾き決定用応答特性データの軌跡と、第1設定値τ_err_a及び第2設定値dτ_err_aによりそれぞれ示されるラインLL1p,LL1n,LL2p,LL2nとの交点のうち、該交点に関する所定の要求条件(以下、交点要求条件という)を満たす交点を用いて切換超平面σ=0の傾きが決定される。 (Procedure 3) Next, the intersection of the trajectory of the response characteristics data for slope determination selected as described above and the lines LL1p, LL1n, LL2p, LL2n indicated by the first set value τ_err_a and the second set value dτ_err_a, respectively. Among them, the inclination of the switching hyperplane σ = 0 is determined using an intersection satisfying a predetermined requirement condition for the intersection (hereinafter referred to as an intersection requirement condition).
上記交点要求条件は、当該交点と、位相平面の原点(τ_err=0,dτ_err=0となる点)とを結ぶラインの傾きが、あらかじめ定められた傾き要求範囲内にあるという条件である。 The intersection requirement condition is a condition that the slope of a line connecting the intersection and the origin of the phase plane (point where τ_err = 0, dτ_err = 0) is within a predetermined slope requirement range.
ここで、切換超平面σ=0の傾きと切換超平面σ=0上の収束時定数Tcとは1対1に対応するので、上記傾き要求範囲は、切換超平面σ=0上の収束時定数Tcの要求範囲に対応する切換超平面σ=0の傾きの要求範囲である。 Here, since the inclination of the switching hyperplane σ = 0 and the convergence time constant Tc on the switching hyperplane σ = 0 correspond one-to-one, the required inclination range is the time of convergence on the switching hyperplane σ = 0. This is the required range of the inclination of the switching hyperplane σ = 0 corresponding to the required range of the constant Tc.
動力伝達装置1における二次側トルクτを目標値(目標二次側トルクτ_cmd)に制御するシステムを構築する場合、通常、二次側トルクτの目標値への収束(τ_errのゼロへの収束)の時定数である収束時定数Tcをどの程度の範囲内の値にしたいという設計的な要求(目標)がある。従って、上記傾き要求範囲は、一例として、収束時定数Tcの値の設計的な要求範囲に対応させて設定される。
When constructing a system for controlling the secondary torque τ in the
例えば、収束時定数Tcの値の設計的な要求範囲がTc_L≦Tc≦Tc_Hという範囲であるとし、また、切換超平面σ=0の傾きと収束時定数Tcとの間の関係が、傾き=−1/Tcという関係であるとした場合、傾き要求範囲は、−(1/Tc_L)≦傾き≦−(1/Tc_H)という範囲として設定すればよい。また、切換超平面σ=0の傾きと収束時定数Tcとの間の関係が、傾き=−Tcという関係であるとした場合には、傾き要求範囲は、−Tc_H≦傾き≦−Tc_Lという範囲として設定すればよい。 For example, the design requirement range of the value of the convergence time constant Tc is a range of Tc_L ≦ Tc ≦ Tc_H, and the relationship between the gradient of the switching hyperplane σ = 0 and the convergence time constant Tc is If the relationship is −1 / Tc, the required tilt range may be set as a range of − (1 / Tc_L) ≦ slope ≦ − (1 / Tc_H). When the relationship between the gradient of the switching hyperplane σ = 0 and the convergence time constant Tc is a relationship of gradient = −Tc, the required gradient range is a range of −Tc_H ≦ tilt ≦ −Tc_L. Can be set as
ただし、駆動プーリ2の回転角加速度は、前記一次側加速度限界値dω1_lim以下の大きさに制限する必要があるので、収束時定数Tcの値を無制限に小さくすることはできない。
However, since the rotational angular acceleration of the
本実施形態では、二次側トルク偏差τ_errの大きさが、前記第1許容限界値τ_err_limに一致する初期状態から、駆動プーリ2に動力源モータ5から付与するトルクを、許容限界の最大の大きさのトルクとして、被動プーリ3に対する駆動プーリ2の相対回転速度の増速及び減速を順次行うことで、τ_errをゼロに収束させた場合に実現可能な最短の収束時定数Tcとしての特定収束時定数Tcxがあらかじめ決定されている。この場合、特定収束時定数Tcxは、前記手順1で選択する目標粘性特性係数Kdp_cmdの各代表値毎にあらかじめ決定されている。
In the present embodiment, the torque applied from the
そして、手順3では、切換超平面σ=0上の収束時定数Tcが、上記特定収束時定数Tcx以上であること(Tc≧Tcxであること)を制約条件(以下、時定数制約条件という)として、この時定数制約条件を満たす範囲で、切換超平面σ=0の傾き要求範囲を設定される。
In
上記特定収束時定数Tcxは、次のように決定される。 The specific convergence time constant Tcx is determined as follows.
両プーリ2,3間に粘性力が発生しない状態(Kdp=0であると仮定した状態)で、二次側トルク偏差τ_errの大きさが前記第1許容限界値τ_err_limに一致する初期状態から、図7(a)〜(c)に示したように、被動プーリ3に対する駆動プーリ2の回転角速度の増速及び減速を同じ時間づつ行うことで、τ_errをゼロに収束させた場合を想定する。そして、この場合にτ_errを第1許容限界値τ_err_limからゼロに収束させるまでに要する時間である収束必要時間taをtax0、その収束必要時間tax0に対応する収束時定数TcをTcx0とおく。
From the initial state where the magnitude of the secondary torque deviation τ_err matches the first allowable limit value τ_err_lim in a state where no viscous force is generated between the
なお、この場合において、駆動プーリ2の回転角速度を増速させる期間で駆動プーリ2に付与するトルクの大きさと、該回転角速度を減速させる期間で駆動プーリ2に付与するトルクの大きさとは、動力源モータ5から駆動プーリ2に付与し得る許容最大限の大きさのトルクとされる。
In this case, the magnitude of the torque applied to the
上記収束必要時間tax0と収束時定数Tcx0との間の関係は、近似的に、次式(33)により表される。 The relationship between the convergence required time tax0 and the convergence time constant Tcx0 is approximately expressed by the following equation (33).
Tcx0=tax0/3 ……(33)
そして、tax0は、前記式(26)におけるτ_err_0にτ_err_limを代入したときのtaの値であるから、次式(34)が成立する。
Tcx0 = tax0 / 3 (33)
Since tax0 is the value of ta when τ_err_lim is substituted for τ_err_0 in the above equation (26), the following equation (34) is established.
(1/4)・dω1_lim・tax02=τ_err_lim/Ksp ……(34)
上記式(33)、(34)から、次式(35)が得られる。
(1/4) · dω1_lim · tax0 2 = τ_err_lim / Ksp (34)
From the above equations (33) and (34), the following equation (35) is obtained.
Tcx0=(2/3)・sqrt((τ_err_lim/dω1_lim)/Ksp) ……(35)
次に、両プーリ2,3間に粘性力が発生する状態(Kdp≠0である状態)で、二次側トルク偏差τ_errの大きさが前記第1許容限界値τ_err_limに一致する初期状態から、被動プーリ3に対する駆動プーリ2の回転角速度の増速、及び減速を順次行うことで、τ_errをゼロに収束させた場合を想定する。
Tcx0 = (2/3) · sqrt ((τ_err_lim / dω1_lim) / Ksp) (35)
Next, in a state where a viscous force is generated between the
なお、この場合においても、駆動プーリ2の回転角速度を増速させる期間で駆動プーリ2に付与するトルクの大きさと、該回転角速度を減速させる期間で駆動プーリ2に付与するトルクの大きさとは、動力源モータ5から駆動プーリ2に付与し得る許容最大限の大きさのトルクとされる。
Even in this case, the magnitude of the torque applied to the
この場合、仮に、駆動プーリ2の回転角速度を増速させる期間の時間と、該回転角速度を減速させる期間の時間とを、tax0の半分の時間にした場合には、図7(a)〜(c)に破線で示すように駆動プーリ2の回転角加速度、回転角速度、プーリ間回転角度差が変化することとなるので、tax0の時間内でτ_errをゼロに収束させることはできない。
In this case, if the time period during which the rotational angular velocity of the
ただし、両プーリ2,3間に粘性力がさほど大きくならない状態(Kdpが比較的小さい状態)では、図7(a),(b)に二点鎖線でしめすように、駆動プーリ2の回転角速度を増速させる期間の時間をtax0/2よりも増やすことで、tax0の時間内でτ_errをゼロに収束させることが可能である。
However, in a state where the viscous force between the
他方、両プーリ2,3間に粘性力が比較的大きなものとなる状態(Kdpが比較的小さい状態)では、tax0の時間内では、τ_errをゼロに収束させるができない場合がある。
On the other hand, in a state where the viscous force between the
そこで、本実施形態では、目標粘性特性係数Kdp_cmdの各代表値に対して、前記式(34)により規定される収束必要時間tax0の期間内で、τ_errを第1許容限界値τ_err_limからゼロに収束させることが可能である場合には、式(35)により算出される収束時定数Tcx0を、当該代表値に対応する前記特定時定数Tcxとして決定する。 Therefore, in this embodiment, for each representative value of the target viscosity characteristic coefficient Kdp_cmd, τ_err is converged from the first allowable limit value τ_err_lim to zero within the convergence required time tax0 defined by the above equation (34). If it is possible, the convergence time constant Tcx0 calculated by the equation (35) is determined as the specific time constant Tcx corresponding to the representative value.
また、目標粘性特性係数Kdp_cmdの各代表値に対して、前記式(34)により規定される収束必要時間tax0の期間内で、τ_errを第1許容限界値τ_err_limからゼロに収束させることができない場合には、τ_errを第1許容限界値τ_err_limからゼロに収束させることが可能な収束必要時間tax(>tax0)を決定し、その収束必要時間taxに対応する収束時定数Tc(=tax/3)を前記特定時定数Tcxとして決定する。 Further, for each representative value of the target viscosity characteristic coefficient Kdp_cmd, τ_err cannot be converged from the first allowable limit value τ_err_lim to zero within the convergence required time tax0 defined by the above equation (34). Includes determining a required convergence time tax (> tax0) that allows τ_err to converge to zero from the first allowable limit value τ_err_lim, and a convergence time constant Tc (= tax / 3) corresponding to the required convergence time tax. Is determined as the specific time constant Tcx.
この場合、前記式(34)により規定される収束必要時間tax0の期間内で、τ_errを第1許容限界値τ_err_limからゼロに収束させることが可能であるか否かは、次のように判断される。 In this case, whether or not it is possible to converge τ_err from the first allowable limit value τ_err_lim within the period of the convergence required time tax0 defined by the equation (34) is determined as follows. The
駆動プーリ2に動力源モータ5から許容最大限の大きさのトルクτ1_maxを付与した状態を想定する。このとき、被動プーリ3に対する駆動プーリ2の相対的な回転運動に関して、次式(36)の動力学的関係(離散系での関係)が成立する。
Assume a state in which a torque τ1_max having a maximum allowable magnitude is applied to the
I・dΔω(n)=τ1_max−Kdp・Δω(n-1) ……(36)
なお、Iは、駆動プーリ2を含む回転系のイナーシャ、Δωは、前記式(12b)により定義される如く、被動プーリ3に対する駆動プーリ2の相対的な回転角速度、dΔωは前記式(12c)により定義される如く、被動プーリ3に対する駆動プーリ2の相対的な回転角加速度(=Δωの時間的変化率)である。そして、式(36)の右辺第2項が、粘性力トルクτdpを表している。
I · dΔω (n) = τ1_max−Kdp · Δω (n-1) (36)
Here, I is the inertia of the rotating system including the driving
この式(36)から、次式(37)が得られる。 From this equation (36), the following equation (37) is obtained.
dΔω(n)=dΔω_max−Mu・Δω(n-1) ……(37)
ただし、
dΔω_max≡τ1_max/I
Mu≡Kdp/I
なお、dΔω_maxは、前記一次側加速度限界値dω1_limに一致する。
dΔω (n) = dΔω_max−Mu · Δω (n−1) (37)
However,
dΔω_max≡τ1_max / I
Mu≡Kdp / I
Note that dΔω_max coincides with the primary acceleration limit value dω1_lim.
また、被動プーリ3に対する駆動プーリ2の相対的な回転角速度Δωと、被動プーリ3に対する駆動プーリ2の相対的な回転角度Δθ(すなわち、前記プーリ間回転角度差Δθ)とに関して、それぞれ、次式(38)、(39)の漸化式が成立する。
Further, regarding the relative rotational angular velocity Δω of the driving
Δω(n)=Δω(n-1)+DT・dΔω(n) ……(38)
Δθ(n)=Δθ(n-1)+DT・Δω(n) ……(39)
式(37)と式(38)とから、次式(40)が得られる。
Δω (n) = Δω (n-1) + DT · dΔω (n) (38)
Δθ (n) = Δθ (n-1) + DT · Δω (n) (39)
From Expression (37) and Expression (38), the following Expression (40) is obtained.
Δω(n)=(dΔω_max/Mu)・(1−Edpn)+Edpn・Δω(0) ……(40)
ただし、Edp≡1−DT・Mu
さらに、この式(40)と、式(39)とから、次式(41)が得られる。
Δω (n) = (dΔω_max / Mu) · (1-Edp n) + Edp n · Δω (0) ...... (40)
However, Edp≡1-DT · Mu
Furthermore, the following equation (41) is obtained from the equation (40) and the equation (39).
Δθ(n)=Δθ(0)
+(dΔω_max/Mu)・n・DT
+DT・(Δω(0)−(dΔω_max/Mu))・Edp・(1−Edpn)/(1−Edp)
……(41)
ここで、Δω(0)=0、Δθ(0)=0である場合において、初期時刻0から、N1・DTの時間の期間でdΔω_maxの回転角加速度で駆動プーリ2を被動プーリ3に対して相対回転させ、続いて、N2・DTの時間の期間で−dΔω_max回転角加速度で駆動プーリ2を被動プーリ3に対して相対回転させた場合を想定する。なお、N1、N2は、ある整数値である。
Δθ (n) = Δθ (0)
+ (DΔω_max / Mu) · n · DT
+ DT · (Δω (0) - (dΔω_max / Mu)) · Edp · (1-Edp n) / (1-Edp)
...... (41)
Here, when Δω (0) = 0 and Δθ (0) = 0, the driving
この場合、N1・DT+N2・DTの時間の期間の経過時におけるΔθ(=Δθ(N1+N2))は、上記式(40),(41)によって次式(42)により与えられる。 In this case, Δθ (= Δθ (N1 + N2)) when the time period N1 · DT + N2 · DT elapses is given by the following equation (42) by the above equations (40) and (41).
Δθ(N1+N2)=(dΔω_max/Mu)・N1・DT
−DT・(dΔω_max/Mu)・Edp・(1−EdpN1)/(1−Edp)
−(dΔω_max/Mu)・N2・DT
+DT・(dΔω_max/Mu)・(2−EdpN1)・Edp・(1−EdpN2)/(1−Edp)
……(42)
ここで、(N1+N2)・DT=tax0となり、且つ、Δθ(N1+N2)=τ_err_lim/Kspとなれば、前記式(34)により規定される収束必要時間tax0の期間で、τ_errが第1許容限界値τ_err_limからゼロに収束することとなる。また、dΔω_max=dω1_limであるから、前記式(34)によって、次式(43)が得られる。
Δθ (N1 + N2) = (dΔω_max / Mu) ・ N1 ・ DT
−DT · (dΔω_max / Mu) · Edp · (1-Edp N1 ) / (1-Edp)
-(DΔω_max / Mu) ・ N2 ・ DT
+ DT · (dΔω_max / Mu) · (2-Edp N1 ) · Edp · (1-Edp N2 ) / (1-Edp)
...... (42)
Here, when (N1 + N2) · DT = tax0 and Δθ (N1 + N2) = τ_err_lim / Ksp, τ_err is the first allowable limit value during the convergence required time tax0 defined by the above equation (34). It will converge from τ_err_lim to zero. Since dΔω_max = dω1_lim, the following equation (43) is obtained from the equation (34).
τ_err_lim/Ksp=(1/4)・dΔω_max・tax02 ……(43)
従って、前記式(34)により規定される収束必要時間tax0の期間で、τ_errを第1許容限界値τ_err_limからゼロに収束させることができるようにするための条件は、次式(44)が成立するようなN1(<tax0/DT)が存在することである。
τ_err_lim / Ksp = (1/4) · dΔω_max · tax0 2 (43)
Accordingly, the following equation (44) is satisfied as a condition for allowing τ_err to converge from the first allowable limit value τ_err_lim to zero during the convergence required time tax0 defined by the equation (34). N1 (<tax0 / DT) exists.
(1/Mu)・N1・DT−DT・(1/Mu)・Edp・(1−EdpN1)/(1−Edp)
−(1/Mu)・(N−N1)・DT
+DT・(1/Mu)・(2−EdpN1)・Edp・(1−EdpN-N1)/(1−Edp)
=(1/4)・tax02 ……(44)
そこで、本実施形態では、目標粘性特性係数Kdp_cmdの各代表値に対応する特定収束時定数Tcxを決定するにあたって、前記式(34)により規定される収束必要時間tax0の期間内で、τ_errを第1許容限界値τ_err_limからゼロに収束させることが可能であるか否かの判断は、目標粘性特性係数Kdp_cmdの各代表値と式(43)により規定される収束必要時間tax0とを用いて、式(44)が成立するようなN1が存在するか否かを判断することによって行われる。
(1 / Mu) ・ N1 ・ DT-DT ・ (1 / Mu) ・ Edp ・ (1-Edp N1 ) / (1-Edp)
-(1 / Mu) / (N-N1) / DT
+ DT ・ (1 / Mu) ・ (2-Edp N1 ) ・ Edp ・ (1-Edp N-N1 ) / (1-Edp)
= (1/4) · tax0 2 …… (44)
Therefore, in the present embodiment, when determining the specific convergence time constant Tcx corresponding to each representative value of the target viscosity characteristic coefficient Kdp_cmd, τ_err is set to the first value within the period of the convergence required time tax0 defined by the equation (34). Judgment as to whether or not it is possible to converge from one allowable limit value τ_err_lim to zero is made by using each representative value of the target viscosity characteristic coefficient Kdp_cmd and the necessary convergence time tax0 defined by the equation (43). This is done by determining whether or not there is N1 that satisfies (44).
すなわち、目標粘性特性係数Kdp_cmdのある1つの代表値に対して、式(44)が成立するようなN1が存在する場合には、収束必要時間tax0の期間内で、τ_errを第1許容限界値τ_err_limからゼロに収束させることが可能であると判断される。そして、この場合には、収束必要時間tax0に対応して、前記式(35)により決定される収束時定数Tcx0が目標粘性特性係数Kdp_cmdの当該一つ代表値に対応する前記特定時定数Tcx0として決定される。 That is, if there is N1 such that Equation (44) holds for one representative value of the target viscosity characteristic coefficient Kdp_cmd, τ_err is set to the first allowable limit value within the period of convergence required time tax0. It is determined that τ_err_lim can be converged to zero. In this case, the convergence time constant Tcx0 determined by the equation (35) corresponding to the convergence required time tax0 is set as the specific time constant Tcx0 corresponding to the one representative value of the target viscosity characteristic coefficient Kdp_cmd. It is determined.
また、目標粘性特性係数Kdp_cmdのある1つの代表値に対して、式(44)が成立するようなN1が存在しない場合には、収束必要時間tax0の期間内で、τ_errを第1許容限界値τ_err_limからゼロに収束させることができないと判断される。そして、この場合には、式(44)における収束必要時間tax0を未知数tax0’で置き換えた式が成立するN1が存在するようなtax0’を探索的に決定する。この場合、tax0’は、式(34)により収束必要時間tax0よりも長い時間の範囲内で、可能な限り短い時間に決定される。 Further, if there is no N1 that satisfies the formula (44) for one representative value of the target viscosity characteristic coefficient Kdp_cmd, τ_err is set to the first allowable limit value within the period of convergence required time tax0. It is determined that τ_err_lim cannot be converged to zero. In this case, tax0 'is determined in an exploratory manner such that there exists N1 in which the formula obtained by replacing the convergence required time tax0 in formula (44) with the unknown number tax0' exists. In this case, tax0 'is determined to be as short as possible within the time range longer than the convergence required time tax0 according to the equation (34).
そして、このように決定したtax0’を目標粘性特性係数Kdp_cmdの当該一つ代表値に対応する収束必要時間として、この収束必要時間tax0’に対応する収束時定数(=tax’/3)が特定収束時定数Tcxとして決定される。 Then, with tax0 ′ determined in this way as the necessary convergence time corresponding to the one representative value of the target viscosity characteristic coefficient Kdp_cmd, the convergence time constant (= tax ′ / 3) corresponding to the necessary convergence time tax0 ′ is specified. It is determined as the convergence time constant Tcx.
本実施形態では、切換超平面σ=0上での収束時定数Tcが、目標粘性特性係数Kdp_cmdの各代表値毎に上記の如く決定した特定時定数Tcx以上であること(Tc≧Tcxであること)を前記時定数制約条件として、この時定数制約条件を満たす範囲で、目標粘性特性係数Kdp_cmdの各代表値毎の切換超平面σ=0の傾き要求範囲が設定されている。 In this embodiment, the convergence time constant Tc on the switching hyperplane σ = 0 is not less than the specific time constant Tcx determined as described above for each representative value of the target viscosity characteristic coefficient Kdp_cmd (Tc ≧ Tcx). )) Is set as the time constant constraint condition, and the tilt required range of the switching hyperplane σ = 0 for each representative value of the target viscosity characteristic coefficient Kdp_cmd is set within the range satisfying the time constant constraint condition.
この場合、収束時定数Tcの値の設計的な要求範囲の下限値Tc_Lが上記時定数制約条件を満たしている場合(Tc_L≧Tcxである場合)には、切換超平面σ=0の傾き要求範囲は、Tc_L≦Tc≦Tc_Hという収束時定数Tcの要求範囲に対応する範囲に設定される。例えば、切換超平面σ=0の傾きと収束時定数Tcとの間の関係が、傾き=−1/Tcという関係であるとした場合、傾き要求範囲は、−(1/Tc_L)≦傾き≦−(1/Tc_H)という範囲として設定される。 In this case, when the lower limit value Tc_L of the design requirement range of the value of the convergence time constant Tc satisfies the time constant constraint condition (when Tc_L ≧ Tcx), the inclination hyperplane σ = 0 is requested. The range is set to a range corresponding to the required range of the convergence time constant Tc such that Tc_L ≦ Tc ≦ Tc_H. For example, if the relationship between the gradient of the switching hyperplane σ = 0 and the convergence time constant Tc is the relationship of gradient = −1 / Tc, the required gradient range is − (1 / Tc_L) ≦ tilt ≦ It is set as a range of − (1 / Tc_H).
また、収束時定数Tcの値の設計的な要求範囲の下限値Tc_Lが上記時定数制約条件を満たしていない場合(Tc_L<Tcxである場合)には、切換超平面σ=0の傾き要求範囲は、Tcx≦Tc≦Tc_Hという時定数Tcの要求範囲に対応する範囲に設定される。例えば、切換超平面σ=0の傾きと時定数Tcとの間の関係が、傾き=−1/Tcという関係であるとした場合、傾き要求範囲は、−(1/Tcx)≦傾き≦−(1/Tc_H)という範囲として設定される。 Further, when the lower limit value Tc_L of the design requirement range of the convergence time constant Tc does not satisfy the time constant constraint condition (when Tc_L <Tcx), the inclination requirement range of the switching hyperplane σ = 0. Is set to a range corresponding to the required range of the time constant Tc, Tcx ≦ Tc ≦ Tc_H. For example, when the relationship between the inclination of the switching hyperplane σ = 0 and the time constant Tc is the relationship of inclination = −1 / Tc, the required inclination range is − (1 / Tcx) ≦ inclination ≦ −. It is set as a range of (1 / Tc_H).
手順3における前記交点要求条件は、前記交点と、位相平面の原点とを結ぶラインの傾きが、前記手順1で選択した目標粘性特性係数Kdp_cmdの一つの代表値に対応して、上記の如くあらかじめ定められた傾き要求範囲内にあるという条件である。
The intersection requirement condition in the
図6の位相平面において、二点鎖線で示すラインLb_max,Lb_minがそれぞれ、上記の如く設定されている傾き要求範囲における最大の大きさの傾きのライン、最小の大きさの傾きのラインの例を示している。この場合、図6の位相平面では、傾き=−1/Tcという関係が成立するので、ラインLb_maxの傾きの大きさは、1/max(Tc_L,Tcx)、ラインLb_minの傾きの大きさは、1/Tc_Hである。 In the phase plane of FIG. 6, the lines Lb_max and Lb_min indicated by the two-dot chain lines are examples of the maximum inclination line and the minimum inclination line in the inclination required range set as described above, respectively. Show. In this case, since the relationship of slope = −1 / Tc is established in the phase plane of FIG. 6, the magnitude of the slope of the line Lb_max is 1 / max (Tc_L, Tcx), and the magnitude of the slope of the line Lb_min is 1 / Tc_H.
手順3では、この傾き要求範囲により規定される前記交点要求条件を満たす交点が抽出される。例えば、図6に示す例では、図6の破線枠部Aの拡大図としての図8(a)に示す白丸の交点と、図6の破線枠部Bの拡大図としての図8(b)に示す白丸の交点とが、前記交点要求条件を満たす交点として抽出される。
In
そして、これらの抽出された複数の交点におけるτ_err及びdτ_errの値の組を用いて、各交点と原点とを結ぶラインの傾きに極力一致もしくは近似する傾きが最小自乗法により算出され、その算出された傾きが、目標粘性特性係数Kdp_cmdの選択中の代表値に対応する切換超平面σ=0の適切な傾きとして決定される。 Then, using the set of values of τ_err and dτ_err at the plurality of extracted intersections, an inclination that matches or approximates the inclination of the line connecting each intersection and the origin as much as possible is calculated by the method of least squares. Is determined as an appropriate inclination of the switching hyperplane σ = 0 corresponding to the representative value being selected for the target viscosity characteristic coefficient Kdp_cmd.
例えば図6に示す例では、図中の一点鎖線で示すラインLcの傾きが切換超平面σ=0の適切な傾きとして決定される。 For example, in the example shown in FIG. 6, the slope of the line Lc indicated by the alternate long and short dash line in the figure is determined as an appropriate slope of the switching hyperplane σ = 0.
なお、切換超平面σ=0の傾きを最小二乗法以外の統計的な同定手法により決定するようにしてもよい。例えば、前記交点要求条件を満たす各交点と原点とを結ぶラインの傾きの平均値を、切換超平面σ=0の傾きとして決定するようにしてもよい。 Note that the gradient of the switching hyperplane σ = 0 may be determined by a statistical identification method other than the method of least squares. For example, the average value of the slopes of the lines connecting the intersections satisfying the intersection requirement condition and the origin may be determined as the slope of the switching hyperplane σ = 0.
また、手順3では、切換超平面σ=0の傾きに対応する収束時定数Tc(目標粘性特性係数Kdp_cmdの各代表値に対応する収束時定数Tc)を決定するようにしてもよい。
In
以上説明した手順1〜手順3の処理が、目標粘性特性係数Kdp_cmdの全ての代表値のそれぞれについて実行される。これにより、目標粘性特性係数Kdp_cmdの全ての代表値のそれぞれに対応する切換超平面σ=0の適切な傾き(又は切換超平面σ=0上の適切な収束時定数Tc)が決定される。
The processes of
(手順4)次に、目標粘性特性係数Kdp_cmdの各代表値と、該代表値に対応して以上の如く決定された切換超平面σ=0の傾きに対応する収束時定数Tcとの組(当該代表値の個数分の組)を用いて、例えば最小二乗法の手法によって、前記式(22)の相関関係における変数a,bの値を決定する。これにより、目標粘性特性係数Kdp_cmdと、切換超平面σ=0上の収束時定数Tcとの間の相関関係、ひいては、目標粘性特性係数Kdp_cmdと、切換超平面σ=0の傾きとの間の相関関係が最終的に決定されることとなる。 (Procedure 4) Next, a set of each representative value of the target viscosity characteristic coefficient Kdp_cmd and a convergence time constant Tc corresponding to the inclination of the switching hyperplane σ = 0 determined as described above corresponding to the representative value ( The values of the variables a and b in the correlation of the equation (22) are determined by using, for example, the least square method, using the number of sets of representative values. As a result, the correlation between the target viscosity characteristic coefficient Kdp_cmd and the convergence time constant Tc on the switching hyperplane σ = 0, and hence, between the target viscosity characteristic coefficient Kdp_cmd and the inclination of the switching hyperplane σ = 0. The correlation is finally determined.
以上が、切換超平面σ=0の傾き(又は切換超平面σ=0上の収束時定数Tc)と、目標粘性特性係数Kdp_cmdとの間の相関関係を決定するための事前準備処理である。 The preparatory process for determining the correlation between the gradient of the switching hyperplane σ = 0 (or the convergence time constant Tc on the switching hyperplane σ = 0) and the target viscosity characteristic coefficient Kdp_cmd has been described above.
なお、本実施形態では、手順3における交点要求条件を規定する傾き要求範囲を、前記時定数制約条件を反映させて設定しておくようにしたが、該傾き要求範囲は、時定数制約条件を考慮せずに、単に収束時定数Tcの設計的な要求範囲に応じて決定しておくようにしてもよい。
In the present embodiment, the inclination requirement range that defines the intersection requirement condition in
その場合、この傾き要求範囲により規定される交点要求条件を満たす交点に基づいて、上記と同様に、最小二乗法等の手法により暫定的に切換超平面σ=0の傾きを決定する。そして、その暫定的な傾きにより規定される収束時定数Tcの値が時定数制約条件を満たしている場合には、その暫定的な傾きをそのまま切換超平面σ=0の傾きとして決定するようにしてもよい。 In that case, the inclination of the switching hyperplane σ = 0 is tentatively determined by a method such as the least square method based on the intersection satisfying the intersection requirement condition defined by this inclination requirement range. When the value of the convergence time constant Tc defined by the provisional inclination satisfies the time constant constraint condition, the provisional inclination is determined as it is as the inclination of the switching hyperplane σ = 0. May be.
また、暫定的な傾きにより規定される収束時定数Tcの値が時定数制約条件を満たしていない場合に、時定数制約条件を前記した如く反映させた傾き要求範囲により規定される交点要求条件を満たす交点だけを用いて、切換超平面σ=0の傾きを決定するようにしてもよい。 In addition, when the value of the convergence time constant Tc defined by the provisional inclination does not satisfy the time constant restriction condition, the intersection requirement condition defined by the inclination requirement range reflecting the time constant restriction condition as described above is set. The inclination of the switching hyperplane σ = 0 may be determined using only the intersections that satisfy the condition.
次に、動力伝達装置1の二次側トルクτを二次側目標トルクτ_cmdに追従させるように動力源モータ5の出力トルクを制御するときの制御装置30の作動を説明する。
Next, the operation of the
なお、以降の説明では、任意の状態量(角度、トルク等)の実際の値、又はその観測値(計測値又は推定値)を示す参照符号に添え字“_act”を付する。 In the following description, the subscript “_act” is attached to a reference sign indicating an actual value of an arbitrary state quantity (angle, torque, etc.) or an observed value (measured value or estimated value).
本実施形態では、制御装置30は、制御入力決定部34により図9のブロック線図で示す処理を実行することによって、制御入力としての動力源モータ5の目標トルクτm_cmdを逐次決定する。
In the present embodiment, the
制御装置30の各制御処理周期において、制御入力決定部34には、角度検出器31,32の出力信号によりそれぞれ示される駆動プーリ2の実際の回転角度θin_act(計測値)と、被動プーリ3の実際の回転角度θout_act(計測値)とが逐次入力されると共に、目標二次側トルクτ_cmdが逐次入力される。
In each control processing cycle of the
なお、この状況において、剛性可変用モータ18の回転駆動軸18aの実際の回転角度θw_act(ひいては、前記基準状態での回転バー14の位相角φ)は、目標剛性特性係数Ksp_cmd(本実施形態では一定値)に対応する所定の回転角度に制御され、この状態で、回転駆動軸18aの回転が停止されている。
In this situation, the actual rotation angle θw_act of the
そして、制御入力決定部34は、二次側トルク計測部34fによって、現在の制御処理周期でのθin_act、θout_actの値(今回値)と、弾性力発生機構4の実際の剛性特性係数Kspの値としての目標剛性特性係数Ksp_cmdの値とを用いて前記式(13a)の右辺の演算を行なうことで、実際の二次側トルクτ_actの計測値(推定値)を算出する。
Then, the control
なお、目標剛性特性係数Ksp_cmdの値は、本実施形態では一定値であるので、図示しないメモリにあらかじめ記憶保持しておいてもよい。 Note that since the value of the target stiffness characteristic coefficient Ksp_cmd is a constant value in the present embodiment, it may be stored in advance in a memory (not shown).
また、制御入力決定部34は、入力された目標二次側トルクτ_cmd(今回値)にローパスフィルタ34bの出力値を演算部34aで加算することで、τ_cmdを補正する。以降、この補正後のτ_cmdを補正後目標二次側トルクτ_cmd_cという。
The control
この補正は、二次側トルクτ_act(計測値)に含まれるオフセット成分(定常誤差成分)の影響を補償するための補正である。この場合、ローパスフィルタ34bには、演算部34cの演算結果の出力値が逐次入力される。
This correction is a correction for compensating for the influence of the offset component (steady error component) included in the secondary torque τ_act (measured value). In this case, the output value of the calculation result of the
該演算部34cは、前回の制御処理周期で前記演算部34aで算出された補正後目標二次側トルクτ_cmd_cの値(前回値)と、今回の制御処理周期で二次側トルク計測部34fによって算出された二次側トルクτ_actの計測値(今回値)の差を算出する。
The
そして、ローパスフィルタ34bは、該演算部34cの演算結果の出力値にローパス特性のフィルタリング処理を施すことで、上記オフセット成分を抽出し、このオフセット成分を前記演算部34aに出力する。
Then, the low-
次いで、制御入力決定部34は、演算部34aにより算出した補正後目標二次側トルクτ_cmd_cの値(今回値)と、二次側トルク計測部34fによって算出した二次側トルクτ_actの計測値(今回値)との偏差を、実際の二次側トルク偏差τ_err_actとして演算部34dにより算出する。
Next, the control
そして、制御入力決定部34は、この二次側トルク偏差τ_err_actをスライディングモード制御処理部34eに逐次入力する。
Then, the control
このスライディングモード制御処理部34eは、切換超平面σ=0の傾き(又は切換超平面σ=0上の収束時定数Tc)を決定する切換超平面可変設定部34gとしての機能を含んでいる。このため、スライディングモード制御処理部34eには、二次側トルク偏差τ_errに加えて、目標粘性特性係数Kdp_cmdが逐次入力される。
The sliding mode
そして、スライディングモード制御処理部34eの切換超平面可変設定部34gは、入力された目標粘性特性係数Kdp_cmd(今回値)を用いて、前記式(22)の右辺の演算を実行することで、現在の目標粘性特性係数Kdp_cmdに対応する収束時定数Tcを決定する。さらに、切換超平面可変設定部34gは、収束時定数Tcに対応する切換超平面σ=0の傾きを決定する。
Then, the switching hyperplane
切換超平面可変設定部34gは、さらに、切換関数σの前記係数成分s1,s2の値を決定される。具体的には、切換超平面σ=0に対応する収束時定数Tcに対して、前記式(19)の関係(Tc=s2/s1という関係)が満たされるように、s1,s2の値が決定される。この場合、s1,s2のうちの一方の値は、任意の定数値(例えば1)でよい。従って、例えば、s1=1、s2=Tc、あるいは、s1=1/Tc、s2=1とされる。
The switching hyperplane
スライディングモード制御処理部34eは、前記式(18)に従って、切換関数σの値を算出し、さらにこの切換関数σの算出値を用いて前記式(17)の右辺の演算を行なうことで、制御入力としての動力源モータ5の目標トルクτm_cmdを逐次算出する。
The sliding mode
この場合、式(18)の演算に必要な二次側トルク偏差dτ_errの値は、演算部34dから入力されるτ_err_actであり、二次側トルク偏差速度dτ_errの値は、τ_err_actの時間的変化率として算出される値である。また、係数成分s1,s2の値は、切換超平面可変設定部34gにより上記の如く決定された値である。
In this case, the value of the secondary torque deviation dτ_err necessary for the calculation of Expression (18) is τ_err_act input from the
また、式(17)の演算に必要な行列A、及び列ベクトルBの各成分は、前記式(15)のただし書きの定義式に基づいて決定された値である。これらの値は、本実施形態で、一定値であるので、図示しないメモリにあらかじめ記憶保持されている。 Further, each component of the matrix A and the column vector B necessary for the calculation of the equation (17) is a value determined based on the proviso definition equation of the equation (15). Since these values are constant values in the present embodiment, they are stored and held in advance in a memory (not shown).
さらに、式(17)の演算に必要なKsldの値は、本実施形態では、前記式(25)により切換関数σの算出値に応じて決定される。また、δの値は、あらかじめ決定された定数値であり、図示しないメモリに記憶保持されている。 Further, in this embodiment, the value of Ksld necessary for the calculation of Expression (17) is determined according to the calculated value of the switching function σ by Expression (25). The value of δ is a constant value determined in advance and is stored and held in a memory (not shown).
制御入力決定部34は、以上の処理によって、動力源モータ5の目標トルクτm_cmd(制御入力)を逐次決定する。
The control
なお、二次側トルクτ_actに含まれるオフセット成分(定常誤差成分)が十分に微小である場合には、演算部34a,34c及びローパスフィルタ34bを省略し、τ_cmdをそのまま演算部34dに入力するようにしてもよい。
When the offset component (steady error component) included in the secondary torque τ_act is sufficiently small, the
制御装置30は、以上の如く制御入力決定部34で逐次決定される目標トルクτm_cmdをモータ制御部35に入力し、該モータ制御部35の処理を実行する。このモータ制御部35は、入力された目標トルクτm_cmdに応じて動力源モータ5の図示しない電機子巻線の通電電流の指令値(目標値)を決定し、その指令値に実際の通電電流を一致させるように該電機子巻線の通電電流をフィードバック制御する。
The
これにより、動力源モータ5の実際の出力トルクが目標トルクτm_cmdに制御される。ひいては、実際の二次側トルクτ_actが目標二次側トルクτ_cmdに追従するように制御される。
Thereby, the actual output torque of the
以上説明した第1実施形態によれば、制御装置30の制御入力決定部34は、制御入力(動力源モータ5の目標トルクτm_cmd)をスライディグモード制御の手法により決定するために用いる二次側トルクτの計測値を、二次側トルク計測部34fによって、前記式(13a)に基づいて逐次取得する。この計測値は、弾性力発生機構4で発生する弾性力によるトルク(弾性力トルクτsp)の計測値に相当するものであるので、駆動プーリ2と被動プーリ3との間の相対回転Δθの計測値から高い信頼性で取得することができる。
According to the first embodiment described above, the control
この場合、二次側トルクτの計測値及びその時間的変化率には、弾性力発生機構4で発生する粘性力によるトルク成分が含まれないこととなるものの、スライディングモード制御用の切換超平面σ=0の傾き(又は切換超平面σ=0上の収束時定数Tc)が、弾性力発生機構4の粘性特性係数Kdpの制御値としての目標粘性特性係数Kdp_cmdに応じて可変的に決定される。 In this case, the measured value of the secondary side torque τ and the temporal change rate thereof do not include the torque component due to the viscous force generated by the elastic force generating mechanism 4, but the switching hyperplane for sliding mode control. The slope of σ = 0 (or the convergence time constant Tc on the switching hyperplane σ = 0) is variably determined according to the target viscosity characteristic coefficient Kdp_cmd as the control value of the viscosity characteristic coefficient Kdp of the elastic force generation mechanism 4. The
このため、弾性力発生機構4の粘性特性係数の制御状態によらずに、弾性力発生機構4で発生する粘性力による影響を適切に補償して、二次側トルクτの計測値の振動等が発生するのを抑制しつつ、実際の二次側トルクτを、高いロバスト性で、安定に二次側目標トルクτ_cmdに収束させるようにすることができる。 For this reason, regardless of the control state of the viscosity characteristic coefficient of the elastic force generating mechanism 4, the influence of the viscous force generated by the elastic force generating mechanism 4 is appropriately compensated for, and the vibration of the measured value of the secondary torque τ, etc. It is possible to stably converge the actual secondary torque τ to the secondary target torque τ_cmd with high robustness while suppressing the occurrence of.
また、スライディングモード制御用の切換超平面σ=0の傾き(又は収束時定数Tc)と、目標粘性特性係数Kdp_cmdとの相関関係が、Kdp_cmdの複数の代表値のそれぞれ毎に、PD制御則等の汎用的な制御手法を用いて作成した複数の応答特性データのうち、前記選出要件1,2を満たす傾き決定用応答特性データを用いて決定されている。
Further, the correlation between the gradient of the switching hyperplane σ = 0 for sliding mode control (or the convergence time constant Tc) and the target viscosity characteristic coefficient Kdp_cmd is determined for each of a plurality of representative values of Kdp_cmd, and so on. Among the plurality of response characteristic data created by using the general-purpose control method, the inclination determination response characteristic data satisfying the
この場合、傾き決定用応答特性データは、前記選出要件1を満たすことで、駆動プーリ2の回転角加速度及び回転角速度の大きさが、それぞれの許容限界値である一次側加速度限界値dω1_lim、及び一次側速度限界値ω1_limを超えないという条件を満たし得る適切なデータである。
In this case, the response characteristic data for determining the inclination satisfy the
また、応答特性データの軌跡は、位相平面の原点付近の領域で、振動を生じるものとなることが多々あるものの、傾き決定用応答特性データは、前記選出要件2を満たすことで、ゼロ近辺の微小な大きさではない二次側トルク偏差τ_err及び二次側トルク偏差速度dτ_errの値の組を含むデータである。
In addition, the response characteristic data trajectory often causes vibration in the region near the origin of the phase plane. However, the response characteristic data for tilt determination satisfies the
そして、τ_errの値の大きさが前記第1設定値τ_err_aとなるラインLL1p,LL1nと、dτ_errの値の大きさが前記第2設定値dτ_err_aとなるラインLL2p,LL2nとのうちのいずれかと、前記選出要件1、2を満たす傾き決定用応答特性データの軌跡との交点のうち、前記収束時定数Tcの要求範囲に対応する前記交点要求条件を満たす交点に基づいて、最小二乗法等の手法によって、切換超平面σ=0の傾き(又は収束時定数Tc)が決定される。
The line LL1p, LL1n where the value of τ_err is the first set value τ_err_a and the line LL2p, LL2n where the value of dτ_err is the second set value dτ_err_a; Based on the intersection satisfying the intersection requirement condition corresponding to the required range of the convergence time constant Tc among the intersection points with the trajectory of the response characteristic data for slope determination satisfying the
この場合、当該交点における二次側トルク偏差τ_errの値の大きさ(=第1設定値τ_err_a)は、前記第1許容限界値τ_err_limよりも小さく、且つ、ゼロに近づき過ぎないある程度の大きさを有する。同様に、当該交点における二次側トルク偏差速度dτ_errの値の大きさ(=第2設定値τ_err_a)は、前記第2許容限界値dτ_err_limよりも小さく、且つ、ゼロに近づき過ぎないある程度の大きさを有する。 In this case, the magnitude of the value of the secondary torque deviation τ_err (= first set value τ_err_a) at the intersection is smaller than the first allowable limit value τ_err_lim and has a magnitude that is not too close to zero. Have. Similarly, the magnitude of the value of the secondary torque deviation speed dτ_err (= second set value τ_err_a) at the intersection is smaller than the second allowable limit value dτ_err_lim, and is a certain level that does not approach zero too much. Have
しかも、当該交点は、前記交点要求条件を満たすので、収束時定数Tcに関する設計的な要求及び前記時定数制約条件を満たす。 In addition, since the intersection satisfies the intersection requirement condition, it satisfies the design requirement regarding the convergence time constant Tc and the time constant constraint condition.
従って、目標粘性特性係数Kdp_cmdの各代表値毎の切換超平面σ=0の傾きの決定に用いられる交点は、二次側トルク偏差τ_errを好適にゼロに収束させ得る応答特性データの軌跡上の点として、信頼性及び安定性の高いものとなる。このため、当該交点を用いて目標粘性特性係数Kdp_cmdの各代表値毎の切換超平面σ=0の傾きを決定することで、二次側トルク偏差τ_errを好適にゼロに収束させ得るように該傾きが決定されることとなる。 Therefore, the intersection used to determine the inclination of the switching hyperplane σ = 0 for each representative value of the target viscosity characteristic coefficient Kdp_cmd is on the trajectory of the response characteristic data that can suitably converge the secondary torque deviation τ_err to zero. As a point, it becomes a thing with high reliability and stability. Therefore, by determining the slope of the switching hyperplane σ = 0 for each representative value of the target viscosity characteristic coefficient Kdp_cmd using the intersection point, the secondary torque deviation τ_err can be suitably converged to zero. The inclination will be determined.
そして、弾性力発生機構4の目標粘性特性係数Kdpの各代表値と、そのそれぞれに対応して決定した切換超平面σ=0の傾き(又は切換超平面σ=0上の収束時定数Tc)とに基づいて、粘性特性係数Kdpと、切換超平面σ=0の傾き(又は切換超平面σ=0上の収束時定数Tc)との間の相関関係(本実施形態では、前記式(22)により表される相関関係)が特定される。 Each representative value of the target viscosity characteristic coefficient Kdp of the elastic force generating mechanism 4 and the inclination of the switching hyperplane σ = 0 determined corresponding to each value (or the convergence time constant Tc on the switching hyperplane σ = 0) Based on the above, the correlation between the viscosity characteristic coefficient Kdp and the gradient of the switching hyperplane σ = 0 (or the convergence time constant Tc on the switching hyperplane σ = 0) (in the present embodiment, the equation (22) ) Is specified.
このため、上記相関関係を、動力伝達装置1の実際の挙動特性に即して好適に特定しておくことができる。
For this reason, the said correlation can be specified suitably according to the actual behavior characteristic of the
また、応答特性データは、汎用的な制御手法を用いて得るようにすればよいので、多数の応答特性データを効率よく容易に収集することができる。ひいては、目標粘性特性係数Kdp_cmdの各代表値毎の好適な切換超平面σ=0の傾きを特定し、さらに、粘性特性係数Kdpと切換超平面σ=0の傾き(又は切換超平面σ=0上の収束時定数Tc)との間の好適な相関関係を特定することを効率よく行うことができる。 In addition, since response characteristic data may be obtained using a general-purpose control method, a large number of response characteristic data can be collected efficiently and easily. Consequently, a suitable gradient of the switching hyperplane σ = 0 for each representative value of the target viscosity characteristic coefficient Kdp_cmd is specified, and further, the gradient of the viscosity characteristic coefficient Kdp and the switching hyperplane σ = 0 (or the switching hyperplane σ = 0). It is possible to efficiently identify a suitable correlation with the above convergence time constant Tc).
そして、制御装置30の制御入力決定部34の処理では、上記のように特定された相関関係に基づいて、切換超平面σ=0の傾き(ひいては、係数成分s1、s2の値)を決定する。そして、制御入力決定部34は、その傾きに対応して規定される切換関数σを用いてスライディングモード制御の処理(前記式(17)の演算処理)により制御入力(電動モータ5の目標トルクτm_cmd)を決定する。
In the process of the control
このため、二次側トルクτの制御を所要の収束特性と高いロバスト性とで行うことを、弾性力発生機構4の粘性特性係数の制御状態によらずに好適に実現することができる。 For this reason, it is possible to suitably realize the control of the secondary side torque τ with the required convergence characteristic and high robustness regardless of the control state of the viscosity characteristic coefficient of the elastic force generating mechanism 4.
特に、本実施形態では切換超平面σ=0の傾き(又は切換超平面σ=0上の収束時定数Tc)が前記時定数制約条件を満たすように設定されているので、動力伝達装置1の幅広い動作領域で、二次側トルクτの制御を高いロバスト性で安定に行なうことができる。 In particular, in this embodiment, the gradient of the switching hyperplane σ = 0 (or the convergence time constant Tc on the switching hyperplane σ = 0) is set so as to satisfy the time constant constraint condition. The secondary torque τ can be stably controlled with high robustness in a wide operating range.
ここで、以上説明した第1実施形態と本願発明との対応関係について補足しておく。第1実施形態は、前記第1発明、第2発明、第4〜第7発明、及び第11発明に関連する実施形態である。この場合、前記駆動プーリ2、被動プーリ3、弾性力発生機構4、電動モータ5がそれぞれ本発明における一次側要素、二次側要素、弾性力発生機構、アクチュエータに相当する。そして、駆動プーリ2の回転が、本発明における一次側要素の変位に相当し、二次側トルクτが、本発明における二次側動力に相当し、剛性特性係数Kspが本発明における剛性特性係数に相当し、粘性特性係数Kdpが本発明における粘性特性係数に相当する。
Here, the correspondence relationship between the first embodiment described above and the present invention will be supplemented. The first embodiment is an embodiment related to the first invention, the second invention, the fourth to seventh inventions, and the eleventh invention. In this case, the
また、制御装置30の制御入力決定部34、二次側トルク計測部34f、切換超平面可変設定部34gがそれぞれ、本発明における制御入力決定手段、二次側動力計測手段、切換超平面可変設定手段に相当する。
Further, the control
また、前記二次側トルク偏差τ_err、二次側トルク偏差速度dτ_errがそれぞれの本発明における第1変数成分、第2変数成分に相当する。また、本実施形態における第1許容限界値τ_err_lim、第2許容限界値dτ_err_lim、第1設定値τ_err_a、第2設定値dτ_err_aが、それぞれ、本発明における第1許容限界値、第2許容限界値、第1設定値、第2設定値に相当する。 The secondary torque deviation τ_err and the secondary torque deviation speed dτ_err correspond to the first variable component and the second variable component in the present invention, respectively. Also, the first allowable limit value τ_err_lim, the second allowable limit value dτ_err_lim, the first set value τ_err_a, and the second set value dτ_err_a in the present embodiment are respectively the first allowable limit value, the second allowable limit value, This corresponds to the first set value and the second set value.
さらに、ラインLL1p,LL1nが本発明における第1設定値ラインに相当し、ラインLL2p,LL2nが本発明における第2設定値ラインに相当する。さらに、前記特定時定数Tcxが、本発明における特定時定数に相当する。 Furthermore, the lines LL1p and LL1n correspond to the first set value line in the present invention, and the lines LL2p and LL2n correspond to the second set value line in the present invention. Further, the specific time constant Tcx corresponds to the specific time constant in the present invention.
また、前記式(22)が本発明における式(A)に相当する。さらに、前記式(17)右辺第1項が、本発明における式(C)により表される第1制御入力成分に相当し、式(17)の右辺第2項が、本発明における第2制御入力成分に相当する。 Moreover, said Formula (22) corresponds to Formula (A) in this invention. Further, the first term on the right side of Equation (17) corresponds to the first control input component represented by Equation (C) in the present invention, and the second term on the right side of Equation (17) is the second control in the present invention. Corresponds to the input component.
[第2実施形態]
次に、本発明の第2実施形態を図10を参照して説明する。なお、本実施形態は、制御装置30の制御入力決定部34の一部の処理だけが、第1実施形態と相違するものである。そのため、本実施形態の説明は、第1実施形態と相違する事項を中心に行い、第1実施形態と同一の事項については説明を省略する。
[Second Embodiment]
Next, a second embodiment of the present invention will be described with reference to FIG. Note that this embodiment is different from the first embodiment only in a part of the process of the control
本実施形態では、制御入力決定部34の処理において、外乱の影響を低減するために、二次側トルク偏差τ_err及び二次側トルク偏差速度dτ_errの値を、オブザーバを用いて逐次推定する。そして、前記二次側トルク計測部34fによる計測値をそのまま用いて算出される二次側トルク偏差τ_err、その時間的変化率として得られる二次側トルク偏差速度dτ_errとの代わりに、オブザーバによる推定値τ_err_hat,dτ_err_hatを用いてスライディングモード制御の処理を実行して、制御入力(目標トルクτm_cmd)を決定する。
In the present embodiment, in the process of the control
具体的には、本実施形態では、図10に示すように、制御入力決定部34のスライディングモード制御処理部34eは、オブザーバ34hとしての機能をさらに含む。
Specifically, in the present embodiment, as shown in FIG. 10, the sliding mode
そして、スライディングモード制御処理部34eには、前記二次側トルク計測部34fにより算出された二次側トルクτ_actの計測値と、前記補正後目標二次側トルクτ_cmd_cとの偏差(演算部34dの出力)が実際の二次側トルク偏差τ_err_actとして入力される。なお、補正後目標二次側トルクτ_cmd_cの算出処理は、第1実施形態と同じである。
Then, the sliding mode
オブザーバ34hは、次式(51)の演算によって、外乱成分を低減した二次側トルク偏差τ_errの推定値τ_err_hat(以降、二次側トルク偏差推定値τ_err_hatという)と、外乱成分を低減した二次側トルク偏差速度dτ_errの推定値dτ_err_hat(以降、二次側トルク偏差速度推定値dτ_err_hatという)を、制御装置30の制御処理周期で、逐次更新しつつ算出する。
The
この式(51)におけるA、Bは、それぞれ、前記式(15)のただし書きで定義される行列(2行2列)、列ベクトル(2行1列)であり、それぞれの各成分値は、第1実施形態と同様に、式(15)のただし書きの定義に従って決定される。 A and B in the equation (51) are a matrix (2 rows and 2 columns) and a column vector (2 rows and 1 column) defined by the proviso of the equation (15), respectively. As in the first embodiment, it is determined according to the definition of the proviso in Expression (15).
この場合、式(51)の右辺のu(n-1)の値としては、前回の制御処理周期で決定された目標トルクTm_cmdの値(前回値)が用いられる。また、Kobsは、所定の既定値であり、制御装置30の図示しないメモリに記憶保持されている。
In this case, the value (previous value) of the target torque Tm_cmd determined in the previous control processing cycle is used as the value of u (n-1) on the right side of the equation (51). Kobs is a predetermined default value and is stored and held in a memory (not shown) of the
また、dτ_err_act_filtは、スライディングモード制御処理部34eに入力される二次側トルク偏差τ_err_actの時間的変化率の値に、ローパス特性のフィルタリング処理を施した値である。
Further, dτ_err_act_filt is a value obtained by performing low-pass characteristic filtering processing on the temporal change rate value of the secondary torque deviation τ_err_act input to the sliding mode
なお、ローパス特性のフィルタリング処理以外の適宜の処理によって、二次側トルク偏差τ_err_actの推定値の時間的変化率の値からノイズ成分を除去したものをdτ_err_act_filtの代わりに用いるようにしてもよい。 Note that a value obtained by removing the noise component from the value of the temporal change rate of the estimated value of the secondary torque deviation τ_err_act may be used instead of dτ_err_act_filt by an appropriate process other than the low-pass characteristic filtering process.
本実施形態におけるスライディングモード制御処理部34eは、上記の如くオブザーバ34hにより算出される二次側トルク偏差推定値τ_err_hatと、二次側トルク偏差速度推定値dτ_err_hatとを用いて、前記式(18)に従って、切換関数σの値を算出し、さらにこの切換関数σの算出値を用いて前記式(17)の右辺の演算を行なうことで、制御入力としての動力源モータ5の目標トルクτm_cmdを逐次算出する。
The sliding mode
本実施形態は、以上説明した事項以外は、前記第1実施形態と同じである。 The present embodiment is the same as the first embodiment except for the matters described above.
かかる本実施形態においても、前記第1実施形態と同様の作用効果を奏することができる。 Also in this embodiment, the same operational effects as in the first embodiment can be achieved.
加えて、本実施形態では、オブザーバ34hにより算出した二次側トルク偏差推定値τ_err_hat及び二次側トルク偏差速度推定値dτ_err_hatを、二次側トルク計測部34fにより逐次算出される実際の二次側トルクτ_actの計測値をその用いて算出される実際の二次側トルク偏差τ_err_act及びその時間的変化率である二次側トルク偏差速度dτ_err_actの代わりに用いてスライディンモード制御の制御処理を行なうので、二次側トルクτ_actの計測値や、その時間的変化率に含まれる外乱成分の影響を低減して、制御入力(目標トルクτm_cmd)を決定できる。
In addition, in the present embodiment, the secondary side torque deviation estimated value τ_err_hat and the secondary side torque deviation speed estimated value dτ_err_hat calculated by the
このため、制御装置30による二次側トルクτの制御のロバスト性をより一層高めることができる。
For this reason, the robustness of the control of the secondary torque τ by the
ここで、以上説明した第2実施形態と本発明との対応関係について補足しておく。第2実施形態は、前記第1発明、第2発明、第4〜第7発明、第11発明、及び第12発明に関連する実施形態である。この場合、第2実施形態では、前記オブザーバ34hが、本発明におけるオブザーバに相当する。これ以外は、第2実施形態と本発明との対応関係は、第1実施形態と同じである。
Here, the correspondence relationship between the second embodiment described above and the present invention will be supplemented. The second embodiment is an embodiment related to the first invention, the second invention, the fourth to seventh inventions, the eleventh invention, and the twelfth invention. In this case, in the second embodiment, the
[第3実施形態]
次に、本発明の第3実施形態を図1及び図11を参照して説明する。なお、本実施形態は、動力伝達装置の一部の制御処理だけが前記第1実施形態と相違するものである。このため、本実施形態の説明は、第1実施形態と相違する事項を中心に行い、第1実施形態と同一の事項については説明を省略する。
[Third Embodiment]
Next, a third embodiment of the present invention will be described with reference to FIGS. Note that this embodiment is different from the first embodiment only in part of the control processing of the power transmission device. For this reason, the description of the present embodiment will be focused on matters that are different from the first embodiment, and the description of the same matters as the first embodiment will be omitted.
前記第1実施形態では、弾性力発生機構4の目標剛性特性係数Ksp_cmdは一定に保持するようにした。これに対して、本実施形態では、目標剛性特性係数Ksp_cmdは、既定の範囲内で可変的に設定されるようになっており、かかる目標剛性特性係数Ksp_cmdが、制御装置30に逐次入力される。
In the first embodiment, the target stiffness characteristic coefficient Ksp_cmd of the elastic force generation mechanism 4 is kept constant. On the other hand, in this embodiment, the target stiffness characteristic coefficient Ksp_cmd is variably set within a predetermined range, and the target stiffness characteristic coefficient Ksp_cmd is sequentially input to the
そして、制御装置30の剛性制御部36は、弾性力発生機構4の基準状態での回転バー14の位相角φを目標剛性特性係数Ksp_cmdに対応する角度値にするための剛性可変用モータ18の回転駆動軸18aの回転角度の目標値を、Ksp_cmdから既定のマップ又は演算式により決定する。そして、剛性制御部36は、回転駆動軸18aの実際の回転角度(角度検出器33の出力により示される観測値)を、サーボ制御によって、Ksp_cmdから決定した目標値に制御する。
Then, the
このとき、剛性可変用モータ18の回転駆動軸18aの回転角度は、目標剛性特性係数Ksp_cmdの変化に追従して、変化するように制御される。これにより、弾性力発生機構4の実際の剛性特性係数Kspが可変的に制御される。
At this time, the rotation angle of the
また、本実施形態では、図11に示すように、制御入力決定部34のスライディングモード制御処理部34eには、目標粘性特性係数Kdp_cmdに加えて、目標剛性特性係数Ksp_cmdも逐次入力される。そして、スライディングモード制御処理部34eの切換超平面可変設定部34gは、前記式(13a),(13b)に基づく計測値と、式(15)の状態方程式とに反映されていない弾性力発生機構4の粘性力(両プーリ2,3間の粘性力)の影響を補償するために、弾性力発生機構4の粘性特性係数Kdpの制御値(制御により実現する値)としての目標粘性特性係数Kdp_cmdと、弾性力発生機構4の剛性特性係数Kspの制御値(制御により実現する値)としての目標剛性特性係数Ksp_cmdとに応じて、切換超平面σ=0の傾き(又は切換超平面σ=0上の収束時定数Tc)を可変的に決定する。
In the present embodiment, as shown in FIG. 11, the target stiffness characteristic coefficient Ksp_cmd is sequentially input to the sliding mode
この場合、切換超平面σ=0の傾き(又は切換超平面σ=0上の収束時定数Tc)と、目標粘性特性係数Kdp_cmd及び目標剛性特性係数Ksp_cmdとの間の相関関係があらかじめ決定されており、その相関関係に従って、切換超平面σ=0の傾き(又は切換超平面σ=0上の収束時定数Tc)が可変的に決定される。 In this case, the correlation between the inclination of the switching hyperplane σ = 0 (or the convergence time constant Tc on the switching hyperplane σ = 0) and the target viscosity characteristic coefficient Kdp_cmd and the target stiffness characteristic coefficient Ksp_cmd is determined in advance. In accordance with the correlation, the slope of the switching hyperplane σ = 0 (or the convergence time constant Tc on the switching hyperplane σ = 0) is variably determined.
本実施形態では、切換超平面可変設定部34gは、Kdp_cmd、Ksp_cmdに応じて決定した切換超平面σ=0の傾き(又は切換超平面σ=0上の収束時定数Tc)に応じて、第1実施形態と同様に、切換関数σの係数成分s1,s2の値を決定する。そしてスライディングモード制御処理部34eは、この係数成分s1,s2の値を用いて、第1実施形態と同様に、前記式(17)、(18)により制御入力τm_cmdを決定する。
In the present embodiment, the switching hyperplane
ここで、本願発明者の各種実験、検討によれば、弾性力発生機構4の剛性特性係数Kspを可変的に制御するようにした場合、τ_errが安定にゼロに収束する場合におけるτ_errとdτ_errとの間の関係は、次式(61)の関係で近似される。 Here, according to various experiments and examinations of the inventors of the present application, when the stiffness characteristic coefficient Ksp of the elastic force generation mechanism 4 is variably controlled, τ_err and dτ_err when τ_err converges to zero stably Is approximated by the relationship of the following formula (61).
τ_err=−((a2/sqrt(Ksp_cmd)+a1・Ksp_cmd+a0)
+(b・Kdp_cmd)/Ksp_cmd)・dτ_err ……(61)
そこで、本実施形態では切換超平面σ=0上でのτ_errとdτ_errとの間の関係が、式(61)の関係となるように、切換超平面σ=0上の傾き(又は切換超平面σ=0上の収束時定数Tc)を目標粘性特性係数Kdp_cmd及び目標剛性特性係数Ksp_cmdに応じて決定する。
τ_err =-((a2 / sqrt (Ksp_cmd) + a1 ・ Ksp_cmd + a0)
+ (B · Kdp_cmd) / Ksp_cmd) · dτ_err (61)
Therefore, in the present embodiment, the slope on the switching hyperplane σ = 0 (or the switching hyperplane so that the relationship between τ_err and dτ_err on the switching hyperplane σ = 0 becomes the relationship of Expression (61). The convergence time constant Tc) over σ = 0 is determined according to the target viscosity characteristic coefficient Kdp_cmd and the target stiffness characteristic coefficient Ksp_cmd.
換言すれば、切換超平面σ=0上の収束時定数Tcと、Kdp_cmd及びKsp_cmdとの間の相関関係が、次式(62)により表されるように、切換超平面σ=0の傾き(又は切換超平面σ=0上の収束時定数Tc)を目標粘性特性係数Kdp_cmd及び目標剛性特性係数Ksp_cmdに応じて決定する。 In other words, as the correlation between the convergence time constant Tc on the switching hyperplane σ = 0 and Kdp_cmd and Ksp_cmd is expressed by the following equation (62), the slope of the switching hyperplane σ = 0 ( Alternatively, the convergence time constant Tc) on the switching hyperplane σ = 0 is determined according to the target viscosity characteristic coefficient Kdp_cmd and the target stiffness characteristic coefficient Ksp_cmd.
Tc=(a2/sqrt(Ksp_cmd)+a1・Ksp_cmd+a0)
+(b・Kdp_cmd)/Ksp_cmd ……(62)
式(61)及び式(62)における(a2/sqrt(Ksp_cmd)+a1・Ksp_cmd+a0)は、弾性力発生機構4の粘性特性係数Kdpがゼロである場合(Kdp_cmd=0である場合)における切換超平面σ=0上の収束時定数Tcの値を意味する。従って、弾性力発生機構4の粘性特性係数Kdpがゼロである場合における切換超平面σ=0上の収束時定数Tcは目標剛性特性係数Ksp_cmdに応じて変化するものとなる。
Tc = (a2 / sqrt (Ksp_cmd) + a1 ・ Ksp_cmd + a0)
+ (B · Kdp_cmd) / Ksp_cmd (62)
(A2 / sqrt (Ksp_cmd) + a1 · Ksp_cmd + a0) in the equations (61) and (62) is a switching hyperplane when the viscosity characteristic coefficient Kdp of the elastic force generation mechanism 4 is zero (when Kdp_cmd = 0). It means the value of the convergence time constant Tc on σ = 0. Therefore, when the viscosity characteristic coefficient Kdp of the elastic force generation mechanism 4 is zero, the convergence time constant Tc on the switching hyperplane σ = 0 changes according to the target stiffness characteristic coefficient Ksp_cmd.
補足すると、前記第1実施形態では、Ksp_cmdが一定値であるために、(a2/sqrt(Ksp_cmd)+a1・Ksp_cmd+a0)が一定値となり、その値が、前記式(22)の変数aの値に相当するものとなる。 Supplementally, in the first embodiment, since Ksp_cmd is a constant value, (a2 / sqrt (Ksp_cmd) + a1 · Ksp_cmd + a0) is a constant value, and this value is the value of the variable a in the equation (22). It will be equivalent.
また、式(61)及び式(62)における変数bは、第1実施形態における前記式(22)の変数bと同様に、目標粘性特性係数Kdp_cmdを、弾性力発生機構4の実際の粘性特性係数Kdpの推定値に補正するための補正係数を意味する。 Further, the variable b in the equations (61) and (62) is the target viscosity characteristic coefficient Kdp_cmd, as in the variable b of the equation (22) in the first embodiment. It means a correction coefficient for correcting to an estimated value of the coefficient Kdp.
なお、本実施形態においても、粘性力トルクτdpと、弾性力トルクτspの時間的変化率dτspとの間の関係は、前記式(23)により表される。 Also in this embodiment, the relationship between the viscous force torque τdp and the temporal change rate dτsp of the elastic force torque τsp is expressed by the equation (23).
従って、第1実施形態の場合と同様に、式(62)の右辺は、弾性力発生機構4の実際の粘性特性係数Kdpがゼロである場合(両プーリ2,3間の粘性力がゼロである場合)には、実際の二次側トルクτとしての弾性力トルクτspと二次側目標トルクτ_cmdとの偏差としての意味を持つ。また、弾性力発生機構4の実際の粘性特性係数Kdpがゼロでない場合には、該弾性力トルクτspと粘性力トルクτdpとを合成してなる実際の二次側トルクτと二次側目標トルクτ_cmdとの偏差としての意味を持つ。
Accordingly, as in the case of the first embodiment, the right side of the equation (62) indicates that the actual viscosity characteristic coefficient Kdp of the elastic force generation mechanism 4 is zero (the viscosity force between the
以下に、本実施形態において、切換超平面σ=0の傾き(又は切換超平面σ=0上の収束時定数Tc)と、目標粘性特性係数Kdp_cmd及び目標剛性特性係数Ksp_cmdとの間の相関関係を決定するための事前準備処理について説明する。 Hereinafter, in the present embodiment, the correlation between the gradient of the switching hyperplane σ = 0 (or the convergence time constant Tc on the switching hyperplane σ = 0) and the target viscosity characteristic coefficient Kdp_cmd and the target stiffness characteristic coefficient Ksp_cmd. The pre-preparation process for determining the will be described.
本実施形態における事前準備処理では、まず、目標粘性特性係数Kdp_cmdの複数の代表値と、目標剛性特性係数Ksp_cmdの複数の代表値とがあらかじめ決定される。 In the preliminary preparation processing in the present embodiment, first, a plurality of representative values of the target viscosity characteristic coefficient Kdp_cmd and a plurality of representative values of the target stiffness characteristic coefficient Ksp_cmd are determined in advance.
そして、目標粘性特性係数Kdp_cmdの1つの代表値と、目標剛性特性係数Ksp_cmdの1つの代表値との組が選択され、その選択された目標粘性特性係数Kdp_cmdの代表値に応じて弾性力発生機構4のオリフィス部24の開口面積が制御されると共に、選択された目標剛性特性係数Ksp_cmdに応じて剛性可変用モータ18の回転駆動軸18aの回転角度(=スプリングウォーム17の回転角度)が制御される。
A set of one representative value of the target viscosity characteristic coefficient Kdp_cmd and one representative value of the target stiffness characteristic coefficient Ksp_cmd is selected, and an elastic force generating mechanism is selected according to the selected representative value of the target viscosity characteristic coefficient Kdp_cmd. 4 is controlled, and the rotation angle of the
この状態で、第1実施形態で説明して手順1〜3の処理と同じ処理が実行され、これにより、選択中の目標粘性特性係数Kdp_cmdの1つの代表値と、目標剛性特性係数Ksp_cmdの1つの代表値との組に対応する切換超平面σ=0の適切な傾き(又は切換超平面σ=0上の適切な収束時定数Tc)が決定される。
In this state, the same processing as in
なお、この場合において、Kdpの値を必要とする処理(例えば前記式(44)のMu、Edpの値を算出する処理等)では、Kdpの値として、目標粘性特性係数Kdp_cmdの選択中の代表値が用いられる。同様に、Kspの値を必要とする処理(例えば前記式(29)により第1許容限界値τ_err_limを決定する処理等)では、Kspの値として、目標剛性特性係数Ksp_cmdの選択中の代表値が用いられる。 In this case, in the process requiring the value of Kdp (for example, the process of calculating the values of Mu and Edp in the equation (44)), the representative viscosity characteristic coefficient Kdp_cmd is selected as the Kdp value. A value is used. Similarly, in a process that requires a value of Ksp (for example, a process of determining the first allowable limit value τ_err_lim by the above equation (29), etc.), the representative value during selection of the target stiffness characteristic coefficient Ksp_cmd is used as the value of Ksp. Used.
そして、手順1〜3の処理と同じ処理を繰り返すことで、目標粘性特性係数Kdp_cmdの代表値と、目標剛性特性係数Ksp_cmdの代表値との全ての組に対して、各々、切換超平面σ=0の適切な傾き(又は切換超平面σ=0上の適切な収束時定数Tc)が決定される。
Then, by repeating the same process as the process of
次に、目標粘性特性係数Kdp_cmdの各代表値と目標剛性特性係数Ksp_cmdの各代表値との組と、当該代表値の各組に対応して決定された切換超平面σ=0の傾きに対応する収束時定数Tcとを用いて、例えば最小二乗法の手法によって、前記式(62)の相関関係における変数a2、a1、a0、bの値を決定する。これにより、目標粘性特性係数Kdp_cmdと、目標剛性特性係数Ksp_cmdと、切換超平面σ=0上の収束時定数Tcとの間の相関関係、ひいては、目標粘性特性係数Kdp_cmdと、目標剛性特性係数Ksp_cmdと、切換超平面σ=0の傾きとの間の相関関係が最終的に決定されることとなる。 Next, a set of each representative value of the target viscosity characteristic coefficient Kdp_cmd and each representative value of the target stiffness characteristic coefficient Ksp_cmd, and a slope of the switching hyperplane σ = 0 determined corresponding to each set of the representative values Using the convergence time constant Tc, the values of the variables a2, a1, a0, b in the correlation of the equation (62) are determined by, for example, the least square method. As a result, the correlation between the target viscosity characteristic coefficient Kdp_cmd, the target rigidity characteristic coefficient Ksp_cmd, and the convergence time constant Tc on the switching hyperplane σ = 0, that is, the target viscosity characteristic coefficient Kdp_cmd, and the target rigidity characteristic coefficient Ksp_cmd And the inclination of the switching hyperplane σ = 0 is finally determined.
以上が、本実施形態において、切換超平面σ=0の傾き(又は切換超平面σ=0上の収束時定数Tc)と、目標粘性特性係数Kdp_cmd及び目標剛性特性係数Ksp_cmdとの間の相関関係を決定するための事前準備処理である。 The above is the correlation between the gradient of the switching hyperplane σ = 0 (or the convergence time constant Tc on the switching hyperplane σ = 0) and the target viscosity characteristic coefficient Kdp_cmd and the target stiffness characteristic coefficient Ksp_cmd in the present embodiment. This is a pre-preparation process for determining.
本実施形態における制御装置30の処理は、以上説明した事項以外は、第1実施形態と同じである。
The processing of the
従って、弾性力発生機構4の粘性特性係数Kdp及び剛性特性係数Kspが適宜変更されながら、実際の二次側トルクτ_actが目標二次側トルクτ_cmdに追従するように制御される。 Therefore, the actual secondary torque τ_act is controlled to follow the target secondary torque τ_cmd while the viscosity characteristic coefficient Kdp and the rigidity characteristic coefficient Ksp of the elastic force generating mechanism 4 are appropriately changed.
以上説明した第3実施形態によれば、制御装置30の制御入力決定部34は、二次側トルクτの計測値を第1実施形態と同様に前記式(13a)に基づいて取得すると共に、スライディングモード制御用の切換超平面σ=0の傾き(又は切換超平面σ=0上の収束時定数Tc)を、弾性力発生機構4の粘性特性係数Kdpの制御値としての目標粘性特性係数Kdp_cmdと、弾性力発生機構4の剛性特性係数Kspの制御値としての目標剛性特性係数Ksp_cmdとに応じて可変的に決定する。
According to the third embodiment described above, the control
このため、弾性力発生機構4の粘性特性係数及び剛性特性係数の制御状態によらずに、弾性力発生機構4で発生する粘性力による影響を適切に補償して、二次側トルクτの計測値の振動等が発生するのを抑制しつつ、実際の二次側トルクτを、高いロバスト性で、安定に二次側目標トルクτ_cmdに収束させるようにすることができる。 Therefore, regardless of the control state of the viscosity characteristic coefficient and the rigidity characteristic coefficient of the elastic force generation mechanism 4, the influence of the viscous force generated by the elastic force generation mechanism 4 is appropriately compensated for, and the secondary side torque τ is measured. It is possible to stably converge the actual secondary torque τ to the secondary target torque τ_cmd with high robustness while suppressing the occurrence of vibration of the value.
また、前記事前準備処理において、弾性力発生機構4の目標粘性特性係数Kdp及び目標剛性特性係数Kspとの各代表値の組にそれぞれ対応する切換超平面σ=0の傾き(又は切換超平面σ=0上の収束時定数Tc)は、前記第1実施形態と同じ仕方で、複数の応答特性データを用いて決定される。 Further, in the pre-preparation process, the inclination (or the switching hyperplane) of the switching hyperplane σ = 0 corresponding to each set of representative values of the target viscosity characteristic coefficient Kdp and the target stiffness characteristic coefficient Ksp of the elastic force generation mechanism 4. The convergence time constant Tc) on σ = 0 is determined using a plurality of response characteristic data in the same manner as in the first embodiment.
さらに、弾性力発生機構4の目標粘性特性係数Kdp及び目標剛性特性係数Kspとの各代表値の組と、そのそれぞれに対応して決定した切換超平面σ=0の傾き(又は切換超平面σ=0上の収束時定数Tc)とに基づいて、粘性特性係数Kdp及び剛性特性係数Kspと、切換超平面σ=0の傾き(又は切換超平面σ=0上の収束時定数Tc)との間の相関関係(本実施形態では、前記式(62)により表される相関関係)が特定される。 Further, a set of representative values of the target viscosity characteristic coefficient Kdp and the target rigidity characteristic coefficient Ksp of the elastic force generation mechanism 4 and the inclination of the switching hyperplane σ = 0 determined corresponding to each set (or the switching hyperplane σ Based on the convergence time constant Tc) = 0, the viscosity characteristic coefficient Kdp and the stiffness characteristic coefficient Ksp and the gradient of the switching hyperplane σ = 0 (or the convergence time constant Tc on the switching hyperplane σ = 0) (In this embodiment, the correlation represented by the equation (62)) is specified.
このため、上記相関関係を、動力伝達装置1の実際の挙動特性に即して好適に特定しておくことができる。
For this reason, the said correlation can be specified suitably according to the actual behavior characteristic of the
また、第1実施形態と同様に、応答特性データを、汎用的な制御手法を用いて効率よく容易に収集することができる。ひいては、目標粘性特性係数Kdp_cmd及び目標剛性特性係数Ksp_cmdの各代表値の組毎の好適な切換超平面σ=0の傾きを特定し、さらに、粘性特性係数Kdpと、剛性特性係数と、切換超平面σ=0の傾き(又は切換超平面σ=0上の収束時定数Tc)との間の好適な相関関係を特定することを効率よく行うことができる。 Further, similarly to the first embodiment, the response characteristic data can be efficiently and easily collected using a general-purpose control method. As a result, a suitable inclination of the switching hyperplane σ = 0 for each representative value set of the target viscosity characteristic coefficient Kdp_cmd and the target rigidity characteristic coefficient Ksp_cmd is specified, and the viscosity characteristic coefficient Kdp, the rigidity characteristic coefficient, It is possible to efficiently identify a suitable correlation with the slope of the plane σ = 0 (or the convergence time constant Tc on the switching hyperplane σ = 0).
そして、制御装置30の制御入力決定部34の処理では、上記のように特定された相関関係に基づいて、切換超平面σ=0の傾き(ひいては、係数成分s1、s2の値)を決定する。そして、制御入力決定部34は、その傾きに対応して規定される切換関数σを用いてスライディングモード制御の処理(前記式(17)の演算処理)により制御入力(電動モータ5の目標トルクτm_cmd)を決定する。
In the process of the control
このため、二次側トルクτの制御を所要の収束特性と高いロバスト性とで行うことを、弾性力発生機構4の粘性特性係数Kdp及び剛性特性係数Kspの制御状態によらずに好適に実現することができる。 For this reason, the control of the secondary torque τ is suitably realized with the required convergence characteristics and high robustness regardless of the control state of the viscosity characteristic coefficient Kdp and the rigidity characteristic coefficient Ksp of the elastic force generation mechanism 4. can do.
特に、切換超平面σ=0の傾き(又は切換超平面σ=0上の収束時定数Tc)が前記時定数制約条件を満たすように設定されているので、動力伝達装置1の幅広い動作領域で、二次側トルクτの制御を高いロバスト性で安定に行なうことができる。
In particular, since the gradient of the switching hyperplane σ = 0 (or the convergence time constant Tc on the switching hyperplane σ = 0) is set so as to satisfy the time constant constraint condition, the
ここで、以上説明した第3実施形態と本願発明との対応関係について補足しておく。第3実施形態は、前記第1発明、第3発明、第4発明、及び第8〜第11発明に関連する実施形態である。この場合、前記式(62)が本発明における式(B)に相当する。これ以外は、第3実施形態と本発明との対応関係は、第1実施形態と同様である。 Here, the correspondence relationship between the third embodiment described above and the present invention will be supplemented. The third embodiment is an embodiment related to the first invention, the third invention, the fourth invention, and the eighth to eleventh inventions. In this case, the formula (62) corresponds to the formula (B) in the present invention. Except for this, the correspondence between the third embodiment and the present invention is the same as in the first embodiment.
なお、第1実施形態の場合と同様に、第3実施形態においても、二次側トルクτ_actに含まれるオフセット成分(定常誤差成分)が十分に微小である場合には、図11に示した演算部34a,34c及びローパスフィルタ34bを省略し、τ_cmdをそのまま演算部34dに入力するようにしてもよい。
As in the case of the first embodiment, in the third embodiment, when the offset component (steady error component) included in the secondary torque τ_act is sufficiently small, the calculation shown in FIG. The
また、第3実施形態において、前記第2実施形態と同様に、スライディングモード制御処理部34eにオブザーバ34hを備えるようにしてもよい。
In the third embodiment, similarly to the second embodiment, the sliding mode
この場合には、スライディングモード制御処理部34eは、前記式(51)によりオブザーバ34hが逐次算出する二次側トルク偏差推定値τ_err_hatと、二次側トルク偏差速度推定値dτ_err_hatとを、演算部34dにより算出されるτ_err_actと、その時間的変化率として算出されるdτ_err_actとの代わりに用いて、前記式(17)、(18)の演算を行うことで、制御入力としての動力源モータ5の目標トルクτm_cmdを逐次算出する。そして、これ以外の処理は、上記第3実施形態の処理と同じでよい。このようにすることで、前記第12発明の他の実施形態が構築されることとなる。
In this case, the sliding mode
[第4実施形態]
次に、本発明の第4実施形態を図1及び図12を参照して説明する。なお、本実施形態は、スライディングモード制御処理部の一部の処理だけが、第1実施形態と相違するものである。そのため、本実施形態の説明は、第1実施形態と相違する事項を中心に行い、第1実施形態と同一の事項については説明を省略する。
[Fourth Embodiment]
Next, a fourth embodiment of the present invention will be described with reference to FIGS. Note that this embodiment is different from the first embodiment only in part of the processing of the sliding mode control processing unit. Therefore, the description of the present embodiment will be focused on matters that are different from those of the first embodiment, and description of the same matters as those of the first embodiment will be omitted.
前記第1実施形態において、スライディングモード制御の手法により制御入力を決定するための演算処理は、前記したように、前記弾性力発生機構4の粘性特性係数Kdpがゼロであると仮定した場合、すなわち、両プーリ2,3間に粘性力が発生しないと仮定した場合における動力伝達装置1の挙動を表現するモデルに基づいて構築される。
In the first embodiment, as described above, the calculation process for determining the control input by the sliding mode control method assumes that the viscosity characteristic coefficient Kdp of the elastic force generation mechanism 4 is zero, that is, In addition, it is constructed based on a model that expresses the behavior of the
そして、弾性力発生機構4で発生する粘性力の影響を補償するために、切換超平面σ=0の傾き(又は切換超平面σ=0上での収束時定数Tc)を目標粘性特性係数Kdp_cmdに応じて可変的に決定するようにした。 In order to compensate for the influence of the viscous force generated by the elastic force generating mechanism 4, the gradient of the switching hyperplane σ = 0 (or the convergence time constant Tc on the switching hyperplane σ = 0) is set as the target viscosity characteristic coefficient Kdp_cmd. It was determined variably according to.
これに対して、本実施形態では、スライディングモード制御の手法により制御入力を決定するための演算処理は、前記弾性力発生機構4の粘性特性係数Kdpがゼロでないとして動力伝達装置1の挙動を表現するモデルに基づいて構築される。そして、切換超平面σ=0の傾き(又は切換超平面σ=0上での収束時定数Tc)を、目標粘性特性係数Kdp_cmdに依存させないように決定する一方、制御入力を決定するために用いる1つのパラメータ(切換関数σに係るパラメータ以外のパラメータ)の値を、目標粘性特性係数Kdp_cmdに応じて変化させるようにすることで、弾性力発生機構4で発生する粘性力の影響を補償する。
On the other hand, in the present embodiment, the arithmetic processing for determining the control input by the sliding mode control technique expresses the behavior of the
具体的には、前記式(10)の状態方程式を、前記式(13a),(13b)を用いて整理すると、二次側トルクτ及び二次側トルク変化速度dτに関する挙動を表現するモデルとして、次式(71)の状態方程式が得られる。 Specifically, when the state equation of the equation (10) is rearranged using the equations (13a) and (13b), as a model expressing the behavior regarding the secondary side torque τ and the secondary side torque change rate dτ. The following equation (71) is obtained.
本実施形態におけるスラディングモード制御では、この式(71)の状態方程式(モデル)を基礎として、制御入力を決定するための制御処理が構築されている。 In the sliding mode control in the present embodiment, a control process for determining a control input is constructed based on the state equation (model) of the equation (71).
この場合、式(71)は、前記式(15)の行列Aを上記式(71)のただし書きで定義される行列Aに置き換えた式である。従って、本実施形態におけるスライディングモード制御による制御入力としての動力源モータ5の目標トルクτm_cmdは、前記式(17)と同じ形式の演算式により決定される。
In this case, the expression (71) is an expression in which the matrix A of the expression (15) is replaced with the matrix A defined by the proviso of the expression (71). Therefore, the target torque τm_cmd of the
ただし、本実施形態では、前記式(18)により表される切換関数σの係数成分s1,s2は、切換超平面σ=0の傾き(又は切換超平面σ=0上での収束時定数Tc)が、前記第1実施形態とは異なる仕方であらかじめ決定される。 However, in the present embodiment, the coefficient components s1 and s2 of the switching function σ represented by the equation (18) are the slope of the switching hyperplane σ = 0 (or the convergence time constant Tc on the switching hyperplane σ = 0). ) Is determined in advance in a manner different from that of the first embodiment.
具体的には、本実施形態では、第1実施形態と同様に事前準備処理をあらかじめ実行しておくことで、弾性力発生機構4の目標粘性特性係数Kdp_cmdと、収束時定数Tcとの間の相関関係を規定する前記式(22)の変数a,bの値が決定される。 Specifically, in this embodiment, the preliminary preparation process is executed in the same manner as in the first embodiment, so that the target viscosity characteristic coefficient Kdp_cmd of the elastic force generation mechanism 4 and the convergence time constant Tc are set. The values of the variables a and b in the equation (22) that define the correlation are determined.
ここで、前記第1実施形態では、式(22)におけるTc、すなわち、Kdp_cmdの関数値としてのTcをそのまま切換超平面σ=0上の収束時定数として用いた。これに対して、本実施形態では、式(22)におけるTcを、切換超平面σ=0上の収束時定数とせずに、τ_errをゼロに収束させるための好適な収束時定数としての適正収束時定数とみなす。そして、式(22)における変数aの値の値、すなわち式(22)により規定される適正時定数TcとKdp_cmdとの間の相関関係において、目標粘性特性係数Kdp_cmdがゼロであるとしたときの適正収束時定数Tc(=a)の値を、切換超平面σ=0上での収束時定数として決定した。 Here, in the first embodiment, Tc in Expression (22), that is, Tc as a function value of Kdp_cmd is used as it is as a convergence time constant on the switching hyperplane σ = 0. On the other hand, in this embodiment, Tc in the equation (22) is not set as the convergence time constant on the switching hyperplane σ = 0, and the proper convergence as a suitable convergence time constant for converging τ_err to zero. Considered as a time constant. In the correlation between the value of the variable a in the equation (22), that is, the appropriate time constant Tc defined by the equation (22) and Kdp_cmd, the target viscosity characteristic coefficient Kdp_cmd is assumed to be zero. The value of the proper convergence time constant Tc (= a) was determined as the convergence time constant on the switching hyperplane σ = 0.
従って、本実施形態では、切換超平面σ=0の傾きは、切換超平面σ=0上の収束時定数(切換超平面上収束時定数)が、あらかじめ決定された変数aの値(本実施形態では一定値)となるように決定されている。以降、本実施形態における切換超平面σ=0上の収束時定数を改めてTc0と表記する。この場合、この収束時定数Tc0は、次式(72)により与えられる。 Therefore, in the present embodiment, the inclination of the switching hyperplane σ = 0 is such that the convergence time constant on the switching hyperplane σ = 0 (the convergence time constant on the switching hyperplane) is the value of the variable a determined in advance (this implementation) It is determined to be a constant value). Hereinafter, the convergence time constant on the switching hyperplane σ = 0 in this embodiment will be referred to as Tc0. In this case, the convergence time constant Tc0 is given by the following equation (72).
Tc0=a ……(72)
このため、本実施形態における切換超平面σ=0上の収束時定数Tc0は、目標粘性特性係数Kdp_cmdに依存しない一定値となっている。
Tc0 = a (72)
Therefore, the convergence time constant Tc0 on the switching hyperplane σ = 0 in the present embodiment is a constant value that does not depend on the target viscosity characteristic coefficient Kdp_cmd.
そして、s2/s1が、切換超平面σ=0上の収束時定数Tc0(=−a)に一致するように、前記式(18)の切換関数σの係数成分s1,s2の値があらかじめ決定されている。例えば、s1=1、s2=a、あるいは、s1=1/a、s2=1とされている。 Then, the values of the coefficient components s1, s2 of the switching function σ in the equation (18) are determined in advance so that s2 / s1 matches the convergence time constant Tc0 (= -a) on the switching hyperplane σ = 0. Has been. For example, s1 = 1, s2 = a, or s1 = 1 / a, s2 = 1.
一方、本実施形態では、前記式(17)により制御入力としての動力源モータ5の目標トルクτm_cmdを算出するために用いる行列Aは、前記式(71)のただし書きで定義される行列であるから、該行列Aの2行2列成分は、粘性特性係数Kdpに依存する値となる。
On the other hand, in the present embodiment, the matrix A used for calculating the target torque τm_cmd of the
ここで、前記第1実施形態において前記したように、式(22)における変数bの値を、目標粘性特性係数Kdp_cmdに乗じてなる値(=b・Kdp_cmd)は、弾性力発生機構4の実際の粘性特性係数Kdpの推定値に相当する。 Here, as described above in the first embodiment, the value (= b · Kdp_cmd) obtained by multiplying the value of the variable b in the equation (22) by the target viscosity characteristic coefficient Kdp_cmd is an actual value of the elastic force generation mechanism 4. This corresponds to an estimated value of the viscosity characteristic coefficient Kdp.
そこで、本実施形態では、行列Aの2行2列成分を算出するためのKspの値として、b・Kdp_cmdが用いられる。すなわち、行列Aの2行2列成分におけるCin、Coutの値は、それぞれ、次式(72a),(72b)により算出される。なお、イナーシャIin,Ioutの値は、第1実施形態と同様に、あらかじめ決定された所定値である。 Therefore, in this embodiment, b · Kdp_cmd is used as the value of Ksp for calculating the 2 × 2 component of the matrix A. That is, the values of Cin and Cout in the 2 × 2 component of the matrix A are calculated by the following equations (72a) and (72b), respectively. Note that the values of the inertias Iin and Iout are predetermined values that are determined in advance, as in the first embodiment.
Cin=b・Kdp_cmd/Iin ……(72a)
Cout=b・Kdp_cmd/Iout ……(72b)
以上を前提として、本実施形態における制御装置30の制御入力決定部34を図12を参照して説明する。図12に示すように、本実施形態における制御入力決定部34は、第1実施形態と同様に、演算部34a,34c,34d,ローパスフィルタ34b、二次側トルク計測部34f、及びスライディングモード制御処理部34eを備える。ただし、本実施形態では、スライディングモード制御処理部34eは、切換超平面可変設定部を備えておらず、切換超平面σ=0の傾きに対応する切換超平面σ=0上の収束時定数aは、前記した如くあらかじめ決定されている。そして、切換関数σの係数成分s1,s2の値も収束時定数aに対応してあらかじめ決定されており、その値が図示しないメモリにあらかじめ記憶保持されている。
Cin = b · Kdp_cmd / Iin (72a)
Cout = b · Kdp_cmd / Iout (72b)
Based on the above, the control
そして、スライディングモード制御処理部34eには、演算部34dにより逐次算出される実際の二次側トルク偏差τ_err_actの計測値が逐次入力されると共に、目標粘性特性係数Kdp_cmdが逐次入力される。
Then, the measured value of the actual secondary torque deviation τ_err_act sequentially calculated by the
そして、スライディングモード制御処理部34eは、あらかじめ決定された係数成分s1,s2の値(一定値)と、演算部34dから入力された二次側トルク偏差τ_err_actと、その時間的変化率として算出される二次側トルク偏差速度dτ_er_actとから、前記式(18)の演算により切換関数σの値を算出する。
Then, the sliding mode
さらに、この切換関数σの値と、あらかじめ図示しないメモリに記憶保持された係数成分s1,s2の値と、前記式(71)の但し書きで定義される行列A及び列ベクトルBと、τ_err_act及びdτ_er_actとを用いて前記式(17)の右辺の演算を行うことで、制御入力としての動力源モータ5の目標トルクτm_cmdを算出する。
Further, the value of the switching function σ, the values of coefficient components s1 and s2 stored in advance in a memory (not shown), the matrix A and the column vector B defined by the proviso of the equation (71), τ_err_act and dτ_er_act Is used to calculate the target torque τm_cmd of the
この場合、行列Aの2行2列成分は、前記したように、Kspの値として、b・Kdp_cmdを用いて算出される。 In this case, the 2 × 2 component of the matrix A is calculated using b · Kdp_cmd as the value of Ksp as described above.
なお、行列Aの2行2列成分を算出するために必要なIin、Ioutの値はあらかじめ決定された値であり、図示しないメモリにあらかじめ記憶保持されている。 Note that the values of Iin and Iout necessary for calculating the 2 × 2 component of the matrix A are predetermined values and are stored and held in advance in a memory (not shown).
さらに、行列Aの2行2列成分以外の各成分と、列ベクトルBの各成分と、式(17)におけるδとは、本実施形態では第1実施形態と同様に定数値であり、図示しないメモリに記憶保持されている。また、式(17)のKsldの値は、第1実施形態と同様に、切換関数σの値に応じて、前記式(25)により算出される。 Further, each component other than the 2-row and 2-column components of the matrix A, each component of the column vector B, and δ in Expression (17) are constant values in the present embodiment, as in the first embodiment. Not stored in memory. Further, the value of Ksld in the equation (17) is calculated by the equation (25) according to the value of the switching function σ as in the first embodiment.
本実施形態は、以上説明した事項以外は、前記第1実施形態と同じである。 The present embodiment is the same as the first embodiment except for the matters described above.
以上説明した第4実施形態によれば、制御装置30の制御入力決定部34は、制御入力(動力源モータ5の目標トルクτm_cmd)をスライディグモード制御の手法により決定するために用いる二次側トルクτの計測値を、第1実施形態と同様に、二次側トルク計測部34fによって、前記式(13a)に基づいて逐次取得する。
According to the fourth embodiment described above, the control
一方、第4実施形態では、第1実施形態と異なり、スライディングモード制御用の切換超平面σ=0の傾き(又は切換超平面σ=0上の収束時定数Tc0)は、目標粘性特性係数Kdp_cmdに依存しないように決定される。具体的には、切換超平面σ=0の傾きは、あらかじめ決定された一定値(=a)の収束時定数Tc0に対応する傾きに決定される。 On the other hand, in the fourth embodiment, unlike the first embodiment, the gradient of the switching hyperplane σ = 0 for sliding mode control (or the convergence time constant Tc0 on the switching hyperplane σ = 0) is the target viscosity characteristic coefficient Kdp_cmd. It is decided not to depend on. Specifically, the inclination of the switching hyperplane σ = 0 is determined to be an inclination corresponding to a convergence time constant Tc0 having a predetermined value (= a).
この場合、切換超平面σ=0の傾きに対応する収束時定数Tc0は、前記第1実施形態と同様に行われる事前準備処理によって、あらかじめ特定された適正収束時定数Tcと粘性特性係数Kdpとの間の相関関係において、粘性特性係数Kdpの値がゼロであるときの適正収束時定数Tcの値とされる。 In this case, the convergence time constant Tc0 corresponding to the inclination of the switching hyperplane σ = 0 is determined by the preparatory processing performed in the same manner as in the first embodiment, and the appropriate convergence time constant Tc and the viscosity characteristic coefficient Kdp specified in advance. Is the value of the appropriate convergence time constant Tc when the value of the viscosity characteristic coefficient Kdp is zero.
また、第4実施形態では、上記のようにスライディングモード制御用の切換超平面σ=0の傾き(又は切換超平面σ=0上の収束時定数Tc0)を、目標粘性特性係数Kdp_cmdに依存しない傾きとする一方、制御入力(τm_cmd)を算出するための演算式(17)の行列Aに、弾性力発生機構4の粘性特性係数Kdpに依存する成分が含まれる。 In the fourth embodiment, the gradient of the switching hyperplane σ = 0 for sliding mode control (or the convergence time constant Tc0 on the switching hyperplane σ = 0) does not depend on the target viscosity characteristic coefficient Kdp_cmd as described above. On the other hand, the matrix A of the arithmetic expression (17) for calculating the control input (τm_cmd) includes a component that depends on the viscosity characteristic coefficient Kdp of the elastic force generation mechanism 4.
そして、当該成分の値を規定する粘性特性係数Kdpの値として、目標粘性特性係数Kdp_cmdを、上記相関関係に基づいてあらかじめ決定された補正係数bにより補正してなる値(=b・Kdp_cmd)が使用される。 As a value of the viscosity characteristic coefficient Kdp that defines the value of the component, a value (= b · Kdp_cmd) obtained by correcting the target viscosity characteristic coefficient Kdp_cmd with the correction coefficient b determined in advance based on the above correlation. used.
このため、第4実施形態においても、結果的には第1実施形態と同様に、弾性力発生機構4の粘性特性係数の制御状態によらずに、弾性力発生機構4で発生する粘性力による影響を適切に補償して、二次側トルクτの計測値の振動等が発生するのを抑制しつつ、実際の二次側トルクτを、高いロバスト性で、安定に二次側目標トルクτ_cmdに収束させるようにすることができる。 For this reason, also in the fourth embodiment, as a result, similarly to the first embodiment, it depends on the viscous force generated by the elastic force generating mechanism 4 regardless of the control state of the viscosity characteristic coefficient of the elastic force generating mechanism 4. The actual secondary torque τ is stable and highly stable with high robustness while suppressing the occurrence of vibration of the measured value of the secondary torque τ by appropriately compensating the influence. Can be made to converge.
また、前記事前準備処理において、弾性力発生機構4の目標粘性特性係数Kdp_cmdの各代表値にそれぞれ対応する適正収束時定数Tcは、前記第1実施形態と同様の仕方で、複数の応答特性データを用いて決定される。 In the preparatory process, the appropriate convergence time constant Tc corresponding to each representative value of the target viscosity characteristic coefficient Kdp_cmd of the elastic force generation mechanism 4 is set in the same manner as in the first embodiment in a plurality of response characteristics. Determined using data.
さらに、弾性力発生機構4の目標粘性特性係数Kdp_cmdの各代表値と、そのそれぞれに対応して決定した適正時定数Tcとに基づいて、粘性特性係数Kdpと適正収束時定数Tcとの間の相関関係(本実施形態では、前記式(22)により表される相関関係)が特定される。 Further, based on each representative value of the target viscosity characteristic coefficient Kdp_cmd of the elastic force generation mechanism 4 and the appropriate time constant Tc determined corresponding to each representative value, between the viscosity characteristic coefficient Kdp and the appropriate convergence time constant Tc. A correlation (in this embodiment, a correlation represented by the formula (22)) is specified.
このため、上記相関関係を、動力伝達装置1の実際の挙動特性に即して好適に特定しておくことができる。
For this reason, the said correlation can be specified suitably according to the actual behavior characteristic of the
また、第1実施形態と同様に、応答特性データを、汎用的な制御手法を用いて効率よく容易に収集することができる。ひいては、目標粘性特性係数Kdp_cmdの各代表値毎の好適な適正収束時定数Tcを特定し、さらに、粘性特性係数Kdpと、適正収束時定数Tcとの間の好適な相関関係を特定することを効率よく行うことができる。 Further, similarly to the first embodiment, the response characteristic data can be efficiently and easily collected using a general-purpose control method. As a result, a suitable proper convergence time constant Tc for each representative value of the target viscosity characteristic coefficient Kdp_cmd is specified, and a suitable correlation between the viscosity characteristic coefficient Kdp and the appropriate convergence time constant Tc is specified. It can be done efficiently.
そして、制御装置30の制御入力決定部34は、上記のように特定された相関関係により規定される傾き(又は収束時定数Tc0)を有する切換超平面σ=0に対応する切換関数σと、上記相関関係により規定される補正係数bとを用いて、スライディングモード制御の処理(前記式(71)の状態方程式に基づく前記(17)の演算処理)により制御入力(電動モータ5の目標トルクτm_cmd)を決定する。
Then, the control
このため、二次側トルクτの制御を所要の収束特性と高いロバスト性とで行うことを、弾性力発生機構4の粘性特性係数Kdpの制御状態によらずに好適に実現することができる。 For this reason, it is possible to suitably realize the control of the secondary side torque τ with the required convergence characteristic and high robustness regardless of the control state of the viscosity characteristic coefficient Kdp of the elastic force generating mechanism 4.
特に、前記式(22)の相関関係の適正収束時定数Tcが前記時定数制約条件を満たすように設定されているので、動力伝達装置1の幅広い動作領域で、二次側トルクτの制御を高いロバスト性で安定に行なうことができる。
In particular, since the proper convergence time constant Tc of the correlation in the equation (22) is set so as to satisfy the time constant constraint condition, the secondary torque τ can be controlled in a wide operating region of the
ここで、以上説明した第4実施形態と本願発明との対応関係について補足しておく。第4実施形態は、前記第13〜第18発明、及び第23発明に関連する実施形態である。この場合、前記式(22)が本発明における式(E)に相当する。さらに、前記式(17)右辺第1項が、本発明における式(D)により表される第1制御入力成分に相当し、式(17)の右辺第2項が、本発明における第2制御入力成分に相当する。また、前記式(72)により表される収束時定数Tc0が本発明における切換超平面上収束時定数に相当する。これ以外は、第4実施形態と本発明との対応関係は、第1実施形態と同様である。 Here, the correspondence relationship between the fourth embodiment described above and the present invention will be supplemented. The fourth embodiment is an embodiment related to the thirteenth to eighteenth inventions and the twenty-third invention. In this case, the formula (22) corresponds to the formula (E) in the present invention. Further, the first term on the right side of the equation (17) corresponds to the first control input component represented by the equation (D) in the present invention, and the second term on the right side of the equation (17) is the second control in the present invention. Corresponds to the input component. Further, the convergence time constant Tc0 represented by the equation (72) corresponds to the convergence time constant on the switching hyperplane in the present invention. Except for this, the correspondence between the fourth embodiment and the present invention is the same as that of the first embodiment.
なお、第1実施形態の場合と同様に、第4実施形態においても、二次側トルクτ_actに含まれるオフセット成分(定常誤差成分)が十分に微小である場合には、図12に示した演算部34a,34c及びローパスフィルタ34bを省略し、τ_cmdをそのまま演算部34dに入力するようにしてもよい。
As in the case of the first embodiment, in the fourth embodiment, when the offset component (steady error component) included in the secondary torque τ_act is sufficiently small, the calculation shown in FIG. The
また、第4実施形態において、前記第2実施形態と同様に、スライディングモード制御処理部34eにオブザーバ34hを備えるようにしてもよい。
In the fourth embodiment, similarly to the second embodiment, the sliding mode
この場合には、オブザーバ34hは、前記式(51)の行列Aとして、前記式(71)のただし書きで定義される行列Aを用いて、二次側トルク偏差推定値τ_err_hatと、二次側トルク偏差速度推定値dτ_err_hatを算出する。なお、この場合のKsp、Kdpの値としては、それぞれ、Ksp_cmd、b・Kdp_cmdが用いられる。
In this case, the
そして、スライディングモード制御処理部34eは、オブザーバ34hが逐次算出する二次側トルク偏差推定値τ_err_hatと、二次側トルク偏差速度推定値dτ_err_hatとを、演算部34dにより算出されるτ_err_actと、その時間的変化率として算出されるdτ_err_actとの代わりに用いて、前記式(17)、(18)の演算を行うことで、制御入力としての動力源モータ5の目標トルクτm_cmdを逐次算出する。そして、これ以外の処理は、上記第4実施形態の処理と同じでよい。このようにすることで、前記第24発明の一実施形態が構築されることとなる。
Then, the sliding mode
[第5実施形態]
次に、本発明の第5実施形態を図1及び図13を参照して説明する。なお、本実施形態は、動力伝達装置の一部の処理だけが第4実施形態と相違するものである。そのため、本実施形態の説明は、第4実施形態と相違する事項を中心に行い、第4実施形態と同一の事項については説明を省略する。
[Fifth Embodiment]
Next, a fifth embodiment of the present invention will be described with reference to FIGS. This embodiment is different from the fourth embodiment only in a part of the processing of the power transmission device. Therefore, the description of this embodiment will be focused on matters that are different from those of the fourth embodiment, and description of the same matters as those of the fourth embodiment will be omitted.
前記第4実施形態では、弾性力発生機構4の目標剛性特性係数Ksp_cmdは一定に保持するようにした。これに対して、本実施形態では、目標剛性特性係数Ksp_cmdは、既定の範囲内で可変的に設定されるようになっており、かかる目標剛性特性係数Ksp_cmdが、制御装置30に逐次入力される。
In the fourth embodiment, the target stiffness characteristic coefficient Ksp_cmd of the elastic force generation mechanism 4 is kept constant. On the other hand, in this embodiment, the target stiffness characteristic coefficient Ksp_cmd is variably set within a predetermined range, and the target stiffness characteristic coefficient Ksp_cmd is sequentially input to the
そして、制御装置30の剛性制御部36は、前記第3実施形態と同様に、目標剛性特性係数Ksp_cmdに応じて剛性可変用モータ18の回転駆動軸18aの回転角度の目標値を決定し、その決定した目標値に、回転駆動軸18aの実際の回転角度(角度検出器33の出力により示される観測値)を制御する。これにより、弾性力発生機構4の実際の剛性特性係数Kspが、可変的に設定される目標剛性特性係数Ksp_cmdに制御される。
Then, similarly to the third embodiment, the
また、本実施形態では、図13に示すように、制御入力決定部34のスライディングモード制御処理部34eには、目標粘性特性係数Kdp_cmdに加えて、目標剛性特性係数Ksp_cmdも逐次入力される。
In the present embodiment, as shown in FIG. 13, in addition to the target viscosity characteristic coefficient Kdp_cmd, the target stiffness characteristic coefficient Ksp_cmd is sequentially input to the sliding mode
本実施形態におけるスライディングモード制御処理部34eは、切換超平面σ=0の傾き(又は切換超平面σ=0上の収束時定数)を可変的に設定する切換超平面可変設定部34gを備えている。この切換超平面可変設定部34gは、入力される目標剛性特性係数Ksp_cmdに応じて切換超平面σ=0の傾き(又は切換超平面σ=0上の収束時定数)を可変的に決定する。
The sliding mode
さらに詳細には、本実施形態では、前記第3実施形態と同様に事前準備処理をあらかじめ実行しておくことで、弾性力発生機構4の目標粘性特性係数Kdp_cmd及び目標剛性特性係数Ksp_cmdと、収束時定数Tcとの間の相関関係を規定する前記式(62)の変数a2,a1,a0,bの値が決定される。 More specifically, in the present embodiment, the pre-preparation process is executed in the same manner as in the third embodiment, so that the target viscosity characteristic coefficient Kdp_cmd and the target rigidity characteristic coefficient Ksp_cmd of the elastic force generation mechanism 4 are converged. The values of the variables a2, a1, a0, b in the equation (62) that define the correlation with the time constant Tc are determined.
そして、本実施形態では、切換超平面可変設定部34gは、式(62)における(a2/sqrt(Ksp_cmd)+a1・Ksp_cmd+a0)の値、すなわち、式(62)により規定されるTcとKdp_cmd及びKsp_cmdとの間の相関関係において、目標粘性特性係数Kdp_cmdがゼロであるとしたときの収束時定数Tc(=a2/sqrt(Ksp_cmd)+a1・Ksp_cmd+a0)の値を、切換超平面σ=0上での収束時定数として、Ksp_cmdに応じて可変的に決定する。
In the present embodiment, the switching hyperplane
従って、本実施形態では、切換超平面σ=0の傾きは、切換超平面σ=0上の収束時定数が、(a2/sqrt(Ksp_cmd)+a1・Ksp_cmd+a0)となるように、目標剛性特性係数Ksp_cmdに応じて可変的に決定される。以降、本実施形態における切換超平面σ=0上の収束時定数を改めてTc0と表記する。この場合、この収束時定数Tc0は、次式(81)により与えられる。 Therefore, in this embodiment, the inclination of the switching hyperplane σ = 0 is such that the convergence time constant on the switching hyperplane σ = 0 is (a2 / sqrt (Ksp_cmd) + a1 · Ksp_cmd + a0). It is variably determined according to Ksp_cmd. Hereinafter, the convergence time constant on the switching hyperplane σ = 0 in this embodiment will be referred to as Tc0. In this case, the convergence time constant Tc0 is given by the following equation (81).
Tc0=a2/sqrt(Ksp_cmd)+a1・Ksp_cmd+a0 ……(81)
このため、本実施形態における切換超平面可変設定部34gが決定する切換超平面σ=0上の収束時定数Tc0は、目標粘性特性係数Kdp_cmdに依存しない値で、且つ、目標剛性特性係数Ksp_cmdに応じた値となる。
Tc0 = a2 / sqrt (Ksp_cmd) + a1 / Ksp_cmd + a0 (81)
For this reason, the convergence time constant Tc0 on the switching hyperplane σ = 0 determined by the switching hyperplane
そして、切換超平面可変設定部34gは、s2/s1が、切換超平面σ=0上の収束時定数Tc0(式(81)により規定される収束時定数Tc0に一致するように、前記式(18)の切換関数σの係数成分s1,s2の値を決定する。例えば、s1=1、s2=Tc0、あるいは、s1=1/Tc0、s2=1とされる。
Then, the switching hyperplane
本実施形態における制御装置30の処理は、以上説明した事項以外は、第4実施形態と同じである。
The processing of the
従って、弾性力発生機構4の粘性特性係数Kdp及び剛性特性係数Kspが適宜変更されながら、実際の二次側トルクτ_actが目標二次側トルクτ_cmdに追従するように制御される。 Therefore, the actual secondary torque τ_act is controlled to follow the target secondary torque τ_cmd while the viscosity characteristic coefficient Kdp and the rigidity characteristic coefficient Ksp of the elastic force generating mechanism 4 are appropriately changed.
以上説明した第5実施形態によれば、制御装置30の制御入力決定部34は、二次側トルクτの計測値を第1実施形態及び第4実施形態と同様に前記式(13a)に基づいて逐次取得する。
According to the fifth embodiment described above, the control
また、第5実施形態では、スライディングモード制御用の切換超平面σ=0の傾き(又は切換超平面σ=0上の収束時定数Tc0)は、第4実施形態と同様に、目標粘性特性係数Kdp_cmdに依存しないように決定される。ただし、第5実施形態では、その傾きは、目標剛性特性係数Kspに応じて、前記式(81)により表される収束時定数Tc0に対応する傾きに決定される。 In the fifth embodiment, the gradient of the switching hyperplane σ = 0 for sliding mode control (or the convergence time constant Tc0 on the switching hyperplane σ = 0) is the target viscosity characteristic coefficient as in the fourth embodiment. It is determined not to depend on Kdp_cmd. However, in the fifth embodiment, the inclination is determined to be an inclination corresponding to the convergence time constant Tc0 represented by the equation (81) according to the target stiffness characteristic coefficient Ksp.
この場合、切換超平面σ=0の傾きに対応する収束時定数Tc0は、前記第4実施形態と同様に行われる事前準備処理によって、あらかじめ特定された適正収束時定数Tcと粘性特性係数Kdpと剛性特性係数Kspとの間の相関関係において、粘性特性係数Kdpの値がゼロであるときの適正収束時定数Tcの値とされる。 In this case, the convergence time constant Tc0 corresponding to the gradient of the switching hyperplane σ = 0 is determined by the preliminarily prepared appropriate convergence time constant Tc and the viscosity characteristic coefficient Kdp by the preparatory processing performed in the same manner as in the fourth embodiment. In the correlation with the stiffness characteristic coefficient Ksp, the value of the proper convergence time constant Tc when the value of the viscosity characteristic coefficient Kdp is zero is used.
また、第5実施形態では切換超平面σ=0の傾き(又は切換超平面σ=0上の収束時定数Tc0)を、目標粘性特性係数Kdp_cmdに依存せずに、目標剛性特性係数Ksp_cmdに依存して変化する傾きとする一方、制御入力(τm_cmd)を算出するための演算式(17)の行列Aに、弾性力発生機構4の粘性特性係数Kdpに依存する成分が含まれる。 In the fifth embodiment, the gradient of the switching hyperplane σ = 0 (or the convergence time constant Tc0 on the switching hyperplane σ = 0) does not depend on the target viscosity characteristic coefficient Kdp_cmd but depends on the target rigidity characteristic coefficient Ksp_cmd. On the other hand, the matrix A of the arithmetic expression (17) for calculating the control input (τm_cmd) includes a component that depends on the viscosity characteristic coefficient Kdp of the elastic force generation mechanism 4.
そして、当該成分の値を規定する粘性特性係数Kdpの値として、目標粘性特性係数Kdp_cmdを、上記相関関係に基づいてあらかじめ決定された補正係数bにより補正してなる値(=b・Kdp_cmd)が使用される。 As a value of the viscosity characteristic coefficient Kdp that defines the value of the component, a value (= b · Kdp_cmd) obtained by correcting the target viscosity characteristic coefficient Kdp_cmd with the correction coefficient b determined in advance based on the above correlation. used.
このため、第5実施形態においては、結果的には前記第3実施形態と同様に、弾性力発生機構4の粘性特性係数及び剛性特性係数の制御状態によらずに、弾性力発生機構4で発生する粘性力による影響を適切に補償して、二次側トルクτの計測値の振動等が発生するのを抑制しつつ、実際の二次側トルクτを、高いロバスト性で、安定に二次側目標トルクτ_cmdに収束させるようにすることができる。 Therefore, in the fifth embodiment, as in the third embodiment, as a result, the elastic force generation mechanism 4 does not depend on the control state of the viscosity characteristic coefficient and the rigidity characteristic coefficient of the elastic force generation mechanism 4. The actual secondary torque τ can be stably increased with high robustness while properly compensating for the influence of the generated viscous force and suppressing the vibration of the measured value of the secondary torque τ. It can be made to converge to the secondary target torque τ_cmd.
また、前記事前準備処理において、弾性力発生機構4の目標粘性特性係数Kdp_cmd及び目標剛性特性係数Ksp_cmdの各代表値の組にそれぞれ対応する適正収束時定数Tcは、前記第1実施形態と同様の仕方で、複数の応答特性データを用いて決定される。 In the pre-preparation process, the appropriate convergence time constant Tc corresponding to each set of representative values of the target viscosity characteristic coefficient Kdp_cmd and the target stiffness characteristic coefficient Ksp_cmd of the elastic force generation mechanism 4 is the same as in the first embodiment. In this way, it is determined using a plurality of response characteristic data.
さらに、弾性力発生機構4の目標粘性特性係数Kdp_cmd及び目標剛性特性係数Ksp_cmdの各代表値の組と、そのそれぞれに対応して決定した適正時定数Tcとに基づいて、粘性特性係数Kdpと剛性特性係数Kspと適正収束時定数Tcとの間の相関関係(本実施形態では、前記式(62)により表される相関関係)が特定される。 Furthermore, the viscosity characteristic coefficient Kdp and the rigidity are determined based on the set of representative values of the target viscosity characteristic coefficient Kdp_cmd and the target rigidity characteristic coefficient Ksp_cmd of the elastic force generation mechanism 4 and the appropriate time constant Tc determined corresponding to each set. A correlation between the characteristic coefficient Ksp and the appropriate convergence time constant Tc (in this embodiment, a correlation represented by the equation (62)) is specified.
このため、上記相関関係を、動力伝達装置1の実際の挙動特性に即して好適に特定しておくことができる。
For this reason, the said correlation can be specified suitably according to the actual behavior characteristic of the
また、第1実施形態と同様に、応答特性データを、汎用的な制御手法を用いて効率よく容易に収集することができる。ひいては、目標粘性特性係数Kdp_cmd及び目標剛性特性係数Ksp_cmdの各代表値の組毎の好適な適正収束時定数Tcを特定し、さらに、粘性特性係数Kdpと、剛性特性係数Kspと、適正収束時定数Tcとの間の好適な相関関係を特定することを効率よく行うことができる。 Further, similarly to the first embodiment, the response characteristic data can be efficiently and easily collected using a general-purpose control method. As a result, a suitable proper convergence time constant Tc for each set of representative values of the target viscosity characteristic coefficient Kdp_cmd and the target stiffness characteristic coefficient Ksp_cmd is specified, and further, the viscosity characteristic coefficient Kdp, the stiffness characteristic coefficient Ksp, and the proper convergence time constant It is possible to efficiently identify a suitable correlation with Tc.
そして、制御装置30の制御入力決定部34は、上記のように特定された相関関係により規定される傾き(又は収束時定数Tc0)を有する切換超平面σ=0に対応する切換関数σと、上記相関関係により規定される補正係数bとを用いて、第4実施形態と同様に、スライディングモード制御の処理(前記式(71)の状態方程式に基づく前記(17)の演算処理)により制御入力(電動モータ5の目標トルクτm_cmd)を決定する。
Then, the control
このため、二次側トルクτの制御を所要の収束特性と高いロバスト性とで行うことを、弾性力発生機構4の粘性特性係数Kdp及び剛性特性係数Kspの制御状態によらずに好適に実現することができる。 For this reason, the control of the secondary torque τ is suitably realized with the required convergence characteristics and high robustness regardless of the control state of the viscosity characteristic coefficient Kdp and the rigidity characteristic coefficient Ksp of the elastic force generation mechanism 4. can do.
特に、前記式(62)の相関関係の適正収束時定数Tcが前記時定数制約条件を満たすように設定されているので、動力伝達装置1の幅広い動作領域で、二次側トルクτの制御を高いロバスト性で安定に行なうことができる。
In particular, since the proper convergence time constant Tc of the correlation in the equation (62) is set so as to satisfy the time constant constraint condition, the secondary side torque τ can be controlled in a wide operating region of the
ここで、以上説明した第5実施形態と本願発明との対応関係について補足しておく。第5実施形態は、前記第13発明、第14発明、及び第19〜第23発明に関連する実施形態である。この場合、前記式(62)が本発明における式(F)に相当する。また、切換超平面可変設定部34gが本発明における切換超平面可変設定手段に相当する。また、式(81)により表される収束時定数Tc0が本発明における切換超平面上収束時定数に相当する。これ以外は、第5実施形態と本発明との対応関係は、第4実施形態と同様である。
Here, the correspondence relationship between the fifth embodiment described above and the present invention will be supplemented. The fifth embodiment is an embodiment related to the thirteenth invention, the fourteenth invention, and the nineteenth to twenty-third invention. In this case, the formula (62) corresponds to the formula (F) in the present invention. The switching hyperplane
なお、第1実施形態の場合と同様に、第5実施形態においても、二次側トルクτ_actに含まれるオフセット成分(定常誤差成分)が十分に微小である場合には、図13に示した演算部34a,34c及びローパスフィルタ34bを省略し、τ_cmdをそのまま演算部34dに入力するようにしてもよい。
As in the case of the first embodiment, also in the fifth embodiment, when the offset component (steady error component) included in the secondary torque τ_act is sufficiently small, the calculation shown in FIG. The
また、第5実施形態において、前記第2実施形態と同様に、スライディングモード制御処理部34eにオブザーバ34hを備えるようにしてもよい。
In the fifth embodiment, similarly to the second embodiment, the sliding mode
この場合には、第4実施形態に関して補足説明した場合と同様に、オブザーバ34hは、前記式(51)の行列Aとして、前記式(71)のただし書きで定義される行列Aを用いて、二次側トルク偏差推定値τ_err_hatと、二次側トルク偏差速度推定値dτ_err_hatを算出する。
In this case, the
そして、スライディングモード制御処理部34eは、オブザーバ34hが逐次算出する二次側トルク偏差推定値τ_err_hatと、二次側トルク偏差速度推定値dτ_err_hatとを、演算部34dにより算出されるτ_err_actと、その時間的変化率として算出されるdτ_err_actとの代わりに用いて、前記式(17)、(18)の演算を行うことで、制御入力としての動力源モータ5の目標トルクτm_cmdを逐次算出する。そして、これ以外の処理は、上記第4実施形態の処理と同じでよい。このようにすることで、前記第24発明の他の実施形態が構築されることとなる。
Then, the sliding mode
[変形態様]
次に、前記各実施形態に関連する変形態様をいくつか説明する。
[Modification]
Next, some modifications related to the above embodiments will be described.
前記各実施形態では、駆動力を発生するアクチュエータとして、電動モータ5(動力源モータ5)を用いたが、電動モータ5以外の電動アクチュエータ、あるいは、油圧アクチュエータ等の他の形態のアクチュエータを用いてもよい。
In each of the embodiments described above, the electric motor 5 (power source motor 5) is used as the actuator that generates the driving force. However, an electric actuator other than the
また、前記第1実施形態では、粘性特性係数Kdpと切換超平面σ=0の傾き(又は切換超平面σ=0上の収束時定数Tc)との間の相関関係を、前記式(22)により表される演算式によって特定する代わりに、マップデータによって特定しておき、動力伝達装置1の動作制御時に、該マップデータに基づいて、切換超平面σ=0の傾き(又は切換超平面σ=0上の収束時定数Tc)を、目標粘性特性係数Kdp_cmdに応じて決定するようにしてもよい。
In the first embodiment, the correlation between the viscosity characteristic coefficient Kdp and the gradient of the switching hyperplane σ = 0 (or the convergence time constant Tc on the switching hyperplane σ = 0) is expressed by the above equation (22). Instead of being specified by the arithmetic expression represented by the following equation, it is specified by map data, and when the operation of the
同様に、前記第3実施形態では、粘性特性係数Kdpと剛性特性係数Kspと切換超平面σ=0の傾き(又は切換超平面σ=0上の収束時定数Tc)との間の相関関係を、前記式(62)により表される演算式によって特定する代わりに、マップデータによって特定しておき、動力伝達装置1の動作制御時に、該マップデータに基づいて、切換超平面σ=0の傾き(又は切換超平面σ=0上の収束時定数Tc)を、目標粘性特性係数Kdp_cmd及び目標剛性特性係数Ksp_cmdに応じて決定するようにしてもよい。
Similarly, in the third embodiment, the correlation between the viscosity characteristic coefficient Kdp, the rigidity characteristic coefficient Ksp, and the slope of the switching hyperplane σ = 0 (or the convergence time constant Tc on the switching hyperplane σ = 0) is obtained. , Instead of specifying by the arithmetic expression represented by the equation (62), it is specified by map data, and when the operation of the
また、前記第5実施形態では、動力伝達装置1の動作制御時に、切換超平面σ=0の傾き(又は切換超平面σ=0上の収束時定数Tc)を、目標剛性特性係数Ksp_cmdに応じて前記式(81)に基づき決定する代わりに、式(81)に対応するマップデータに基づき、切換超平面σ=0の傾き(又は切換超平面σ=0上の収束時定数Tc)を、目標剛性特性係数Ksp_cmdに応じて決定するようにしてもよい。
In the fifth embodiment, during the operation control of the
また、弾性力発生機構4の剛性特性係数Kspを一定に保持する前記第1実施形態、第2実施形態及び第4実施形態では、弾性力発生機構4における剛性可変用モータ18を省略し、スプリングウォーム17のシリンダ19と反対側の一端(バネ座部材20a側の一端)を、駆動プーリ2及び被動プーリ3等を回転自在に支持する部材に固定しておくようにしてもよい。
In the first, second, and fourth embodiments in which the stiffness characteristic coefficient Ksp of the elastic force generating mechanism 4 is kept constant, the
また、前記各実施形態では、図2〜図4に示した構成の弾性力発生機構4を採用したが、弾性力発生機構4は、駆動プーリ2(一次側要素)と、被動プーリ3(二次側要素)との間に弾性力及び粘性力を発生可能で、且つ、粘性特性係数を可変的に制御可能であるか、あるいは、粘性特性係数及び剛性特性係数の両方を制御可能なものであれば、他の任意の構造のものでよい。 In each of the above embodiments, the elastic force generation mechanism 4 having the configuration shown in FIGS. 2 to 4 is adopted. However, the elastic force generation mechanism 4 includes the drive pulley 2 (primary element) and the driven pulley 3 (two It is possible to generate elastic force and viscous force with the secondary element) and to control the viscosity characteristic coefficient variably, or to control both the viscosity characteristic coefficient and the rigidity characteristic coefficient. Any other structure may be used as long as it exists.
例えば、弾性力発生機構は、導電性高分子アクチュエータを用いて構成されたものであってもよい。 For example, the elastic force generation mechanism may be configured using a conductive polymer actuator.
また、前記各実施形態における動力伝達装置1は、回転駆動力を伝達するものであるが、本発明における動力伝達装置は、二次側要素が、一次側要素に対して相対的に並進移動するように弾性力発生機構で連結され、両要素間で並進力を伝達するように構成されていてもよい。
The
1…動力伝達装置、2…駆動プーリ(一次側要素)、3…被動プーリ(二次側要素)、4…弾性力発生機構、5…電動モータ(アクチュエータ)、30…制御装置、34…制御入力決定部(制御入力決定手段)、34f…二次側トルク計測部(二次側動力計測手段)、34g…切換超平面可変設定部(切換超平面可変設定手段)、34h…オブザーバ。
DESCRIPTION OF
Claims (24)
前記弾性力発生機構は、前記一次側要素と二次側要素との間の相対速度に応じた粘性力を発生すると共に、当該両要素の間の相対速度の変化に対する前記粘性力の変化の比率を表す粘性特性係数を可変的に制御可能に構成されており、
前記一次側要素と前記二次側要素との間の相対変位量を計測し、該相対変位量の計測値と、該相対変位量の変化に対する前記弾性力発生機構の発生弾性力の変化の比率を表す剛性特性係数の値とから、該発生弾性力によって前記二次側要素に付与される前記二次側動力の計測値を取得する二次側動力計測手段と、
前記二次側動力の計測値と前記目標値との偏差を第1変数成分、該偏差の時間的変化率を第2変数成分として構成される切換関数を用いるスライディングモード制御の制御処理により、該切換関数により規定される切換超平面上で前記第1変数成分をゼロに収束させるように前記アクチュエータの駆動力を制御するための制御入力を逐次決定する制御入力決定手段と、
前記第1変数成分及び第2変数成分を2つの座標軸成分とする位相平面での前記切換超平面の傾きを、前記粘性特性係数の制御値に応じて変化させるように設定する切換超平面可変設定手段とを備え、
前記制御入力決定手段は、前記設定された傾きを有する前記切換超平面に対応する前記切換関数を用いて前記制御入力を決定するように構成されていることを特徴とする動力伝達装置の制御装置。 A primary side element that is displaced by a driving force of an actuator; and a secondary side element that is connected to the primary side element via an elastic force generating mechanism so as to be relatively displaceable with respect to the primary side element. And a power transmission device configured to transmit power between the two elements by the elastic force generated by the elastic force generation mechanism between the two elements in accordance with the relative displacement between the two elements. A control device for controlling secondary power, which is power given to the secondary element by the power transmission, to a target value,
The elastic force generation mechanism generates a viscous force according to a relative speed between the primary side element and the secondary side element, and a ratio of a change in the viscous force to a change in the relative speed between the two elements. The viscosity characteristic coefficient that represents is variably controllable,
The relative displacement amount between the primary side element and the secondary side element is measured, the measured value of the relative displacement amount, and the ratio of the change in the elastic force generated by the elastic force generation mechanism to the change in the relative displacement amount A secondary-side power measuring means for obtaining a measured value of the secondary-side power applied to the secondary-side element by the generated elastic force from the value of the stiffness characteristic coefficient representing
By control processing of sliding mode control using a switching function configured with a deviation between the measured value of the secondary power and the target value as a first variable component, and a temporal change rate of the deviation as a second variable component, Control input determining means for sequentially determining a control input for controlling the driving force of the actuator so that the first variable component converges to zero on a switching hyperplane defined by a switching function;
A switching hyperplane variable setting for setting the inclination of the switching hyperplane in a phase plane having the first variable component and the second variable component as two coordinate axis components according to the control value of the viscosity characteristic coefficient Means and
The control input determining means is configured to determine the control input by using the switching function corresponding to the switching hyperplane having the set inclination. .
前記弾性力発生機構は、前記剛性特性係数が一定値になるように構成されており、
前記切換超平面可変設定手段は、前記切換超平面上での前記第1変数成分のゼロへの収束の時定数として該切換超平面の傾きにより規定される切換超平面上収束時定数と、前記粘性特性係数との間の相関関係が次式(A)により表される関係になるように、前記粘性特性係数の制御値に応じて前記切換超平面の傾きを決定するように構成されていることを特徴とする動力伝達装置の制御装置。
Tc=a+b・Kdp/Ksp ……(A)
ただし、
Tc:前記切換超平面上収束時定数
a,b:あらかじめ決定された定数値
Ksp:前記剛性特性係数の値
Kdp:前記粘性特性係数の値 In the control device of the power transmission device according to claim 1,
The elastic force generation mechanism is configured such that the stiffness characteristic coefficient is a constant value,
The switching hyperplane variable setting means includes a convergence time constant on the switching hyperplane defined by an inclination of the switching hyperplane as a time constant of convergence of the first variable component to zero on the switching hyperplane, The inclination of the switching hyperplane is determined according to the control value of the viscosity characteristic coefficient so that the correlation between the viscosity characteristic coefficient is expressed by the following equation (A). A control device for a power transmission device.
Tc = a + b · Kdp / Ksp (A)
However,
Tc: convergence time constant on the switching hyperplane a, b: predetermined constant value Ksp: value of the stiffness characteristic coefficient Kdp: value of the viscosity characteristic coefficient
前記弾性力発生機構は、前記粘性特性係数と前記剛性特性係数とをそれぞれ可変的に制御可能に構成されており、
前記切換超平面可変設定手段は、前記切換超平面上での前記第1変数成分のゼロへの収束の時定数として該切換超平面の傾きにより規定される切換超平面上収束時定数と、前記粘性特性係数と、前記剛性特性係数との間の相関関係が次式(B)により表される関係になるように、前記粘性特性係数の制御値と前記剛性特性係数の制御値とに応じて前記切換超平面の傾きを決定するように構成されていることを特徴とする動力伝達装置の制御装置。
Tc=(a2/sqrt(Ksp))+a1・Ksp+a0+b・Kdp/Ksp ……(B)
ただし、
Tc:前記切換超平面上収束時定数
a2,a1,a0,b:あらかじめ決定された定数値
Ksp:前記剛性特性係数の値
Kdp:前記粘性特性係数の値 In the control device of the power transmission device according to claim 1,
The elastic force generation mechanism is configured to be able to variably control the viscosity characteristic coefficient and the rigidity characteristic coefficient,
The switching hyperplane variable setting means includes a convergence time constant on the switching hyperplane defined by an inclination of the switching hyperplane as a time constant of convergence of the first variable component to zero on the switching hyperplane, According to the control value of the viscosity characteristic coefficient and the control value of the rigidity characteristic coefficient so that the correlation between the viscosity characteristic coefficient and the rigidity characteristic coefficient is represented by the following equation (B): A control device for a power transmission device configured to determine an inclination of the switching hyperplane.
Tc = (a2 / sqrt (Ksp)) + a1 * Ksp + a0 + b * Kdp / Ksp (B)
However,
Tc: convergence time constant on the switching hyperplane a2, a1, a0, b: constant values determined in advance Ksp: value of the stiffness characteristic coefficient Kdp: value of the viscosity characteristic coefficient
前記制御入力決定手段は、前記切換超平面上で前記第1変数成分をゼロに収束させる機能を有する制御入力成分として次式(C)により算出される第1制御入力成分と、前記切換関数の値をゼロに収束させる機能を有する制御入力成分として該切換関数の値に応じて決定される第2制御入力成分とを合成してなる値を前記制御入力として決定するように構成されていることを特徴とする動力伝達装置の制御装置。
The control input determining means includes a first control input component calculated by the following equation (C) as a control input component having a function of converging the first variable component to zero on the switching hyperplane, and the switching function A value obtained by combining a second control input component determined according to the value of the switching function as a control input component having a function of converging the value to zero is determined as the control input. A control device for a power transmission device.
前記弾性力発生機構は、前記剛性特性係数が一定値になるように構成されており、
前記切換超平面可変設定手段は、前記切換超平面の傾きと、前記粘性特性係数との間の相関関係であって、前記粘性特性係数の複数の代表値と、該粘性特性係数の各代表値に対応してあらかじめ決定された前記切換超平面の傾きとに基づいてあらかじめ特定された相関関係に従って、前記粘性特性係数の制御値に応じて前記切換超平面の傾きを決定するように構成されており、
前記粘性特性係数の各代表値に対応する前記切換超平面の傾きは、前記弾性力発生機構の粘性特性係数を当該代表値に制御した状態で、前記第1変数成分を任意の値からゼロに収束させるときの該第1変数成分の値と前記第2変数成分の値と組の推移の軌跡を示すデータとしてあらかじめ取得された複数の応答特性データのうちの所定の要件を満たす特定の応答特性データに基づいて決定されており、
前記第1変数成分の値の大きさの許容限界値である第1許容限界値とゼロとの間で該第1許容限界値に応じて設定された第1設定値を前記位相平面において示すラインを第1設定値ライン、前記第2変数成分の値の大きさの許容限界値である第2許容限界値とゼロとの間で該第2許容限界値に応じて設定された第2設定値を前記位相平面において示すラインを第2設定値ラインと定義したとき、前記所定の要件を満たす特定の応答特性データは、該特定の応答特性データにより示される前記軌跡上での前記第1変数成分の値の大きさと前記第2変数成分の値の大きさとがそれぞれ前記第1許容限界値以下と第2許容限界値以下とに収まり、且つ、該軌跡が前記第1設定値ライン又は第2設定値ラインと交わるという要件を満たす応答特性データであり、
前記粘性特性係数の各代表値に対応する前記切換超平面の傾きは、前記位相平面において、前記特定の応答特性データのそれぞれにより示される前記軌跡と前記第1設定値ライン又は第2設定値ラインとの交点のうち、該交点と前記位相平面の原点とを結ぶライン上での前記第1変数成分のゼロへの収束の時定数が、あらかじめ定めた要求範囲内の値であるという制約条件を満たす交点と、該位相平面の原点とを結ぶラインの傾きに一致又は近似するように決定されていることを特徴とする動力伝達装置の制御装置。 In the control device of the power transmission device according to claim 1,
The elastic force generation mechanism is configured such that the stiffness characteristic coefficient is a constant value,
The switching hyperplane variable setting means is a correlation between the inclination of the switching hyperplane and the viscosity characteristic coefficient, and includes a plurality of representative values of the viscosity characteristic coefficient, and representative values of the viscosity characteristic coefficient. The inclination of the switching hyperplane is determined according to the control value of the viscosity characteristic coefficient in accordance with a correlation specified in advance based on the inclination of the switching hyperplane determined in advance corresponding to And
The inclination of the switching hyperplane corresponding to each representative value of the viscosity characteristic coefficient is such that the first variable component is changed from an arbitrary value to zero while the viscosity characteristic coefficient of the elastic force generation mechanism is controlled to the representative value. Specific response characteristics satisfying a predetermined requirement among a plurality of response characteristic data acquired in advance as data indicating a locus of transition of a set of the value of the first variable component and the value of the second variable component at the time of convergence Based on data,
A line indicating, on the phase plane, a first set value set according to the first allowable limit value between a first allowable limit value which is an allowable limit value of the magnitude of the value of the first variable component and zero. , A first set value line, a second set value set according to the second allowable limit value between zero and a second allowable limit value which is an allowable limit value of the value of the second variable component Is defined as a second set value line, the specific response characteristic data satisfying the predetermined requirement is the first variable component on the locus indicated by the specific response characteristic data. And the value of the second variable component fall within the first allowable limit value and the second allowable limit value, respectively, and the locus is the first set value line or the second set value. Response characteristic data that satisfies the requirement to cross the value line It is in,
The inclination of the switching hyperplane corresponding to each representative value of the viscosity characteristic coefficient is the locus indicated by each of the specific response characteristic data and the first set value line or the second set value line in the phase plane. The constraint that the time constant of convergence of the first variable component to zero on the line connecting the intersection and the origin of the phase plane is a value within a predetermined required range among A control device for a power transmission device, wherein the control device is determined so as to match or approximate an inclination of a line connecting a satisfying intersection and an origin of the phase plane.
前記第1許容限界値は、前記アクチュエータの駆動力による前記一次側要素の変位速度及び変位加速度がそれぞれあらかじめ定められた許容限界値を超えないように、該一次側要素の変位速度の許容限界値と該一次側要素の変位加速度の許容限界値と前記剛性特性係数の値とに応じて設定された値であることを特徴とする動力伝達装置の制御装置。 In the control apparatus of the power transmission device according to claim 5,
The first permissible limit value is a permissible limit value of the displacement speed of the primary side element so that a displacement speed and a displacement acceleration of the primary side element due to the driving force of the actuator do not exceed predetermined permissible limit values, respectively. And an allowable limit value of displacement acceleration of the primary side element and a value of the stiffness characteristic coefficient.
前記第2許容限界値は、前記アクチュエータから前記二次側要素に至る動力伝達系の固有振動に応じた該動力伝達系の振動の発生を防止するように、前記剛性特性係数の値に応じて設定された値であることを特徴とする動力伝達装置の制御装置。 In the control apparatus of the power transmission device according to claim 5 or 6,
The second permissible limit value depends on the value of the stiffness characteristic coefficient so as to prevent the occurrence of vibration of the power transmission system according to the natural vibration of the power transmission system from the actuator to the secondary element. A control device for a power transmission device, which is a set value.
前記弾性力発生機構は、前記粘性特性係数と前記剛性特性係数とをそれぞれ可変的に制御可能に構成されており、
前記切換超平面可変設定手段は、前記切換超平面の傾きと、前記粘性特性係数と、前記剛性特性係数との間の相関関係であって、前記粘性特性係数の複数の代表値と、前記剛性特性係数の複数の代表値と、該粘性特性係数及び剛性特性係数の各代表値の組のそれぞれに対応してあらかじめ決定された前記切換超平面の傾きとに基づいてあらかじめ決定された相関関係に従って、前記粘性特性係数の制御値と、前記剛性特性係数の制御値とに応じて前記切換超平面の傾きを決定するように構成されており、
前記粘性特性係数及び剛性特性係数の各代表値の組のそれぞれに対応する前記切換超平面の傾きは、前記弾性力発生機構の粘性特性係数及び剛性特性係数をそれぞれ当該代表値に制御した状態で、前記第1変数成分を任意の値からゼロに収束させるときの該第1変数成分の値と前記第2変数成分の値と組の推移の軌跡を示すデータとしてあらかじめ取得された複数の応答特性データのうちの所定の要件を満たす特定の応答特性データに基づいて決定されており、
前記第1変数成分の値の大きさの許容限界値である第1許容限界値とゼロとの間で該第1許容限界値に応じて設定された第1設定値を前記位相平面において示すラインを第1設定値ライン、前記第2変数成分の値の大きさの許容限界値である第2許容限界値とゼロとの間で該第2許容限界値に応じて設定された第2設定値を前記位相平面において示すラインを第2設定値ラインと定義したとき、前記所定の要件を満たす特定の応答特性データは、該特定の応答特性データにより示される前記軌跡上での前記第1変数成分の値の大きさと前記第2変数成分の値の大きさとがそれぞれ前記第1許容限界値以下と第2許容限界値以下とに収まり、且つ、該軌跡が前記第1設定値ライン又は第2設定値ラインと交わるという要件を満たす応答特性データであり、
前記粘性特性係数及び剛性特性係数の各代表値の組のそれぞれに対応する前記切換超平面の傾きは、前記位相平面において、前記特定の応答特性データのそれぞれにより示される前記軌跡と前記第1設定値ライン又は第2設定値ラインとの交点のうち、該交点と前記位相平面の原点とを結ぶライン上での前記第1変数成分のゼロへの収束の時定数が、あらかじめ定めた要求範囲内の値であるという制約条件を満たす交点と、該位相平面の原点とを結ぶラインの傾きに一致又は近似するように決定されていることを特徴とする動力伝達装置の制御装置。 In the control device of the power transmission device according to claim 1,
The elastic force generation mechanism is configured to be able to variably control the viscosity characteristic coefficient and the rigidity characteristic coefficient,
The switching hyperplane variable setting means is a correlation among the inclination of the switching hyperplane, the viscosity characteristic coefficient, and the stiffness characteristic coefficient, wherein a plurality of representative values of the viscosity characteristic coefficient, and the stiffness In accordance with a predetermined correlation based on a plurality of representative values of the characteristic coefficient and the inclination of the switching hyperplane determined in advance corresponding to each set of representative values of the viscosity characteristic coefficient and the rigidity characteristic coefficient The inclination of the switching hyperplane is determined according to the control value of the viscosity characteristic coefficient and the control value of the rigidity characteristic coefficient,
The inclination of the switching hyperplane corresponding to each set of representative values of the viscosity characteristic coefficient and the rigidity characteristic coefficient is in a state where the viscosity characteristic coefficient and the rigidity characteristic coefficient of the elastic force generation mechanism are controlled to the representative values, respectively. , A plurality of response characteristics acquired in advance as data indicating a locus of transition of a set of the value of the first variable component and the value of the second variable component when the first variable component is converged from an arbitrary value to zero Determined based on specific response characteristics data that meets certain requirements of the data,
A line indicating, on the phase plane, a first set value set according to the first allowable limit value between a first allowable limit value which is an allowable limit value of the magnitude of the value of the first variable component and zero. , A first set value line, a second set value set according to the second allowable limit value between zero and a second allowable limit value which is an allowable limit value of the value of the second variable component Is defined as a second set value line, the specific response characteristic data satisfying the predetermined requirement is the first variable component on the locus indicated by the specific response characteristic data. And the value of the second variable component fall within the first allowable limit value and the second allowable limit value, respectively, and the locus is the first set value line or the second set value. Response characteristic data that satisfies the requirement to cross the value line It is in,
The inclination of the switching hyperplane corresponding to each set of representative values of the viscosity characteristic coefficient and the rigidity characteristic coefficient is the trajectory indicated by each of the specific response characteristic data and the first setting on the phase plane. Among the intersections with the value line or the second set value line, the time constant for convergence of the first variable component to zero on the line connecting the intersection and the origin of the phase plane is within a predetermined required range. A control device for a power transmission device, wherein the control device is determined so as to coincide with or approximate to an inclination of a line connecting an intersection satisfying a constraint condition that is a value of and an origin of the phase plane.
前記第1許容限界値は、前記剛性特性係数の各代表値に対応して設定される値であり、該剛性特性係数の各代表値に対応する前記第1許容限界値は、前記弾性力発生機構の剛性特性係数を当該代表値に制御した状態で、前記アクチュエータの駆動力による前記一次側要素の変位速度及び変位加速度がそれぞれあらかじめ定められた許容限界値を超えないように、該一次側要素の変位速度の許容限界値と該一次側要素の変位加速度の許容限界値と前記剛性特性係数の当該代表値とに応じて設定された値であることを特徴とする動力伝達装置の制御装置。 The control device for a power transmission device according to claim 8,
The first permissible limit value is a value set corresponding to each representative value of the stiffness characteristic coefficient, and the first permissible limit value corresponding to each representative value of the stiffness characteristic coefficient is the elastic force generation In a state in which the stiffness characteristic coefficient of the mechanism is controlled to the representative value, the primary side element is controlled such that the displacement speed and the displacement acceleration of the primary side element due to the driving force of the actuator do not exceed predetermined allowable limit values. A control device for a power transmission device, characterized in that the value is set in accordance with a permissible limit value of the displacement speed, a permissible limit value of the displacement acceleration of the primary side element, and the representative value of the stiffness characteristic coefficient.
前記第2許容限界値は、前記剛性特性係数の各代表値に対応して設定される値であり、該剛性特性係数の各代表値に対応する前記第2許容限界値は、前記弾性力発生機構の剛性特性係数を当該代表値に制御した状態で、前記アクチュエータから前記二次側要素に至る動力伝達系の固有振動に応じた該動力伝達系の振動の発生を防止するように、前記剛性特性係数の当該代表値に応じて決定された値であることを特徴とする動力伝達装置の制御装置。 In the control device of the power transmission device according to claim 8 or 9,
The second permissible limit value is a value set corresponding to each representative value of the stiffness characteristic coefficient, and the second permissible limit value corresponding to each representative value of the stiffness characteristic coefficient is the elastic force generation In a state where the stiffness characteristic coefficient of the mechanism is controlled to the representative value, the rigidity of the power transmission system is prevented from occurring in accordance with the natural vibration of the power transmission system from the actuator to the secondary element. A control device for a power transmission device, which is a value determined according to the representative value of the characteristic coefficient.
前記第1変数成分の値をゼロから前記第1許容限界値までステップ状に変化させると共に該第1変数成分の値のゼロへの収束を前記アクチュエータの駆動力による前記一次側要素の変位加速度が該変位加速度の許容限界値になるように行なったと仮定した場合に実現される時定数を特定時定数と定義しとき、前記制約条件は、前記第1変数成分のゼロへの収束の時定数を、前記特定時定数以上の範囲の値に制限する条件であることを特徴とする動力伝達装置の制御装置。 In the control apparatus of the power transmission device according to any one of claims 5 to 10,
The value of the first variable component is changed stepwise from zero to the first permissible limit value, and the convergence of the value of the first variable component to zero is caused by the displacement acceleration of the primary side element by the driving force of the actuator. When the time constant realized when assuming that the displacement acceleration is set to the allowable limit value is defined as a specific time constant, the constraint condition is that the time constant of convergence of the first variable component to zero is A control device for a power transmission device, characterized in that the condition is limited to a value in a range not less than the specific time constant.
前記二次側動力の計測値と該二次側動力の目標値とから算出される前記第1変数成分の値である第1変数成分計測値と、該第1変数成分計測値の時間的変化率として算出される前記第2変数成分の値である第2変数成分計測値とから外乱による影響を低減してなる前記第1変数成分の推定値と前記第2変数成分の推定値とを逐次算出するオブザーバをさらに備えており、
前記制御入力決定手段は、前記第1変数成分計測値と前記第2変数成分計測値との代わりに、前記オブザーバにより算出された前記第1変数成分の推定値と第2変数成分の推定値とを用いて前記切換関数の値を算出しつつ、該切換関数の値を用いて前記制御入力を逐次生成するように構成されていることを特徴とする動力伝達装置の制御装置。 In the control apparatus of the power transmission device according to any one of claims 1 to 11,
A first variable component measurement value that is a value of the first variable component calculated from the measurement value of the secondary power and the target value of the secondary power, and a temporal change of the first variable component measurement value The estimated value of the first variable component and the estimated value of the second variable component obtained by reducing the influence of disturbance from the second variable component measured value that is the value of the second variable component calculated as a rate are sequentially It also has an observer to calculate,
The control input determining means includes an estimated value of the first variable component and an estimated value of the second variable component calculated by the observer instead of the first variable component measured value and the second variable component measured value. A control device for a power transmission device, wherein the control input is sequentially generated by using the value of the switching function while calculating the value of the switching function using.
前記弾性力発生機構は、前記一次側要素と二次側要素との間の相対速度に応じた粘性力を発生すると共に、当該両要素の間の相対速度の変化に対する前記粘性力の変化の比率を表す粘性特性係数を可変的に制御可能に構成されており、
前記一次側要素と前記二次側要素との間の相対変位量を計測し、該相対変位量の計測値と、該相対変位量の変化に対する前記弾性力発生機構の発生弾性力の変化の比率を表す剛性特性係数の値とから、該発生弾性力によって前記二次側要素に付与される前記二次側動力の計測値を取得する二次側動力計測手段と、
前記二次側動力の計測値と前記目標値との偏差を第1変数成分、該偏差の時間的変化率を第2変数成分として構成される切換関数を用いるスライディングモード制御の制御処理により、該切換関数により規定される切換超平面上で前記第1変数成分をゼロに収束させるように前記アクチュエータの駆動力を制御するための制御入力を逐次決定する制御入力決定手段とを備え、
前記制御入力決定手段は、前記粘性特性係数の制御値をあらかじめ決定された補正係数により補正してなる補正値と、前記第1変数成分及び第2変数成分を2つの座標軸成分とする位相平面における前記切換超平面の傾きが前記粘性特性係数の制御値の変化に依存しない傾きになるように決定された前記切換関数とを用いて前記制御入力を決定するように構成されていることを特徴とする動力伝達装置の制御装置。 A primary side element that is displaced by a driving force of an actuator; and a secondary side element that is connected to the primary side element via an elastic force generating mechanism so as to be relatively displaceable with respect to the primary side element. And a power transmission device configured to transmit power between the two elements by the elastic force generated by the elastic force generation mechanism between the two elements in accordance with the relative displacement between the two elements. A control device for controlling secondary power, which is power given to the secondary element by the power transmission, to a target value,
The elastic force generation mechanism generates a viscous force according to a relative speed between the primary side element and the secondary side element, and a ratio of a change in the viscous force to a change in the relative speed between the two elements. The viscosity characteristic coefficient that represents is variably controllable,
The relative displacement amount between the primary side element and the secondary side element is measured, the measured value of the relative displacement amount, and the ratio of the change in the elastic force generated by the elastic force generation mechanism to the change in the relative displacement amount A secondary-side power measuring means for obtaining a measured value of the secondary-side power applied to the secondary-side element by the generated elastic force from the value of the stiffness characteristic coefficient representing
By control processing of sliding mode control using a switching function configured with a deviation between the measured value of the secondary power and the target value as a first variable component, and a temporal change rate of the deviation as a second variable component, Control input determining means for sequentially determining a control input for controlling the driving force of the actuator so that the first variable component converges to zero on a switching hyperplane defined by a switching function;
The control input determination means is a phase plane having a correction value obtained by correcting the control value of the viscosity characteristic coefficient with a predetermined correction coefficient, and the first variable component and the second variable component as two coordinate axis components. The control input is determined using the switching function determined so that the inclination of the switching hyperplane becomes an inclination independent of a change in the control value of the viscosity characteristic coefficient. Control device for power transmission device.
前記制御入力決定手段は、前記切換超平面上で前記第1変数成分をゼロに収束させる機能を有する制御入力成分として次式(D)により算出される第1制御入力成分と、前記切換関数の値をゼロに収束させる機能を有する制御入力成分として該切換関数の値に応じて決定される第2制御入力成分とを合成してなる値を前記制御入力として決定するように構成されていることを特徴とする動力伝達装置の制御装置。
The control input determining means includes a first control input component calculated by the following equation (D) as a control input component having a function of converging the first variable component to zero on the switching hyperplane, and the switching function A value obtained by combining a second control input component determined according to the value of the switching function as a control input component having a function of converging the value to zero is determined as the control input. A control device for a power transmission device.
前記弾性力発生機構は、前記剛性特性係数が一定値になるように構成されており、
前記第1変数成分をゼロに収束させるための適正時定数と、前記粘性特性係数との間の相関関係であって、前記粘性特性係数の複数の代表値と、該粘性特性係数の各代表値に対応してあらかじめ決定された前記適正時定数の値とに基づいてあらかじめ特定された相関関係において、前記粘性特性係数の値がゼロであるときの前記適正時定数の値に、前記切換超平面上での前記第1変数成分のゼロへの収束の時定数である切換超平面上収束時定数が一致するように、前記切換超平面の傾きが決定されていると共に、該相関関係において、任意の粘性特性係数の値に対応する前記適正時定数の値が、前記粘性特性係数の値がゼロであるときの前記適正時定数の値との差が、当該任意の粘性特性係数の値を前記補正係数により補正してなる補正値の関数値となるように前記補正係数が決定されており、
前記粘性特性係数の各代表値に対応する前記適正時定数の値は、前記弾性力発生機構の粘性特性係数を当該代表値に制御した状態で、前記第1変数成分を任意の値からゼロに収束させるときの該第1変数成分の値と前記第2変数成分の値と組の推移の軌跡を示すデータとしてあらかじめ取得された複数の応答特性データのうちの所定の要件を満たす特定の応答特性データに基づいて決定されており、
前記第1変数成分の値の大きさの許容限界値である第1許容限界値とゼロとの間で該第1許容限界値に応じて設定された第1設定値を前記位相平面において示すラインを第1設定値ライン、前記第2変数成分の値の大きさの許容限界値である第2許容限界値とゼロとの間で該第2許容限界値に応じて設定された第2設定値を前記位相平面において示すラインを第2設定値ラインと定義したとき、前記所定の要件を満たす特定の応答特性データは、該特定の応答特性データにより示される前記軌跡上での前記第1変数成分の値の大きさと前記第2変数成分の値の大きさとがそれぞれ前記第1許容限界値以下と第2許容限界値以下とに収まり、且つ、該軌跡が前記第1設定値ライン又は第2設定値ラインと交わるという要件を満たす応答特性データであり、
前記粘性特性係数の各代表値に対応する前記適正時定数の値は、前記位相平面において、前記特定の応答特性データのそれぞれにより示される前記軌跡と前記第1設定値ライン又は第2設定値ラインとの交点のうち、該交点と前記位相平面の原点とを結ぶライン上での前記第1変数成分のゼロへの収束の時定数が、あらかじめ定めた要求範囲内の値であるという制約条件を満たす交点と、該位相平面の原点とを結ぶライン上での前記第1変数成分のゼロへの収束の時定数に一致又は近似するように設定されていることを特徴とする動力伝達装置の制御装置。 In the control device of the power transmission device according to claim 13 or 14,
The elastic force generation mechanism is configured such that the stiffness characteristic coefficient is a constant value,
Correlation between an appropriate time constant for converging the first variable component to zero and the viscosity characteristic coefficient, and a plurality of representative values of the viscosity characteristic coefficient and representative values of the viscosity characteristic coefficient The switching hyperplane to the value of the appropriate time constant when the value of the viscosity characteristic coefficient is zero in the correlation specified in advance based on the value of the appropriate time constant determined in advance corresponding to The inclination of the switching hyperplane is determined so that the convergence time constant on the switching hyperplane, which is the time constant of convergence of the first variable component to zero above, matches, and in the correlation, any The difference between the value of the appropriate time constant corresponding to the value of the viscosity characteristic coefficient and the value of the appropriate time constant when the value of the viscosity characteristic coefficient is zero is the value of the arbitrary viscosity characteristic coefficient. Of the correction value corrected by the correction coefficient Numerical and said correction coefficient are determined so that,
The value of the appropriate time constant corresponding to each representative value of the viscosity characteristic coefficient is set such that the first variable component is changed from an arbitrary value to zero while the viscosity characteristic coefficient of the elastic force generation mechanism is controlled to the representative value. Specific response characteristics satisfying a predetermined requirement among a plurality of response characteristic data acquired in advance as data indicating a locus of transition of a set of the value of the first variable component and the value of the second variable component at the time of convergence Based on data,
A line indicating, on the phase plane, a first set value set according to the first allowable limit value between a first allowable limit value which is an allowable limit value of the magnitude of the value of the first variable component and zero. , A first set value line, a second set value set according to the second allowable limit value between zero and a second allowable limit value which is an allowable limit value of the value of the second variable component Is defined as a second set value line, the specific response characteristic data satisfying the predetermined requirement is the first variable component on the locus indicated by the specific response characteristic data. And the value of the second variable component fall within the first allowable limit value and the second allowable limit value, respectively, and the locus is the first set value line or the second set value. Response characteristic data that satisfies the requirement to cross the value line It is in,
The value of the appropriate time constant corresponding to each representative value of the viscosity characteristic coefficient is the trajectory indicated by each of the specific response characteristic data and the first set value line or the second set value line on the phase plane. The constraint that the time constant of convergence of the first variable component to zero on the line connecting the intersection and the origin of the phase plane is a value within a predetermined required range among Control of the power transmission device, which is set so as to coincide with or approximate a time constant of convergence of the first variable component to zero on a line connecting a satisfying intersection and the origin of the phase plane apparatus.
前記相関関係は、次式(E)により表される関係であることを特徴とする動力伝達装置の制御装置。
Tc=a+b・Kdp/Ksp ……(E)
ただし、
Tc:前記適正時定数の値
Ksp:前記剛性特性係数の値
Kdp:前記粘性特性係数の値
a:あらかじめ決定された所定値
b:前記補正係数としてあらかじめ決定された所定値 The control device for a power transmission device according to claim 15,
The control device for a power transmission device, wherein the correlation is a relationship represented by the following equation (E):
Tc = a + b · Kdp / Ksp (E)
However,
Tc: value of the appropriate time constant Ksp: value of the stiffness characteristic coefficient Kdp: value of the viscous characteristic coefficient a: predetermined value determined in advance b: predetermined value determined in advance as the correction coefficient
前記第1許容限界値は、前記アクチュエータの駆動力による前記一次側要素の変位速度及び変位加速度がそれぞれあらかじめ定められた許容限界値を超えないように、該一次側要素の変位速度の許容限界値と該一次側要素の変位加速度の許容限界値と前記剛性特性係数の値とに応じて決定された値であることを特徴とする動力伝達装置の制御装置。 The control device for a power transmission device according to claim 15 or 16,
The first permissible limit value is a permissible limit value of the displacement speed of the primary side element so that a displacement speed and a displacement acceleration of the primary side element due to the driving force of the actuator do not exceed predetermined permissible limit values, respectively. And a value determined in accordance with an allowable limit value of displacement acceleration of the primary side element and the value of the stiffness characteristic coefficient.
前記第2許容限界値は、前記アクチュエータから前記二次側要素に至る動力伝達系の固有振動に応じた該動力伝達系の振動の発生を防止するように、前記剛性特性係数の値に応じて決定された値であることを特徴とする動力伝達装置の制御装置。 In the control apparatus of the power transmission device according to any one of claims 15 to 17,
The second permissible limit value depends on the value of the stiffness characteristic coefficient so as to prevent the occurrence of vibration of the power transmission system according to the natural vibration of the power transmission system from the actuator to the secondary element. A control device for a power transmission device, wherein the control value is a determined value.
前記弾性力発生機構は、前記粘性特性係数と前記剛性特性係数とをそれぞれ可変的に制御可能に構成されており、
前記切換超平面の傾きを前記剛性特性係数の制御値に応じて変化させるように設定する切換超平面可変設定手段とを備え、
該切換超平面可変設定手段は、前記第1変数成分をゼロに収束させるための適正時定数と、前記粘性特性係数と、前記剛性特性係数との間の相関関係であって、前記粘性特性係数の複数の代表値と、前記剛性特性係数の複数の代表値と、該粘性特性係数及び剛性特性係数の各代表値の組のそれぞれに対応してあらかじめ決定された前記適正時定数の値とに基づいてあらかじめ特定された相関関係において、前記粘性特性係数の値をゼロとし、且つ、前記剛性特性係数の値を該剛性特性係数の制御値に一致させたときの前記適正時定数の値に、前記切換超平面上での前記第1変数成分のゼロへの収束の時定数である切換超平面上収束時定数が一致するように、前記剛性特性係数の制御値に応じて前記切換超平面の傾きを決定するように構成されており、
さらに、前記相関関係において、任意の粘性特性係数の値に対応する前記適正時定数の値と前記粘性特性係数の値がゼロであるときの前記適正時定数の値との差が、当該任意の粘性特性係数の値を前記補正係数により補正してなる補正値の関数値となるように前記補正係数があらかじめ決定されており、
前記粘性特性係数及び剛性特性係数の各代表値の組のそれぞれに対応する前記適正時定数の値は、前記弾性力発生機構の粘性特性係数及び剛性特性係数をそれぞれ当該代表値に制御した状態で、前記第1変数成分を任意の値からゼロに収束させるときの該第1変数成分の値と前記第2変数成分の値と組の推移の軌跡を示すデータとしてあらかじめ取得された複数の応答特性データのうちの所定の要件を満たす特定の応答特性データに基づいて決定されており、
前記第1変数成分の値の大きさの許容限界値である第1許容限界値とゼロとの間で該第1許容限界値に応じて設定された第1設定値を前記位相平面において示すラインを第1設定値ライン、前記第2変数成分の値の大きさの許容限界値である第2許容限界値とゼロとの間で該第2許容限界値に応じて設定された第2設定値を前記位相平面において示すラインを第2設定値ラインと定義したとき、前記所定の要件を満たす特定の応答特性データは、該特定の応答特性データにより示される前記軌跡上での前記第1変数成分の値の大きさと前記第2変数成分の値の大きさとがそれぞれ前記第1許容限界値以下と第2許容限界値以下とに収まり、且つ、該軌跡が前記第1設定値ライン又は第2設定値ラインと交わるという要件を満たす応答特性データであり、
前記粘性特性係数及び剛性特性係数の各代表値の組のそれぞれに対応する前記適正時定数の値は、前記位相平面において、前記特定の応答特性データのそれぞれにより示される前記軌跡と前記第1設定値ライン又は第2設定値ラインとの交点のうち、該交点と前記位相平面の原点とを結ぶライン上での前記第1変数成分のゼロへの収束の時定数が、あらかじめ定めた要求範囲内の値であるという制約条件を満たす交点と、該位相平面の原点とを結ぶライン上での前記第1変数成分のゼロへの収束の時定数に一致又は近似するように決定されていることを特徴とする動力伝達装置の制御装置。 In the control device of the power transmission device according to claim 13 or 14,
The elastic force generation mechanism is configured to be able to variably control the viscosity characteristic coefficient and the rigidity characteristic coefficient,
Switching hyperplane variable setting means for setting the inclination of the switching hyperplane to change according to the control value of the stiffness characteristic coefficient,
The switching hyperplane variable setting means is a correlation between an appropriate time constant for converging the first variable component to zero, the viscosity characteristic coefficient, and the stiffness characteristic coefficient, wherein the viscosity characteristic coefficient A plurality of representative values, a plurality of representative values of the stiffness characteristic coefficient, and a value of the appropriate time constant determined in advance corresponding to each set of representative values of the viscosity characteristic coefficient and the stiffness characteristic coefficient. Based on the correlation specified in advance, the value of the viscosity characteristic coefficient is set to zero, and the value of the appropriate time constant when the value of the rigidity characteristic coefficient matches the control value of the rigidity characteristic coefficient, Depending on the control value of the stiffness characteristic coefficient, the switching hyperplane has a convergence time constant on the switching hyperplane that is a time constant for convergence of the first variable component to zero on the switching hyperplane. Configured to determine the tilt Cage,
Further, in the correlation, the difference between the value of the appropriate time constant corresponding to the value of the arbitrary viscosity characteristic coefficient and the value of the appropriate time constant when the value of the viscosity characteristic coefficient is zero is the arbitrary time constant. The correction coefficient is determined in advance to be a function value of a correction value obtained by correcting the value of the viscosity characteristic coefficient with the correction coefficient,
The value of the appropriate time constant corresponding to each set of representative values of the viscosity characteristic coefficient and the rigidity characteristic coefficient is the state in which the viscosity characteristic coefficient and the rigidity characteristic coefficient of the elastic force generation mechanism are controlled to the representative values, respectively. , A plurality of response characteristics acquired in advance as data indicating a locus of transition of a set of the value of the first variable component and the value of the second variable component when the first variable component is converged from an arbitrary value to zero Determined based on specific response characteristics data that meets certain requirements of the data,
A line indicating, on the phase plane, a first set value set according to the first allowable limit value between a first allowable limit value which is an allowable limit value of the magnitude of the value of the first variable component and zero. , A first set value line, a second set value set according to the second allowable limit value between zero and a second allowable limit value which is an allowable limit value of the value of the second variable component Is defined as a second set value line, the specific response characteristic data satisfying the predetermined requirement is the first variable component on the locus indicated by the specific response characteristic data. And the value of the second variable component fall within the first allowable limit value and the second allowable limit value, respectively, and the locus is the first set value line or the second set value. Response characteristic data that satisfies the requirement to cross the value line It is in,
The value of the appropriate time constant corresponding to each set of representative values of the viscosity characteristic coefficient and the stiffness characteristic coefficient is the trajectory indicated by each of the specific response characteristic data and the first setting on the phase plane. Among the intersections with the value line or the second set value line, the time constant for convergence of the first variable component to zero on the line connecting the intersection and the origin of the phase plane is within a predetermined required range. Is determined so as to match or approximate the time constant of convergence of the first variable component to zero on a line connecting the intersection satisfying the constraint that the value is the value of and the origin of the phase plane. A control device for a power transmission device.
前記相関関係は、次式(F)により表される関係であることを特徴とする動力伝達装置の制御装置。
Tc=(a2/sqrt(Ksp))+a1・Ksp+a0+b・Kdp/Ksp ……(F)
ただし、
Tc:前記適正時定数の値
Ksp:前記剛性特性係数の値
Kdp:前記粘性特性係数の値
a2,a1,a0:あらかじめ決定された所定値
b:前記補正係数としてあらかじめ決定された所定値 The control device for a power transmission device according to claim 19,
The control device for a power transmission device, wherein the correlation is a relationship represented by the following equation (F).
Tc = (a2 / sqrt (Ksp)) + a1 · Ksp + a0 + b · Kdp / Ksp (F)
However,
Tc: value of the appropriate time constant Ksp: value of the stiffness characteristic coefficient Kdp: value of the viscosity characteristic coefficient a2, a1, a0: predetermined value determined in advance b: predetermined value determined in advance as the correction coefficient
前記第1許容限界値は、前記剛性特性係数の各代表値に対応して設定される値であり、該剛性特性係数の各代表値に対応する前記第1許容限界値は、前記弾性力発生機構の剛性特性係数を当該代表値に制御した状態で、前記アクチュエータの駆動力による前記一次側要素の変位速度及び変位加速度がそれぞれあらかじめ定められた許容限界値を超えないように、該一次側要素の変位速度の許容限界値と該一次側要素の変位加速度の許容限界値と前記剛性特性係数の当該代表値とに応じて決定された値であることを特徴とする動力伝達装置の制御装置。 The control device for a power transmission device according to claim 19 or 20,
The first permissible limit value is a value set corresponding to each representative value of the stiffness characteristic coefficient, and the first permissible limit value corresponding to each representative value of the stiffness characteristic coefficient is the elastic force generation In a state in which the stiffness characteristic coefficient of the mechanism is controlled to the representative value, the primary side element is controlled such that the displacement speed and the displacement acceleration of the primary side element due to the driving force of the actuator do not exceed predetermined allowable limit values. A control device for a power transmission device, characterized in that the value is determined in accordance with a permissible limit value of the displacement speed, a permissible limit value of the displacement acceleration of the primary side element, and the representative value of the stiffness characteristic coefficient.
前記第2許容限界値は、前記剛性特性係数の各代表値に対応して設定される値であり、該剛性特性係数の各代表値に対応する前記第2許容限界値は、前記弾性力発生機構の剛性特性係数を当該代表値に制御した状態で、前記アクチュエータから前記二次側要素に至る動力伝達系の固有振動に応じた該動力伝達系の振動の発生を防止するように、前記剛性特性係数の当該代表値に応じて決定された値であることを特徴とする動力伝達装置の制御装置。 In the control apparatus of the power transmission device according to any one of claims 19 to 21,
The second permissible limit value is a value set corresponding to each representative value of the stiffness characteristic coefficient, and the second permissible limit value corresponding to each representative value of the stiffness characteristic coefficient is the elastic force generation In a state where the stiffness characteristic coefficient of the mechanism is controlled to the representative value, the rigidity of the power transmission system is prevented from occurring in accordance with the natural vibration of the power transmission system from the actuator to the secondary element. A control device for a power transmission device, which is a value determined according to the representative value of the characteristic coefficient.
前記第1変数成分の値をゼロから前記第1許容限界値までステップ状に変化させると共に該第1変数成分の値のゼロへの収束を前記アクチュエータの駆動力による前記一次側要素の変位加速度が該変位加速度の許容限界値になるように行なったと仮定した場合に実現される時定数を特定時定数と定義しとき、前記制約条件は、前記第1変数成分のゼロへの収束の時定数を、前記特定時定数以上の範囲の値に制限する条件であることを特徴とする動力伝達装置の制御装置。 In the control apparatus of the power transmission device according to any one of claims 15 to 22,
The value of the first variable component is changed stepwise from zero to the first permissible limit value, and the convergence of the value of the first variable component to zero is caused by the displacement acceleration of the primary side element by the driving force of the actuator. When the time constant realized when assuming that the displacement acceleration is set to the allowable limit value is defined as a specific time constant, the constraint condition is that the time constant of convergence of the first variable component to zero is A control device for a power transmission device, characterized in that the condition is limited to a value in a range not less than the specific time constant.
前記二次側動力の計測値と該二次側動力の目標値とから算出される前記第1変数成分の値である第1変数成分計測値と、該第1変数成分計測値の時間的変化率として算出される前記第2変数成分の値である第2変数成分計測値とから外乱による影響を低減してなる前記第1変数成分の推定値と前記第2変数成分の推定値とを逐次算出するオブザーバをさらに備えており、
前記制御入力決定手段は、前記第1変数成分計測値と前記第2変数成分計測値との代わりに、前記オブザーバにより算出された前記第1変数成分の推定値と第2変数成分の推定値とを用いて前記切換関数の値を算出しつつ、該切換関数の値を用いて前記制御入力を逐次生成するように構成されていることを特徴とする動力伝達装置の制御装置。 In the control apparatus of the power transmission device according to any one of claims 13 to 23,
A first variable component measurement value that is a value of the first variable component calculated from the measurement value of the secondary power and the target value of the secondary power, and a temporal change of the first variable component measurement value The estimated value of the first variable component and the estimated value of the second variable component obtained by reducing the influence of disturbance from the second variable component measured value that is the value of the second variable component calculated as a rate are sequentially It also has an observer to calculate,
The control input determining means includes an estimated value of the first variable component and an estimated value of the second variable component calculated by the observer instead of the first variable component measured value and the second variable component measured value. A control device for a power transmission device, wherein the control input is sequentially generated by using the value of the switching function while calculating the value of the switching function using.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2012286343A JP5946762B2 (en) | 2012-12-27 | 2012-12-27 | Power transmission control device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2012286343A JP5946762B2 (en) | 2012-12-27 | 2012-12-27 | Power transmission control device |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2014128835A true JP2014128835A (en) | 2014-07-10 |
JP5946762B2 JP5946762B2 (en) | 2016-07-06 |
Family
ID=51407723
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2012286343A Active JP5946762B2 (en) | 2012-12-27 | 2012-12-27 | Power transmission control device |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5946762B2 (en) |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0392911A (en) * | 1989-09-06 | 1991-04-18 | Fanuc Ltd | Robot control method for sliding mode control |
JPH0628005A (en) * | 1992-07-08 | 1994-02-04 | Kobe Steel Ltd | Control method using sliding mode control system |
JPH09225883A (en) * | 1996-02-26 | 1997-09-02 | Toyota Motor Corp | Robot with vibration absorbing mechanism |
US6694856B1 (en) * | 2001-02-22 | 2004-02-24 | The University Of Maryland | Magnetorheological damper and energy dissipation method |
US20070138992A1 (en) * | 2005-12-20 | 2007-06-21 | Intuitive Surgical Inc. | Medical robotic system with sliding mode control |
JP2008207321A (en) * | 2007-02-02 | 2008-09-11 | Honda Motor Co Ltd | Leg type mobile robot |
JP2012226620A (en) * | 2011-04-20 | 2012-11-15 | Harmonic Drive Syst Ind Co Ltd | Positioning device for actuator with wave motion gear device |
-
2012
- 2012-12-27 JP JP2012286343A patent/JP5946762B2/en active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0392911A (en) * | 1989-09-06 | 1991-04-18 | Fanuc Ltd | Robot control method for sliding mode control |
JPH0628005A (en) * | 1992-07-08 | 1994-02-04 | Kobe Steel Ltd | Control method using sliding mode control system |
JPH09225883A (en) * | 1996-02-26 | 1997-09-02 | Toyota Motor Corp | Robot with vibration absorbing mechanism |
US6694856B1 (en) * | 2001-02-22 | 2004-02-24 | The University Of Maryland | Magnetorheological damper and energy dissipation method |
US20070138992A1 (en) * | 2005-12-20 | 2007-06-21 | Intuitive Surgical Inc. | Medical robotic system with sliding mode control |
JP2008207321A (en) * | 2007-02-02 | 2008-09-11 | Honda Motor Co Ltd | Leg type mobile robot |
JP2012226620A (en) * | 2011-04-20 | 2012-11-15 | Harmonic Drive Syst Ind Co Ltd | Positioning device for actuator with wave motion gear device |
Non-Patent Citations (1)
Title |
---|
JPN6015048347; Chien-Yu Ji; Yung-Lung Lee; Tsung-Chien Chen: 'Based on Genetic Algorithm and Input Estimation Approach to Design a Sliding Mode Controller for Fle' Proceedings of IEEE 22nd International Symposium on Intelligent Control, 2007. ISIC 2007. , 200710, pp.481-486 * |
Also Published As
Publication number | Publication date |
---|---|
JP5946762B2 (en) | 2016-07-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
De Luca et al. | Robots with flexible elements | |
Bilal et al. | A practical study of active disturbance rejection control for rotary flexible joint robot manipulator | |
JP5939941B2 (en) | Power transmission device | |
JP6097174B2 (en) | Robot controller | |
US10042343B2 (en) | Control device and speed reducer system | |
CN106218922B (en) | The joint actuating mechanism controls method of flexible agility satellite | |
Wolf et al. | Extending a dynamic friction model with nonlinear viscous and thermal dependency for a motor and harmonic drive gear | |
US8996170B2 (en) | Actuating apparatus | |
JP2015231663A (en) | Apparatus and method for controlling and regulating multi-element system | |
Duchaine et al. | Computationally efficient predictive robot control | |
JP2005242794A (en) | Robot control device and robot control method | |
KR20100084671A (en) | Engine bench system control system | |
CN111730594A (en) | Decentralized control method and system for face-to-face collision of modular robot | |
Ramadurai et al. | Application of unscented kalman filter to a cable driven surgical robot: A simulation study | |
US11251742B2 (en) | Damping torsional oscillations in a drive system | |
JP5836231B2 (en) | Power transmission device | |
KR19980083174A (en) | Vibration Suppression Control Method and Control Apparatus of Resonance System | |
CN114137982A (en) | Robot motion control method and device, robot control device and storage medium | |
Zhu et al. | Adaptive control of harmonic drives | |
JP2017071012A (en) | Master slave device | |
JP5946762B2 (en) | Power transmission control device | |
Lendermann et al. | Comparison of passivity based impedance controllers without torque-feedback for variable stiffness actuators | |
Verdonck et al. | Experimental robot identification: Advantages of combining internal and external measurements and of using periodic excitation | |
Raouf et al. | Workspace trajectory tracking control for two-flexible-link manipulator through output redefinition | |
Penzlin et al. | Torque estimation in variable stiffness actuators |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20141127 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20151026 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20151201 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20160125 |
|
TRDD | Decision of grant or rejection written | ||
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20160510 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20160601 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 5946762 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |