JP7450856B2 - Control method of piezoelectric drive device, piezoelectric drive device, and robot - Google Patents
Control method of piezoelectric drive device, piezoelectric drive device, and robot Download PDFInfo
- Publication number
- JP7450856B2 JP7450856B2 JP2020087258A JP2020087258A JP7450856B2 JP 7450856 B2 JP7450856 B2 JP 7450856B2 JP 2020087258 A JP2020087258 A JP 2020087258A JP 2020087258 A JP2020087258 A JP 2020087258A JP 7450856 B2 JP7450856 B2 JP 7450856B2
- Authority
- JP
- Japan
- Prior art keywords
- piezoelectric
- frequency
- detection signal
- drive signal
- threshold
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims description 70
- 238000001514 detection method Methods 0.000 claims description 192
- 230000002159 abnormal effect Effects 0.000 claims description 65
- 230000005856 abnormality Effects 0.000 description 17
- 238000010586 diagram Methods 0.000 description 17
- 238000012545 processing Methods 0.000 description 14
- 230000007274 generation of a signal involved in cell-cell signaling Effects 0.000 description 11
- 238000012935 Averaging Methods 0.000 description 9
- 230000000694 effects Effects 0.000 description 7
- 239000000463 material Substances 0.000 description 7
- 238000004088 simulation Methods 0.000 description 5
- 238000005452 bending Methods 0.000 description 3
- 238000012790 confirmation Methods 0.000 description 3
- 230000003287 optical effect Effects 0.000 description 3
- 239000003638 chemical reducing agent Substances 0.000 description 2
- 238000003384 imaging method Methods 0.000 description 2
- 238000009434 installation Methods 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- XUIMIQQOPSSXEZ-UHFFFAOYSA-N Silicon Chemical compound [Si] XUIMIQQOPSSXEZ-UHFFFAOYSA-N 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 239000012636 effector Substances 0.000 description 1
- 238000009429 electrical wiring Methods 0.000 description 1
- 239000010410 layer Substances 0.000 description 1
- NJPPVKZQTLUDBO-UHFFFAOYSA-N novaluron Chemical compound C1=C(Cl)C(OC(F)(F)C(OC(F)(F)F)F)=CC=C1NC(=O)NC(=O)C1=C(F)C=CC=C1F NJPPVKZQTLUDBO-UHFFFAOYSA-N 0.000 description 1
- 230000002093 peripheral effect Effects 0.000 description 1
- 238000003825 pressing Methods 0.000 description 1
- 229910052710 silicon Inorganic materials 0.000 description 1
- 239000010703 silicon Substances 0.000 description 1
- 239000000758 substrate Substances 0.000 description 1
- 239000002344 surface layer Substances 0.000 description 1
Images
Landscapes
- Manipulator (AREA)
- General Electrical Machinery Utilizing Piezoelectricity, Electrostriction Or Magnetostriction (AREA)
Description
本発明は、圧電駆動装置の制御方法、圧電駆動装置、及び、圧電駆動装置を備えたロボットに関する。 The present invention relates to a method of controlling a piezoelectric drive device, a piezoelectric drive device, and a robot equipped with the piezoelectric drive device.
複数の圧電素子により、長さ方向、及び、屈曲方向の振動を発生させて駆動力を得る圧電モーターが知られている。圧電モーターは、小型かつ軽量で、減速機を使用せずに低速高トルクが得られ、無通電時に保持トルクを有するなど、電磁モーターとは異なる特長を備えている。 2. Description of the Related Art Piezoelectric motors are known that generate driving force by generating vibrations in the longitudinal direction and bending direction using a plurality of piezoelectric elements. Piezoelectric motors have features different from electromagnetic motors, such as being small and lightweight, achieving low speed and high torque without the use of a reducer, and maintaining a holding torque when not energized.
このような圧電モーターを複数個用いて、多連構成とすることが知られている。多連構成とすることで、複数の圧電モーターが同時に駆動することにより高トルクが得られる。例えば、特許文献１には、２つの超音波振動子に印加する２相の駆動交番電圧の何れか一方と、２つの平均の振動検出信号との位相差を検出し、検出された位相差が所定の値となるように駆動交番電圧の周波数を制御する、多連構成の圧電駆動装置が開示されている。なお、超音波振動子が圧電モーターに相当する。
It is known to use a plurality of such piezoelectric motors to form a multiple configuration. By using a multi-connection configuration, high torque can be obtained by driving multiple piezoelectric motors simultaneously. For example, in
しかしながら、特許文献１の技術では、多連構成のうち、いずれかの圧電モーターに異常があったとしても、異常のある圧電モーターを特定することは困難であった。
However, in the technique of
本願に係る圧電駆動装置の制御方法は、駆動用の圧電素子、及び検出用の圧電素子を有する圧電モーターを複数個連結した圧電駆動装置の制御方法であって、複数の前記圧電モーターは、同一の駆動信号により駆動されており、前記駆動信号は、前記検出用の圧電素子からの検出信号に基づく、前記駆動信号の周波数の帰還制御を含む追尾制御が施され、前記追尾制御が施された初期の前記駆動信号により駆動した際の前記検出信号の平均の周波数を初期周波数として記憶し、前記初期周波数と、前記初期に続く駆動時における前記駆動信号により駆動した際の前記検出信号の平均の周波数との差分が、第１の閾値より大きいか否か確認し、前記第１の閾値以下の場合は、前記駆動信号による駆動を継続し、前記第１の閾値より大きい場合は、前記駆動信号が異常であると判断する。 A method for controlling a piezoelectric drive device according to the present application is a method for controlling a piezoelectric drive device in which a plurality of piezoelectric motors each having a piezoelectric element for driving and a piezoelectric element for detection are connected, wherein the plurality of piezoelectric motors are identical to each other. The drive signal is driven by a drive signal, and the drive signal is subjected to tracking control including feedback control of the frequency of the drive signal based on the detection signal from the detection piezoelectric element, and the tracking control is performed. The average frequency of the detection signal when driving with the initial drive signal is stored as an initial frequency, and the average frequency of the detection signal when driving with the drive signal during driving subsequent to the initial frequency is stored as an initial frequency. It is confirmed whether the difference with the frequency is larger than a first threshold value, and if the difference is less than or equal to the first threshold value, driving by the drive signal is continued, and if it is larger than the first threshold value, the drive signal is is judged to be abnormal.
本願に係る圧電駆動装置の制御方法は、駆動用の圧電素子、及び検出用の圧電素子を有する圧電モーターを複数個連結した圧電駆動装置の制御方法であって、複数の前記圧電モーターは、同一の駆動信号により駆動されており、前記駆動信号は、前記検出用の圧電素子からの検出信号に基づく、前記駆動信号の周波数の帰還制御を含む追尾制御が施され、前記追尾制御が施された初期の前記駆動信号により駆動した際の前記検出信号の平均の周波数を初期周波数として記憶し、第１の時刻における前記駆動信号により駆動した際の前記検出信号の周波数の変化率と、第１の時刻よりも前の第２の時刻における前記駆動信号により駆動した際の前記検出信号の周波数の変化率との比率が、第２の閾値より大きいか否か確認し、前記第２の閾値以下の場合は、前記駆動信号による駆動を継続し、前記第２の閾値より大きい場合は、前記駆動信号が異常であると判断する。 A method for controlling a piezoelectric drive device according to the present application is a method for controlling a piezoelectric drive device in which a plurality of piezoelectric motors each having a piezoelectric element for driving and a piezoelectric element for detection are connected, wherein the plurality of piezoelectric motors are identical to each other. The driving signal is driven by a driving signal, and the driving signal is subjected to tracking control including feedback control of the frequency of the driving signal based on the detection signal from the detection piezoelectric element, and the tracking control is performed. The average frequency of the detection signal when driven by the initial drive signal is stored as an initial frequency, and the rate of change in the frequency of the detection signal when driven by the drive signal at a first time, and the first Check whether the ratio of the rate of change in frequency of the detection signal when driven by the drive signal at a second time earlier than the time is greater than a second threshold, and If the drive signal is greater than the second threshold, the drive signal is determined to be abnormal.
本願に係る圧電駆動装置の制御方法は、駆動用の圧電素子、及び検出用の圧電素子を有する圧電モーターを複数個連結した圧電駆動装置の制御方法であって、複数の前記圧電モーターは、同一の駆動信号により駆動されており、前記駆動信号は、前記検出用の圧電素子からの検出信号に基づく、前記駆動信号の周波数の帰還制御を含む追尾制御が施され、前記追尾制御が施された初期の前記駆動信号により駆動した際の前記検出信号の平均の周波数を初期周波数として記憶し、前記初期周波数における前記検出信号の電圧振幅を初期検出信号として記憶し、前記初期周波数と、前記初期に続く駆動時における前記駆動信号により駆動した際の前記検出信号の周波数との差分が、第１の閾値より大きいか否か確認し、前記第１の閾値以下の場合は、前記駆動信号による駆動を継続し、前記第１の閾値より大きい場合は、前記駆動信号が異常であると判断する。 A method for controlling a piezoelectric drive device according to the present application is a method for controlling a piezoelectric drive device in which a plurality of piezoelectric motors each having a piezoelectric element for driving and a piezoelectric element for detection are connected, wherein the plurality of piezoelectric motors are identical to each other. The drive signal is driven by a drive signal, and the drive signal is subjected to tracking control including feedback control of the frequency of the drive signal based on the detection signal from the detection piezoelectric element, and the tracking control is performed. The average frequency of the detection signal when driven by the initial drive signal is stored as an initial frequency, the voltage amplitude of the detection signal at the initial frequency is stored as an initial detection signal, and the initial frequency and the initial frequency are stored as an initial detection signal. Check whether the difference between the frequency of the detection signal when driving with the drive signal during subsequent driving is larger than a first threshold, and if it is less than the first threshold, drive with the drive signal is performed. If it continues and is larger than the first threshold, it is determined that the drive signal is abnormal.
本願に係る圧電駆動装置は、駆動用の圧電素子、及び検出用の圧電素子を有する複数の圧電モーターと、複数の前記圧電モーターに、同一の駆動信号を供給する制御部と、を備え、前記制御部は、前記検出用の圧電素子からの検出信号に基づき、前記駆動信号の周波数の帰還制御を含む追尾制御を施した前記駆動信号を生成し、前記追尾制御が施された初期の前記駆動信号により駆動した際の前記検出信号の平均の周波数を初期周波数として記憶し、前記初期周波数と、前記初期に続く駆動時における前記駆動信号により駆動した際の前記検出信号の平均の周波数との差分が、第１の閾値より大きいか否か確認し、前記第１の閾値以下の場合は、前記駆動信号による駆動を継続し、前記第１の閾値より大きい場合は、前記駆動信号が異常であると判断する。 A piezoelectric drive device according to the present application includes a plurality of piezoelectric motors each having a piezoelectric element for driving and a piezoelectric element for detection, and a control section that supplies the same drive signal to the plurality of piezoelectric motors, The control unit generates the drive signal subjected to tracking control including feedback control of the frequency of the drive signal based on the detection signal from the detection piezoelectric element, and generates the drive signal subjected to tracking control including feedback control of the frequency of the drive signal, and generates the drive signal at the initial stage after the tracking control has been performed. The average frequency of the detection signal when driven by the signal is stored as an initial frequency, and the difference between the initial frequency and the average frequency of the detection signal when driven by the drive signal during driving following the initial stage. is larger than a first threshold, and if it is less than or equal to the first threshold, driving by the drive signal is continued, and if it is larger than the first threshold, the drive signal is abnormal. I judge that.
実施形態１
＊＊＊圧電モーターの概要＊＊＊
図１は、本実施形態に係る圧電駆動装置の概要を示す平面図である。
図１に示すように、圧電モーター８０ａは、円板状の被駆動体としてのローター１６０を、駆動体２０の突起部９５によって押圧することにより、回転方向Ｒ１、または、回転方向Ｒ２に回動させる圧電駆動型のモーターである。なお、図１は、基本構成の説明図であるため、１つの圧電モーター８０ａを図示しているが、実際に用いる際には、図４に示すように、複数の圧電モーターを連ねて駆動力を高める多連構成とすることが多い。図４では、３つの圧電モーター８０ａ，８０ｂ，８０ｃにより多連駆動を行う圧電駆動装置１００を示している。
***Overview of piezoelectric motor***
FIG. 1 is a plan view showing an outline of a piezoelectric drive device according to this embodiment.
As shown in FIG. 1, the
図１に戻る。
圧電モーター８０ａは、圧電アクチュエーター２２、付勢体９０などから構成される。
圧電アクチュエーター２２は、振動源となる圧電素子を有する駆動体２０や、駆動体２０を支える基材１０などから構成される。圧電モーター８０ａには、制御部７０から駆動信号が供給される。なお、圧電アクチュエーター２２、制御部７０の詳細は後述する。
付勢体９０は、複数本の板バネ８５を備えており、ローター１６０に対して突起部９５を押し付ける方向に圧電アクチュエーター２２を付勢する。付勢体９０は、圧電モーター８０ａを取付ける台座などに、２本のネジで固定されている。
このような構成の圧電モーター８０ａは、図１に示すように、複数本の板バネ８５の復元力により、突起部９５がローター１６０の外周面１６０ａを押圧した状態で、駆動体２０の屈曲運動による回転力を印加する。
Return to Figure 1.
The
The
The
As shown in FIG. 1, the
また、ローター１６０にはエンコーダー１６１が設けられており、エンコーダー１６１によって、ローター１６０の挙動、特に、回転量および角速度が検出可能となっている。エンコーダー１６１としては、例えば、ローター１６０の回転時にその回転量を検出するインクリメンタル型のエンコーダーを用いることができる。なお、これに限定するものではなく、ローター１６０の回転の有無に関わらず、ローター１６０の原点からの絶対位置を検出するアブソリュート型のエンコーダーであっても良い。
Further, the
本実施形態のエンコーダー１６１は、ローター１６０の上面に固定されたスケール１６２と、スケール１６２の上側に設けられた光学素子９２とを有する。スケール１６２は、円板状をなし、その上面に図示しないパターンが設けられている。また、光学素子９２は、スケール１６２のパターンに向けて光を照射する発光素子９２ａと、スケール１６２のパターンを撮像する撮像素子９２ｂとを有する。
このような構成のエンコーダー１６１では、撮像素子９２ｂにより取得されるパターンの画像をテンプレートマッチングすることにより、ローター１６０の回転量、駆動速度、絶対位置等を検出することができる。なお、撮像素子９２ｂに代えて、スケール１６２からの反射光、または透過光を受光する受光素子を備えることでも良い。
The
In the
＊＊＊圧電アクチュエーターの概要＊＊＊
図２は、圧電アクチュエーターの平面図である。
圧電アクチュエーター２２の基材１０は、好適例として、矩形状をなしたシリコン基板を用いている。
駆動体２０は、基材１０内で略長方形に区画された部位であり、表層側には、駆動用の圧電素子である圧電素子１～６が配置されている。詳しくは、駆動体２０は、略矩形をなした基材１０に設けられた３つの切欠き部２４～２６により、略長方形に区画されている。そして、長方形の長辺の略中央に残された一対の支持部２１ａ，２１ｂにより、基材１０本体と接続している。なお、駆動体２０の長辺に沿った方向をＸ方向、Ｘ方向と交差する短辺に沿った方向をＹ方向、基材１０の厚さ方向をＺ方向とする。また、支持部２１ａ，２１ｂを通り、Ｙ方向に延在する線分を中心線２８とする。
***Overview of piezoelectric actuators***
FIG. 2 is a plan view of the piezoelectric actuator.
As the
The driving
駆動体２０の略中央には、小さな長方形の圧電素子７が配置されている。圧電素子７は、駆動体の振動状態を検知するための検出用の圧電素子である。
駆動体２０において、圧電素子７と突起部９５との間には、Ｘ方向に延在する３つの長方形状の圧電素子１，５，３が設けられている。圧電素子１，５，３の形状は、略同一である。また、駆動体２０のＸプラス方向にも、Ｘ方向に延在する３つの長方形状の圧電素子２，６，４が設けられている。圧電素子２，６，４は、中心線２８を対象軸として、圧電素子１，５，３の線対称となっている。
A small rectangular
In the
図２では、図示を省略しているが、圧電素子１～７の上面には、圧電素子に駆動信号を供給するための電極、及び、配線が設けられている。駆動体２０において対角に位置する、圧電素子１と圧電素子４には、電気的に同じ配線が接続される。同様に、圧電素子２と圧電素子３にも、電気的に同じ配線が接続される。そして、駆動体２０のＹ方向の中央においてＸ方向に配置された圧電素子５と圧電素子６にも、電気的に同じ配線が接続される。また、圧電素子７には、駆動体２０の振動状態を検出した検出信号を電送するための配線が設けられている。
なお、圧電素子１～７の下層側には、共通の共通配線が設けられている。共通配線は、好適例において、グランド電位に接続している。
Although not shown in FIG. 2, electrodes and wiring for supplying drive signals to the piezoelectric elements are provided on the upper surfaces of the
Note that a common common wiring is provided on the lower layer side of the
＊＊＊圧電モーターの駆動態様＊＊＊
図３は、駆動信号の波形図である。図４は、圧電モーターの駆動態様を示す模式図であり、図１の圧電モーターにおける駆動体２０の駆動態様を模式図として示した図である。
図３では、３つの圧電モーター８０ａ，８０ｂ，８０ｃを備えた圧電駆動装置１００による駆動態様を示しているが、３つの圧電モーター８０ａ，８０ｂ，８０ｃは、同一の構成であり、かつ、供給される駆動信号も同じなので、以下、圧電モーター８０ａを代表として説明する。
***Piezoelectric motor drive mode***
FIG. 3 is a waveform diagram of the drive signal. FIG. 4 is a schematic diagram showing a drive mode of the piezoelectric motor, and is a diagram schematically showing a drive mode of the driving
FIG. 3 shows a drive mode by a
圧電モーター８０ａの駆動体２０において、圧電素子１，４には、駆動信号Ｖｓを印加する。図３に示すように、駆動信号Ｖｓは交番電圧である。また、圧電素子２，３には、駆動信号Ｖｓとは位相が異なる駆動信号Ｖｚを印加する。そして、圧電素子５，６には、駆動信号Ｖｓとは位相が異なる駆動信号Ｖｉを印加する。圧電素子５，６に印加される駆動信号Ｖｉは伸縮振動を発生させる。また、圧電素子１，４に印加される駆動信号Ｖｓ、及び、圧電素子２，３に印加される駆動信号Ｖｚは、屈曲振動を発生させる。
In the
上記の駆動電圧を印加すると、図４に示すように、駆動体２０が長辺方向に伸縮振動しつつ、短辺方向に屈曲振動する。そして、これらの振動が合成されると、突起部９５の先端が矢印で示すように反時計回りに楕円軌道を描く楕円運動をする。このような突起部９５の楕円運動によってローター１６０が送り出され、ローター１６０が回転方向Ｒ１で示す方向に、時計回りに回転する。また、駆動体２０の振動に対応して、圧電素子７から検出信号が出力される。
When the above driving voltage is applied, as shown in FIG. 4, the driving
また、駆動信号Ｖｓを圧電素子２，３に印加し、駆動信号Ｖｚを圧電素子１，４に印加することにより、時計回りに楕円軌道を描く楕円運動とすることができる。
なお、駆動信号Ｖｓ，Ｖｚ，Ｖｉは、駆動状態に応じて逐次、最適な駆動信号となるように制御されている。具体的には、制御部７０により、検出用の圧電素子７からの検出信号に基づいて、駆動信号の周波数の帰還制御を含む追尾制御が施されている。この制御方法について、次に説明する。
Furthermore, by applying the drive signal Vs to the
Note that the drive signals Vs, Vz, and Vi are sequentially controlled to become optimal drive signals according to the drive state. Specifically, the
＊＊＊制御部の回路ブロック構成＊＊＊
図５は、制御部の回路ブロック構成を示す図である。
制御部７０は、位置速度制御部３１、Ｓ駆動信号生成部６１、Ｚ駆動信号生成部６２、Ｉ駆動信号生成部６３、周波数制御部６４、ＳＷ制御部３５などから構成されている。なお、図示は省略しているが、制御部７０が記憶部を備えていても良い。
***Circuit block configuration of control unit***
FIG. 5 is a diagram showing a circuit block configuration of the control section.
The
位置速度制御部３１は、例えば、図示しないホストコンピューターからの指令に基づいて、ローター１６０の目標位置を示した位置指令を生成し、当該位置指令とエンコーダー１６１が検出した現在位置との偏差に対して比例ゲインを調整する比例制御を含むＰ制御を施し、位置指令に基づく位置となるように速度指令を生成する。次に、速度指令とエンコーダー１６１が検出した現在のローター１６０の駆動速度との偏差に対して比例ゲインを調整する比例制御と、積分ゲインを調整する積分制御とを含むＰＩ制御を実施し、速度指令に基づく駆動速度となるように電圧指令を生成する。そして、位置速度制御部３１は、生成した電圧指令をＳ駆動信号生成部６１、及び、Ｚ駆動信号生成部６２に送信する。
For example, the position
Ｓ駆動信号生成部６１は、駆動信号Ｖｓの生成回路であり、Ｓ駆動電圧制御部３２ｓ、ＰＷＭ波形生成部３３ｓ、Ｓ駆動回路３４ｓなどから構成されている。
Ｓ駆動電圧制御部３２ｓは、位置速度制御部３１からの電圧指令と、Ｓ駆動回路３４ｓの出力から帰還される駆動信号Ｖｓとの偏差に対して比例ゲインを調整する比例制御と、積分ゲインを調整する積分制御とを含むＰＩ制御を実施し、電圧指令に基づく電圧（振幅）となる目標Ｄｕｔｙを規定したＤｕｔｙ指令を生成し、ＰＷＭ波形生成部３３ｓに送信する。
The S drive
The S drive
ＰＷＭ波形生成部３３ｓは、Ｓ駆動電圧制御部３２ｓからのＤｕｔｙ指令、及び、駆動周波数制御部３８からの周波数指令に基づいたパルス信号を生成し、Ｓ駆動回路３４ｓに送信する。
Ｓ駆動回路３４ｓは、ＰＷＭ波形生成部３３ｓからのパルス信号に応じた交番電圧を生成し、駆動信号Ｖｓとして各圧電モーターの圧電素子１，４に供給する。なお、上記「ＰＷＭ」は、「Pulse Width Modulation」の略である。
The PWM
The
Ｚ駆動信号生成部６２は、駆動信号Ｖｚの生成回路であり、Ｚ駆動電圧制御部３２ｚ、ＰＷＭ波形生成部３３ｚ、Ｚ駆動回路３４ｚなどから構成されている。
Ｚ駆動電圧制御部３２ｚは、位置速度制御部３１からの電圧指令と、Ｚ駆動回路３４ｚの出力から帰還される駆動信号Ｖｚとの偏差に対して比例ゲインを調整する比例制御と、積分ゲインを調整する積分制御とを含むＰＩ制御を実施し、電圧指令に基づく電圧（振幅）となる目標Ｄｕｔｙを規定したＤｕｔｙ指令を生成し、ＰＷＭ波形生成部３３ｚに送信する。
The Z drive
The Z drive
ＰＷＭ波形生成部３３ｚは、Ｚ駆動電圧制御部３２ｚからのＤｕｔｙ指令、及び、駆動周波数制御部３８からの周波数指令に基づいたパルス信号を生成し、Ｚ駆動回路３４ｚに送信する。
Ｚ駆動回路３４ｚは、ＰＷＭ波形生成部３３ｚからのパルス信号に応じた交番電圧を生成し、駆動信号Ｖｚとして各圧電モーターの圧電素子２，３に供給する。
The PWM
The
Ｉ駆動信号生成部６３は、駆動信号Ｖｉの生成回路であり、Ｉ駆動電圧制御部３２ｉ、ＰＷＭ波形生成部３３ｉ、Ｉ駆動回路３４ｉなどから構成されている。
Ｉ駆動電圧制御部３２ｉは、図示しないホストコンピューターからの電圧指令と、Ｉ駆動回路３４ｉの出力から帰還される駆動信号Ｖｉとの偏差に対して比例ゲインを調整する比例制御と、積分ゲインを調整する積分制御とを含むＰＩ制御を実施し、電圧指令に基づく電圧（振幅）となる目標Ｄｕｔｙを規定したＤｕｔｙ指令を生成し、ＰＷＭ波形生成部３３ｉに送信する。
The I drive
The I drive
ＰＷＭ波形生成部３３ｉは、Ｉ駆動電圧制御部３２ｉからのＤｕｔｙ指令、及び、駆動周波数制御部３８からの周波数指令に基づいたパルス信号を生成し、Ｉ駆動回路３４ｉに送信する。
Ｉ駆動回路３４ｉは、ＰＷＭ波形生成部３３ｉからのパルス信号に応じた交番電圧を生成し、駆動信号Ｖｉとして各圧電モーターの圧電素子５，６に供給する。
The PWM waveform generation section 33i generates a pulse signal based on the Duty command from the I drive
The I drive
周波数制御部６４は、駆動信号Ｖｓ，Ｖｚ，Ｖｉの周波数の制御回路であり、平均化回路３６、駆動周波数判定部３７、駆動周波数制御部３８などから構成される。
平均化回路３６には、３つの圧電モーター８０ａ，８０ｂ，８０ｃの検出用の圧電素子７ａ，７ｂ，７ｃからの検出信号Ｐａ，Ｐｂ，Ｐｃが入力可能に設けられている。
圧電モーター８０ａの圧電素子７ａからの検出信号Ｐａの出力線には、スイッチＳＷａが設けられており、検出信号Ｐａの平均化回路３６への入力を開閉（オンオフ）可能となっている。同様に、圧電モーター８０ｂ，８０ｃの圧電素子７ｂ，７ｃからの検出信号の出力線には、スイッチＳＷａ，ＳＷｂが設けられている。
The
The averaging
A switch SWa is provided on the output line of the detection signal Pa from the
スイッチＳＷａ，ＳＷｂ，ＳＷｃの開閉制御は、ＳＷ制御部３５により制御される。
ＳＷ制御部３５は、図示しないホストコンピューターからの開閉指示に従って、スイッチＳＷａ，ＳＷｂ，ＳＷｃの開閉を制御する。なお、ホストコンピューターには、後述する複数の異常検出方法に準じた制御プログラムがインストールされており、当該制御プログラムの実行に伴ってスイッチＳＷａ，ＳＷｂ，ＳＷｃのオンオフが行われる。
平均化回路３６では、入力される検出信号の平均化処理が行われる。平均化処理は、検出信号の周波数、及び／又は、振幅電圧について行われる。検出信号は、図示しないＡ／Ｄ変換回路でデジタル信号化され、当該信号により平均化処理が行われる。
Opening/closing control of the switches SWa, SWb, and SWc is controlled by the
The
The averaging
駆動周波数判定部３７では、平均化回路３６で平均化された検出信号の周波数、又は振幅電圧と、比較対象の周波数、又は振幅電圧とを比較し、当該比較情報を駆動周波数制御部３８に送信する。
駆動周波数制御部３８は、図示しないホストコンピューターに駆動周波数判定部３７からの比較情報を送信し、ホストコンピューターから周波数調整指令を受信し、当該周波数調整指令に基づく周波数指令を生成し、ＰＷＭ波形生成部３３ｓ，３３ｚ，３３ｉに送信する。なお、ホストコンピューターでは、後述する異常検出方法に準じた制御プログラムに従って処理が実行され、ＳＷ制御部３５への開閉指示、及び、駆動周波数制御部３８への周波数指令を送信する。
The drive
The drive
＊＊＊圧電駆動装置の駆動方法－１＊＊＊
図６は、本実施形態における圧電駆動装置の異常検出方法を示すフローチャートである。図７は、異常モジュールの検出方法を示すフローチャートである。
ここでは、本実施形態における圧電駆動装置１００の異常検出方法について、図６を主体に、適宜、図４、図５を交えて説明する。これらの検出方法は、図示しないホストコンピューターの記憶部に記憶された制御プログラムを実行することにより、図５の制御部７０の各部により実行処理される。なお、ホストコンピューターを用いることに限定するものではなく、制御プログラムを記憶した記憶部、ＣＰＵ（Central Processing Unit）を備えた制御装置であれば良く、例えば、圧電駆動装置１００を備えたロボットの制御装置にも適用することができる。
***Drive method of piezoelectric drive device-1***
FIG. 6 is a flowchart showing a method for detecting an abnormality in a piezoelectric drive device according to this embodiment. FIG. 7 is a flowchart showing a method for detecting an abnormal module.
Here, a method for detecting an abnormality in the
図６の処理手順を規定した制御プログラムは常駐プログラムであり、圧電駆動装置１００の駆動中に、多連駆動されている圧電モーターにおける異常の有無を検出する。なお、図６の処理フローをメインルーチンともいう。
The control program that defines the processing procedure in FIG. 6 is a resident program, and while the
ステップＳ１１では、制御部７０は、圧電駆動装置１００を起動させるために、周波数調整指令に基づく周波数よりも高い周波数の駆動信号を印加し、起動したら徐々に周波数を下げるダウンスイープを行う。
In step S11, the
ステップＳ１２では、多連駆動されている各圧電モーターからの検出信号の周波数の平均値に基づく帰還制御を含む周波数の追尾制御が施された駆動信号が生成され、当該駆動信号により、各圧電モーターが駆動される。図４の場合、圧電モーター８０ａ，８０ｂ，８０ｃからの検出信号Ｐａ，Ｐｂ，Ｐｃの周波数の平均値に基づく周波数追尾制御が施された駆動信号Ｖｓ，Ｖｚ，Ｖｉが生成され、各圧電モーターに供給される。なお、周波数追尾制御のことを追尾制御ともいう。
In step S12, a drive signal is generated that has been subjected to frequency tracking control including feedback control based on the average frequency of detection signals from each piezoelectric motor that is driven in series. is driven. In the case of FIG. 4, drive signals Vs, Vz, and Vi subjected to frequency tracking control based on the average value of the frequencies of detection signals Pa, Pb, and Pc from
ステップＳ１３では、追尾制御により生成された初期の駆動信号により駆動した際の検出信号の平均の周波数である初期周波数ｆ０を記憶する。なお、初期周波数ｆ０の記憶は、制御部７０の記憶部、又は、ホストコンピューターの記憶部を用いる。
In step S13, the initial frequency f0, which is the average frequency of the detection signal when driven by the initial drive signal generated by the tracking control, is stored. Note that the initial frequency f0 is stored using the storage section of the
ステップＳ１４ａからステップＳ１４ｂの間では、圧電駆動装置１００の駆動を継続した状態で、ステップＳ１５からステップＳ１７までの処理を繰り返す。
Between step S14a and step S14b, the processes from step S15 to step S17 are repeated while the
ステップＳ１５では、前記初期に続く駆動時の駆動信号により駆動した際の検出信号の平均値の周波数ｆａを記憶する。 In step S15, the frequency fa of the average value of the detection signal when the drive signal is driven by the drive signal following the initial drive is stored.
ステップＳ１６では、周波数ｆａと初期周波数ｆ０との差分の絶対値が、第１の閾値としての閾値Ａより大きいか否か確認する。閾値Ａ以下の場合は、ステップＳ１４ｂに進み、駆動を継続する。閾値Ａより大きい場合は、ステップＳ１７の異常モジュール検出サブルーチンに進む。なお、閾値Ａは、実験データや、シミュレーション結果などから導出することができる。 In step S16, it is checked whether the absolute value of the difference between the frequency fa and the initial frequency f0 is larger than a threshold A as a first threshold. If it is less than or equal to the threshold value A, the process advances to step S14b and continues driving. If it is larger than the threshold A, the process advances to the abnormal module detection subroutine of step S17. Note that the threshold value A can be derived from experimental data, simulation results, and the like.
続いて、図７の異常モジュール検出方法について説明する。この検出方法は、ステップＳ１７のサブルーチンに相当する。
ステップＳ２１ａからステップＳ２１ｂの間では、複数の圧電モーターのうち、１つの圧電モーターの検出信号を順次選択することを、全ての圧電モーターについて行う。なお、圧電モーターのことをモジュールともいう。
Next, the abnormal module detection method shown in FIG. 7 will be explained. This detection method corresponds to the subroutine of step S17.
Between step S21a and step S21b, the detection signal of one piezoelectric motor among the plurality of piezoelectric motors is sequentially selected for all the piezoelectric motors. Note that the piezoelectric motor is also called a module.
ステップＳ２２では、選択した圧電モーターの検出信号のスイッチＳＷをオンし、それ以外の圧電モーターの検出信号のスイッチＳＷをオフとする。 In step S22, the switch SW for the detection signal of the selected piezoelectric motor is turned on, and the switches SW for the detection signals of the other piezoelectric motors are turned off.
ステップＳ２３では、選択した圧電モーターの検出信号により追尾制御が施されて生成された駆動信号で駆動した際の検出信号の周波数ｆｂを記憶する。 In step S23, the frequency fb of the detection signal when the piezoelectric motor is driven by the drive signal generated by performing tracking control using the detection signal of the selected piezoelectric motor is stored.
ステップＳ２４では、周波数ｆｂと初期周波数ｆ０との差分の絶対値が、第３の閾値としての閾値Ｂより大きいか否か確認する。閾値Ｂ以下の場合は、ステップＳ２１ｂに進む。閾値Ｂより大きい場合は、ステップＳ２５に進む。なお、閾値Ｂは、実験データや、シミュレーション結果などから導出することができる。 In step S24, it is checked whether the absolute value of the difference between the frequency fb and the initial frequency f0 is larger than a threshold B as a third threshold. If it is less than or equal to threshold B, the process advances to step S21b. If it is larger than threshold B, the process advances to step S25. Note that the threshold value B can be derived from experimental data, simulation results, and the like.
ステップＳ２５では、ステップＳ２２で選択した圧電モーターを異常モジュールと判定する。 In step S25, the piezoelectric motor selected in step S22 is determined to be an abnormal module.
ステップＳ２６では、ステップＳ２５で異常判定された圧電モーターの検出信号のスイッチＳＷをオフし、ステップＳ２１ｂに進む。なお、異常モジュールのスイッチＳＷオフは、全モジュールの選択確認が終了し、本サブルーチンを抜けて、図６のメインルーチンに戻った際にも有効である。つまり、追尾制御を行う際に帰還される検出信号から、異常モジュールの検出信号は除外される。 In step S26, the switch SW of the detection signal of the piezoelectric motor determined to be abnormal in step S25 is turned off, and the process proceeds to step S21b. Note that turning off the switch SW of the abnormal module is also effective when the confirmation of selection of all modules is completed, exits from this subroutine, and returns to the main routine of FIG. 6. In other words, the detection signal of the abnormal module is excluded from the detection signal fed back when tracking control is performed.
なお、上記では、ステップＳ２６の後、ステップＳ２１ｂに進むとして説明したが、破線７５で示すように、ステップＳ２６の後、本サブルーチンを終了して、図６のメインルーチンに戻っても良い。この方法によれば、異常モジュールを検出したら、直にメインフローに戻るため、駆動効率が良い。
In addition, although the above explanation was given as proceeding to step S21b after step S26, as shown by the
以上述べた通り、この検出方法によれば、メインルーチンにおいて、追尾制御が施された初期の駆動信号により駆動した際の検出信号の平均の周波数である初期周波数ｆ０と、初期に続く駆動時における駆動信号により駆動した際の検出信号の平均の周波数ｆａとの差分が、閾値Ａより大きいか否か確認し、閾値Ａ以下の場合は、駆動信号による駆動を継続し、閾値Ａより大きい場合は、駆動信号が異常であると判断する。
よって、初期周波数ｆ0と、駆動時における駆動信号により駆動した際の検出信号の平均の周波数ｆａとの差分から、駆動時における駆動信号の異常を検出することができる。
さらに、閾値Ａより大きい場合は、サブルーチンにおいて、複数の圧電モーターのうち、１つの圧電モーターの検出信号を順次選択し、選択された検出信号に基づき追尾制御が施された駆動信号により駆動した際の検出信号の周波数ｆｂと、初期周波数ｆ０との差分が、閾値Ｂより大きいか否か確認し、閾値Ｂより大きい場合は、選択された圧電モーターを異常と判定する。
従って、多連構成の圧電駆動装置１００において、異常がある圧電モーターを検出する方法を提供することができる。
As described above, according to this detection method, in the main routine, the initial frequency f0, which is the average frequency of the detection signal when driving with the initial driving signal subjected to tracking control, and the initial frequency f0 during driving following the initial Check whether the difference from the average frequency fa of the detection signal when driving by the drive signal is larger than the threshold value A. If it is below the threshold value A, continue driving by the drive signal, and if it is larger than the threshold value A. , it is determined that the drive signal is abnormal.
Therefore, an abnormality in the drive signal during driving can be detected from the difference between the initial frequency f0 and the average frequency fa of the detection signal when driven by the drive signal during driving.
Furthermore, if it is larger than the threshold value A, in the subroutine, the detection signal of one piezoelectric motor is sequentially selected from among the plurality of piezoelectric motors, and when the drive signal is driven by a drive signal subjected to tracking control based on the selected detection signal. It is checked whether the difference between the frequency fb of the detection signal and the initial frequency f0 is larger than a threshold value B, and if it is larger than the threshold value B, the selected piezoelectric motor is determined to be abnormal.
Therefore, it is possible to provide a method for detecting an abnormal piezoelectric motor in the
さらに、サブルーチンでは、異常判定された圧電モーターの検出信号の入力を切断する。よって、異常がある圧電モーターの検出信号を除いた、正常な圧電モーターからの検出信号に基づいて追尾制御された所期の駆動信号を得ることができる。よって、所期の駆動出力を得ることができる。 Further, in the subroutine, the input of the detection signal of the piezoelectric motor determined to be abnormal is cut off. Therefore, it is possible to obtain the desired drive signal that is tracked and controlled based on the detection signal from the normal piezoelectric motor, excluding the detection signal from the abnormal piezoelectric motor. Therefore, the desired drive output can be obtained.
また、これらの検出方法は、圧電駆動装置１００の駆動中に実行されるため、駆動効率に優れている。換言すれば、圧電駆動装置１００の駆動を中断することなく、駆動信号の異常検出、及び、異常がある圧電モーターの特定、並びに、駆動信号の適正化を行うことができる。
従って、異常モジュールが含まれている場合であっても、安定した駆動を行うことが可能な圧電駆動装置１００を提供することができる。
Furthermore, these detection methods are executed while the
Therefore, it is possible to provide the
実施形態２
＊＊＊圧電駆動装置の駆動方法－２＊＊＊
図８は、異常モジュールの検出方法を示すフローチャートであり、図７に対応している。図８の処理フローは、図７の処理フローの一部を変更したものである。図８の検出方法は、図６のメインルーチンにおけるステップＳ１７のサブルーチンに相当する。以下、図７での説明と重複する内容は省略して説明する。
***Drive method of piezoelectric drive device-2***
FIG. 8 is a flowchart showing a method for detecting an abnormal module, and corresponds to FIG. The processing flow in FIG. 8 is a partial modification of the processing flow in FIG. 7. The detection method of FIG. 8 corresponds to the subroutine of step S17 in the main routine of FIG. Hereinafter, content that overlaps with the description in FIG. 7 will be omitted.
ステップＳ３１ａからステップＳ３１ｂの間では、複数の圧電モーターのうち、１つの圧電モーターの検出信号を順次選択することを、全ての圧電モーターについて行う。 Between step S31a and step S31b, the detection signal of one piezoelectric motor among the plurality of piezoelectric motors is sequentially selected for all the piezoelectric motors.
ステップＳ３２では、選択した圧電モーターの検出信号のスイッチＳＷをオフし、それ以外の圧電モーターの検出信号のスイッチＳＷをオンとする。このステップが、図７の処理フローと主に異なる点である。 In step S32, the switch SW for the detection signal of the selected piezoelectric motor is turned off, and the switches SW for the detection signals of the other piezoelectric motors are turned on. This step is the main difference from the processing flow in FIG.
ステップＳ３３では、選択した圧電モーターを除く、他の圧電モーターによる平均の検出信号により追尾制御が施されて生成された駆動信号で駆動した際の検出信号の周波数ｆｃを記憶する。 In step S33, the frequency fc of the detection signal when driving with the drive signal generated by performing tracking control using the average detection signals of other piezoelectric motors other than the selected piezoelectric motor is stored.
ステップＳ３４では、周波数ｆｃと初期周波数ｆ０との差分の絶対値が、第４の閾値としての閾値Ｃより大きいか否か確認する。閾値Ｃより大きい場合は、ステップＳ３１ｂに進む。閾値Ｃ以下の場合は、ステップＳ３５に進む。なお、閾値Ｃは、実験データや、シミュレーション結果などから導出することができる。 In step S34, it is checked whether the absolute value of the difference between the frequency fc and the initial frequency f0 is larger than a threshold C as a fourth threshold. If it is larger than the threshold C, the process advances to step S31b. If it is less than or equal to the threshold C, the process advances to step S35. Note that the threshold value C can be derived from experimental data, simulation results, and the like.
ステップＳ３５では、ステップＳ３２で選択した圧電モーターを異常モジュールと判定する。 In step S35, the piezoelectric motor selected in step S32 is determined to be an abnormal module.
ステップＳ３６では、ステップＳ３５で異常判定された圧電モーターの検出信号のスイッチＳＷをオフし、ステップＳ３１ｂに進む。なお、異常モジュールのスイッチＳＷオフは、全モジュールの選択確認が終了し、本サブルーチンを抜けて、図６のメインルーチンに戻った際にも有効である。つまり、追尾制御を行う際に帰還される検出信号から、異常モジュールの検出信号は除外される。 In step S36, the switch SW of the detection signal of the piezoelectric motor determined to be abnormal in step S35 is turned off, and the process proceeds to step S31b. Note that turning off the switch SW of the abnormal module is also effective when the confirmation of selection of all modules is completed, exits from this subroutine, and returns to the main routine of FIG. 6. In other words, the detection signal of the abnormal module is excluded from the detection signal fed back when tracking control is performed.
なお、上記では、ステップＳ３６の後、ステップＳ３１ｂに進むとして説明したが、破線７６で示すように、ステップＳ３６の後、本サブルーチンを終了して、図６のメインルーチンに戻っても良い。この方法によれば、異常モジュールを検出したら、直にメインフローに戻るため、駆動効率が良い。
In addition, although the above description was given as proceeding to step S31b after step S36, as shown by the
以上述べた通り、本実施形態によれば、実施形態１での効果に加えて以下の効果を得ることができる。
メインルーチンにて閾値Ａより大きい場合は、この異常検出サブルーチンにおいて、複数の圧電モーターのうち、１つの圧電モーターの検出信号を順次選択し、選択された圧電モーターの検出信号を除く、複数の圧電モーターによる検出信号の平均値に基づき追尾制御が施された駆動信号により駆動した際の検出信号の周波数ｆｃと、初期周波数ｆ０との差分が、閾値Ｃより大きいか否か確認し、閾値Ｃ以下の場合は、選択された圧電モーターを異常と判定する。従って、多連構成の圧電駆動装置１００において、異常がある圧電モーターを検出する方法を提供することができる。
As described above, according to this embodiment, in addition to the effects of
If it is larger than threshold A in the main routine, in this abnormality detection subroutine, the detection signal of one piezoelectric motor is sequentially selected from among the plurality of piezoelectric motors, and the detection signal of the plurality of piezoelectric motors excluding the detection signal of the selected piezoelectric motor is Check whether the difference between the frequency fc of the detection signal when the motor is driven by a drive signal subjected to tracking control based on the average value of the detection signal and the initial frequency f0 is greater than the threshold C, and if it is equal to or less than the threshold C. In this case, the selected piezoelectric motor is determined to be abnormal. Therefore, it is possible to provide a method for detecting an abnormal piezoelectric motor in the
さらに、異常判定された圧電モーターの検出信号の入力を切断する。よって、異常がある圧電モーターの検出信号を除いた、正常な圧電モーターからの検出信号に基づいて追尾制御された所期の駆動信号を得ることができる。よって、所期の駆動出力を得ることができる。 Further, the input of the detection signal of the piezoelectric motor determined to be abnormal is cut off. Therefore, it is possible to obtain the desired drive signal that is tracked and controlled based on the detection signal from the normal piezoelectric motor, excluding the detection signal from the abnormal piezoelectric motor. Therefore, the desired drive output can be obtained.
実施形態３
＊＊＊圧電駆動装置の駆動方法－３＊＊＊
図９は、本実施形態における圧電駆動装置の異常検出方法を示すフローチャートであり、図６に対応している。図１０は、異常モジュールの検出方法を示すフローチャートであり、図７に対応している。
図９、図１０の処理フローは、図６、図７の処理フローの一部を変更したものである。主な変更点は、異常モジュールの検出に、検出信号の電圧振幅を用いる点である。以下、図６、図７での説明と重複する内容は省略して説明する。
***Drive method of piezoelectric drive device-3***
FIG. 9 is a flowchart showing a method for detecting an abnormality in a piezoelectric drive device according to this embodiment, and corresponds to FIG. 6. FIG. 10 is a flowchart showing a method for detecting an abnormal module, and corresponds to FIG.
The processing flows in FIGS. 9 and 10 are partially modified versions of the processing flows in FIGS. 6 and 7. The main change is that the voltage amplitude of the detection signal is used to detect abnormal modules. Hereinafter, the explanation will be omitted to omit the content that overlaps with the explanation in FIGS. 6 and 7.
ステップＳ４１では、制御部７０は、圧電駆動装置１００を起動させるために、周波数調整指令に基づく周波数よりも高い周波数の駆動信号を印加し、起動したら徐々に周波数を下げるダウンスイープを行う。
In step S41, the
ステップＳ４２では、多連駆動されている各圧電モーターからの検出信号の周波数の平均値に基づく帰還制御を含む周波数の追尾制御が施された駆動信号が生成され、当該駆動信号により、各圧電モーターが駆動される。 In step S42, a drive signal is generated that has been subjected to frequency tracking control including feedback control based on the average frequency of detection signals from each piezoelectric motor that is driven in series. is driven.
ステップＳ４３では、追尾制御により生成された初期の駆動信号により駆動した際の検出信号の平均の周波数である初期周波数ｆ０を記憶する。 In step S43, the initial frequency f0, which is the average frequency of the detection signal when driven by the initial drive signal generated by the tracking control, is stored.
ステップＳ４４では、追尾制御により生成された初期の駆動信号により駆動した際の検出信号の平均の電圧振幅値である初期検出信号Ｐｕ０を記憶する。このステップが、図６の処理フローと主に異なる点である。 In step S44, the initial detection signal Pu0, which is the average voltage amplitude value of the detection signal when driven by the initial drive signal generated by the tracking control, is stored. This step is the main difference from the processing flow in FIG.
ステップＳ４５ａからステップＳ４５ｂの間では、圧電駆動装置１００の駆動を継続した状態で、ステップＳ４６からステップＳ４８までの処理を繰り返す。
Between step S45a and step S45b, the processes from step S46 to step S48 are repeated while the
ステップＳ４６では、前記初期に続く駆動時の駆動信号により駆動した際の検出信号の平均値の周波数ｆａを記憶する。 In step S46, the frequency fa of the average value of the detection signal when the drive signal is driven by the drive signal following the initial drive is stored.
ステップＳ４７では、周波数ｆａと初期周波数ｆ０との差分の絶対値が、第１の閾値としての閾値Ａより大きいか否か確認する。閾値Ａ以下の場合は、ステップＳ４５ｂに進み、駆動を継続する。閾値Ａより大きい場合は、ステップＳ４８の異常モジュール検出サブルーチンに進む。なお、閾値Ａは、図６のメインルーチンにおける閾値Ａと同じである。 In step S47, it is checked whether the absolute value of the difference between the frequency fa and the initial frequency f0 is larger than a threshold A as a first threshold. If it is less than or equal to the threshold value A, the process advances to step S45b and continues driving. If it is larger than the threshold A, the process advances to the abnormal module detection subroutine of step S48. Note that the threshold value A is the same as the threshold value A in the main routine of FIG.
続いて、図１０の異常モジュール検出方法について説明する。この検出方法は、ステップＳ４８のサブルーチンに相当する。 Next, the abnormal module detection method shown in FIG. 10 will be explained. This detection method corresponds to the subroutine of step S48.
ステップＳ５０では、追尾制御を止めて駆動信号の周波数を固定する。好適例では、駆動信号を初期周波数ｆ０に基づく周波数に固定する。 In step S50, tracking control is stopped and the frequency of the drive signal is fixed. In a preferred embodiment, the drive signal is fixed at a frequency based on the initial frequency f0.
ステップＳ５１ａからステップＳ５１ｂの間では、複数の圧電モーターのうち、１つの圧電モーターの検出信号を順次選択することを、全ての圧電モーターについて行う。 Between step S51a and step S51b, the detection signal of one piezoelectric motor among the plurality of piezoelectric motors is sequentially selected for all piezoelectric motors.
ステップＳ５２では、選択した圧電モーターの検出信号のスイッチＳＷをオンし、それ以外の圧電モーターの検出信号のスイッチＳＷをオフとする。 In step S52, the switch SW for the detection signal of the selected piezoelectric motor is turned on, and the switches SW for the detection signals of the other piezoelectric motors are turned off.
ステップＳ５３では、選択した圧電モーターの検出信号により追尾制御が施されて生成された駆動信号で駆動した際の検出信号の電圧振幅値である選択検出信号Ｐｕｘを記憶する。 In step S53, the selected detection signal Pux, which is the voltage amplitude value of the detection signal when the piezoelectric motor is driven by the drive signal generated by performing tracking control using the detection signal of the selected piezoelectric motor, is stored.
ステップＳ５４では、選択検出信号Ｐｕｘと初期検出信号Ｐｕ０との差分の絶対値が、第５の閾値としての閾値Ｄより大きいか否か確認する。閾値Ｄ以下の場合は、ステップＳ５１ｂに進む。閾値Ｄより大きい場合は、ステップＳ５５に進む。なお、閾値Ｄは、実験データや、シミュレーション結果などから導出することができる。 In step S54, it is checked whether the absolute value of the difference between the selection detection signal Pux and the initial detection signal Pu0 is larger than a threshold D as a fifth threshold. If it is less than or equal to the threshold D, the process advances to step S51b. If it is larger than the threshold D, the process advances to step S55. Note that the threshold value D can be derived from experimental data, simulation results, and the like.
ステップＳ５５では、ステップＳ５２で選択した圧電モーターを異常モジュールと判定する。 In step S55, the piezoelectric motor selected in step S52 is determined to be an abnormal module.
ステップＳ５６では、ステップＳ５５で異常判定された圧電モーターの検出信号のスイッチＳＷをオフし、ステップＳ５１ｂに進む。なお、異常モジュールのスイッチＳＷオフは、全モジュールの選択確認が終了し、ステップＳ５７に進んだ際にも有効である。 In step S56, the switch SW of the detection signal of the piezoelectric motor determined to be abnormal in step S55 is turned off, and the process proceeds to step S51b. Note that turning off the switch SW of the abnormal module is also effective when the selection confirmation of all modules is completed and the process proceeds to step S57.
ステップＳ５７では、駆動信号の周波数固定を解除して、追尾制御に戻す。この際、追尾制御を行う際に帰還される検出信号から、ステップＳ５６で特定された異常モジュールの検出信号は除外されている。 In step S57, the fixation of the frequency of the drive signal is canceled and the control is returned to tracking control. At this time, the detection signal of the abnormal module identified in step S56 is excluded from the detection signals fed back when tracking control is performed.
以上述べた通り、本実施形態によれば、上記実施形態での効果に加えて以下の効果を得ることができる。
メインルーチンにおいて、追尾制御が施された初期の駆動信号により駆動した際の検出信号の平均の周波数を初期周波数ｆ０として記憶し、初期周波数における検出信号の電圧振幅を初期検出信号Ｐｕ０として記憶し、初期周波数ｆ０と、初期に続く駆動時における駆動信号により駆動した際の検出信号の周波数ｆａとの差分が、閾値Ａより大きいか否か確認し、閾値Ａ以下の場合は、駆動信号による駆動を継続し、閾値Ａより大きい場合は、駆動信号が異常であると判断する。
よって、初期周波数ｆ０と、初期に続く駆動時における駆動信号により駆動した際の検出信号の周波数ｆａとの差分から、駆動時における駆動信号の異常を検出することができる。
As described above, according to this embodiment, the following effects can be obtained in addition to the effects of the above embodiments.
In the main routine, the average frequency of the detection signal when driven by an initial drive signal subjected to tracking control is stored as an initial frequency f0, the voltage amplitude of the detection signal at the initial frequency is stored as an initial detection signal Pu0, Check whether the difference between the initial frequency f0 and the frequency fa of the detection signal when driving with the drive signal during the initial drive is larger than the threshold A, and if it is less than the threshold A, drive with the drive signal. If it continues and is larger than the threshold value A, it is determined that the drive signal is abnormal.
Therefore, it is possible to detect an abnormality in the drive signal during driving from the difference between the initial frequency f0 and the frequency fa of the detection signal when driving with the drive signal during the initial drive.
さらに、サブルーチンにおいて、選択された圧電モーターにおける検出信号の振幅電圧である選択検出信号Ｐｕｘと、初期検出信号Ｐｕ０との差分が、閾値Ｄより大きいか否か確認し、閾値Ｄより大きい場合は、選択された圧電モーターを異常と判定する。
従って、多連構成の圧電駆動装置１００において、異常がある圧電モーターを検出する方法を提供することができる。
Furthermore, in the subroutine, it is checked whether the difference between the selected detection signal Pux, which is the amplitude voltage of the detection signal in the selected piezoelectric motor, and the initial detection signal Pu0 is larger than the threshold D, and if it is larger than the threshold D, Determine the selected piezoelectric motor as abnormal.
Therefore, it is possible to provide a method for detecting an abnormal piezoelectric motor in the
さらに、サブルーチンでは、異常判定された圧電モーターの検出信号の入力を切断し、駆動信号の周波数の固定を解除し、追尾制御に戻す。
よって、異常がある圧電モーターの検出信号を除いた、正常な圧電モーターからの検出信号に基づいて追尾制御された所期の駆動信号を得ることができる。よって、所期の駆動出力を得ることができる。
Furthermore, in the subroutine, the input of the detection signal of the piezoelectric motor determined to be abnormal is cut off, the frequency of the drive signal is released from being fixed, and the tracking control is returned to.
Therefore, it is possible to obtain the desired drive signal that is tracked and controlled based on the detection signal from the normal piezoelectric motor, excluding the detection signal from the abnormal piezoelectric motor. Therefore, the desired drive output can be obtained.
実施形態４
＊＊＊圧電駆動装置の駆動方法－４＊＊＊
図１１は、本実施形態における圧電駆動装置の異常検出方法を示すフローチャートであり、図６に対応している。
図１１の処理フローは、図６の処理フローの一部を変更したものである。主な変更点は、異常モジュールの検出に、検出信号の周波数の変化率を用いる点である。以下、図６での説明と重複する内容は省略して説明する。
***Drive method of piezoelectric drive device-4***
FIG. 11 is a flowchart showing a method for detecting an abnormality in a piezoelectric drive device according to this embodiment, and corresponds to FIG. 6.
The processing flow in FIG. 11 is a partial modification of the processing flow in FIG. 6. The main change is that the rate of change in the frequency of the detection signal is used to detect abnormal modules. Hereinafter, content that overlaps with the description in FIG. 6 will be omitted.
ステップＳ６１では、制御部７０は、圧電駆動装置１００を起動させるために、周波数調整指令に基づく周波数よりも高い周波数の駆動信号を印加し、起動したら徐々に周波数を下げるダウンスイープを行う。
In step S61, the
ステップＳ６２では、多連駆動されている各圧電モーターからの検出信号の周波数の平均値に基づく帰還制御を含む周波数の追尾制御が施された駆動信号が生成され、当該駆動信号により、各圧電モーターが駆動される。 In step S62, a drive signal is generated that has been subjected to frequency tracking control including feedback control based on the average frequency of detection signals from each piezoelectric motor that is driven in series. is driven.
ステップＳ６３では、追尾制御により生成された初期の駆動信号により駆動した際の検出信号の平均の周波数である初期周波数ｆ０を記憶する。 In step S63, the initial frequency f0, which is the average frequency of the detection signal when driven by the initial drive signal generated by the tracking control, is stored.
ステップＳ６４ａからステップＳ６４ｂの間では、圧電駆動装置１００の駆動を継続した状態で、ステップＳ６５からステップＳ６７までの処理を繰り返す。
Between step S64a and step S64b, the processes from step S65 to step S67 are repeated while the
ステップＳ６５では、追尾制御により生成された駆動信号により駆動した際の検出信号の平均の周波数を一定時間ごとに記憶する。このステップ、及び、次のステップが、図６の処理フローと主に異なる点である。 In step S65, the average frequency of the detection signal when driven by the drive signal generated by the tracking control is stored at fixed time intervals. This step and the next step are the main points that differ from the processing flow in FIG.
ステップＳ６６では、時刻Ｙにおける駆動信号により駆動した際の検出信号の周波数の変化率ｆ（ｙ）－ｆ（ｙ－１）の絶対値と、時刻Ｙよりも前の時刻Ｘにおける駆動信号により駆動した際の検出信号の周波数の変化率ｆ（ｘ）－ｆ（ｘ－１）の絶対値との比率が、第２の閾値としての閾値Ｅより大きいか否か確認する。なお、時刻Ｙが第１の時刻に相当し、時刻Ｘが第２の時刻に相当する。また、時刻Ｙにおける周波数がｆ（ｙ）で、その一定時間前における周波数がｆ（ｙ－１）である。周波数ｆ（ｘ）、及び、周波数ｆ（ｘ－１）についても同様である。閾値Ｅ以下の場合は、ステップＳ６４ｂに進み、駆動を継続する。閾値Ｅより大きい場合は、ステップＳ６７の異常モジュール検出サブルーチンに進む。なお、閾値Ｅは、実験データや、シミュレーション結果などから導出することができる。 In step S66, the absolute value of the frequency change rate f(y)-f(y-1) of the detection signal when driven by the drive signal at time Y and the drive signal at time X before time Y are determined. It is checked whether the ratio of the frequency change rate f(x)-f(x-1) of the detection signal to the absolute value at the time of the detection signal is larger than a threshold E serving as a second threshold. Note that time Y corresponds to a first time, and time X corresponds to a second time. Further, the frequency at time Y is f(y), and the frequency at a certain time before that is f(y-1). The same applies to frequency f(x) and frequency f(x-1). If it is less than or equal to the threshold value E, the process advances to step S64b to continue driving. If it is larger than the threshold E, the process advances to the abnormal module detection subroutine of step S67. Note that the threshold value E can be derived from experimental data, simulation results, and the like.
ステップＳ６７のサブルーチンは、図７、又は、図８の異常モジュール検出サブルーチンと同じである。いずれのサブルーチンを用いても、上記各実施形態と同様に、異常モジュールを検出することができる。また、異常がある圧電モーターの検出信号を除いた、正常な圧電モーターからの検出信号に基づいて追尾制御された所期の駆動信号を得ることができる。 The subroutine of step S67 is the same as the abnormal module detection subroutine of FIG. 7 or 8. No matter which subroutine is used, an abnormal module can be detected as in each of the above embodiments. Further, it is possible to obtain the desired drive signal that is tracked and controlled based on the detection signal from the normal piezoelectric motor, excluding the detection signal from the abnormal piezoelectric motor.
以上述べた通り、本実施形態によれば、上記実施形態での効果に加えて以下の効果を得ることができる。
メインルーチンにおいて、追尾制御が施された初期の駆動信号により駆動した際の検出信号の平均の周波数を初期周波数ｆ０として記憶し、時刻Ｙにおける駆動信号により駆動した際の検出信号の周波数の変化率と、時刻Ｙよりも前の時刻Ｘにおける駆動信号により駆動した際の検出信号の周波数の変化率との比率が、閾値Ｅより大きいか否か確認し、閾値Ｅ以下の場合は、駆動信号による駆動を継続し、閾値Ｅより大きい場合は、駆動信号が異常であると判断する。
よって、時刻Ｙにおける検出信号の周波数の変化率と、時刻Ｙよりも前の時刻Ｘにおける検出信号の周波数の変化率との比率から、駆動時における駆動信号の異常を検出することができる。従って、多連構成の圧電駆動装置１００において、異常がある圧電モーターを検出する方法を提供することができる。
As described above, according to this embodiment, the following effects can be obtained in addition to the effects of the above embodiments.
In the main routine, the average frequency of the detection signal when driven by the initial drive signal subjected to tracking control is stored as the initial frequency f0, and the rate of change in the frequency of the detection signal when driven by the drive signal at time Y is calculated. and the rate of change in the frequency of the detection signal when driven by the drive signal at time If the driving continues and the value is greater than the threshold E, it is determined that the driving signal is abnormal.
Therefore, an abnormality in the drive signal during driving can be detected from the ratio of the rate of change in the frequency of the detection signal at time Y and the rate of change in the frequency of the detection signal at time X before time Y. Therefore, it is possible to provide a method for detecting an abnormal piezoelectric motor in the
実施形態５
＊＊＊リニアアクチュエーター、多連駆動＊＊＊
図１２、図１３は、圧電駆動装置の異なる態様を示す図である。
上記各実施形態では、圧電駆動装置１００を用いて円板状のローター１６０（図１）を回転駆動する態様について説明したが、この構成に限定するものではなく、例えば、リニアアクチュエーターに適用しても良い。
***Linear actuator, multiple drive***
12 and 13 are diagrams showing different aspects of the piezoelectric drive device.
In each of the above embodiments, a mode has been described in which the disk-shaped rotor 160 (FIG. 1) is rotationally driven using the
図１２に示すように、３連駆動の圧電駆動装置１００は、棒状のロッド１７０の側面に並んで配置されている。詳しくは、３つの圧電モーター８０ａ，８０ｂ，８０ｃがロッド１７０の同じ側面に一定間隔で配置されている。３つの圧電モーター８０ａ，８０ｂ，８０ｃが、上記各実施形態の駆動方法により駆動されることにより、ロッド１７０が、その延在方向に移動する。なお、多連の数は、３つに限定するものではなく、必要なトルクに応じて、圧電モーターの数を調整すれば良い。
As shown in FIG. 12, the three-drive
例えば、図１３に示すように、圧電駆動装置１１０は、円柱状のローター１６５の周囲に１０個の圧電モーター８０を備えている。この構成によれば、ローター１６５を高トルクで駆動することができる。これらの構成であっても、上記各実施形態と同様の作用効果を得ることができる。
For example, as shown in FIG. 13, the
実施形態６
＊＊＊ロボット＊＊＊
図１４は、アームを備えたロボットの概要図である。図１５は、ハンドの拡大図である。図１４に示すロボット５００は、６軸の垂直多関節ロボットであり、精密機器や、これを構成する部品（対象物）の給材、除材、搬送および組立等の作業を行うことができる。
***robot***
FIG. 14 is a schematic diagram of a robot equipped with an arm. FIG. 15 is an enlarged view of the hand. The
ロボット５００は、基台１９０と、基台１９０に接続されたロボットアーム２００と、ロボットアーム２００の先端部に設けられた力検出器（図示せず）とハンド４００と、を有する。また、ロボット５００は、ロボットアーム２００を駆動させる動力を発生させる複数の駆動源を有している。
The
基台１９０は、ロボット５００を任意の設置箇所に取り付けるベース部分である。なお、基台１９０の設置箇所は、特に限定されず、例えば、床、壁、天井、移動可能な台車上などが挙げられる。
The
ロボットアーム２００は、第１アーム２１０、第２アーム２２０、第３アーム２３０、第４アーム２４０、第５アーム２５０、第６アーム２６０などから構成されており、これらが基台１９０側から先端側に向って、この順に連結されている。
第１アーム２１０は、基台１９０に接続されている。第６アーム２６０の先端には、例えば、各種部品等を把持するハンド４００が着脱可能に取り付けられている。ハンド４００は、エンドエフェクターであり、２本の指４１０を備えている。ハンド４００は、２本の指４１０により、例えば各種部品等を把持することができる。
The
The
第５アーム２５０には、第６アーム２６０を駆動する駆動源として上記実施形態の圧電モーター８０を多連使いした圧電駆動装置１２０が用いられている。圧電駆動装置１２０は、多連の数以外は、上記実施形態の圧電駆動装置１００と同様である。また、図示しないが、第１アーム２１０と第２アーム２２０との接合部には関節部が設けられている。関節部には、モーターや、減速機が組込まれている。他のアーム間にも、同様に関節部が設けられている。そして、各駆動源は、図示しない制御装置により制御される。当該制御装置には、上記実施形態の制御部７０が搭載されている。
The
図１５に示すように、複数の圧電モーター８０は、第５アーム２５０の内周に沿って並び、突起部を第６アーム２６０に向けて配置されている。つまり、複数の圧電モーター８０は、第５アーム２５０と第６アーム２６０との間の関節部に設けられている。そして、複数の圧電モーター８０は、第６アーム２６０の端面に回動軸Ｏ回りの駆動力を与える。これにより、第５アーム２５０に対して第６アーム２６０を回動軸Ｏ回りに回動させることができる。
As shown in FIG. 15, the plurality of
また、ハンド４００にも、圧電モーター８０が指４１０ごとに対応して多連構成で設けられている。それぞれの圧電モーター８０は、対応する指４１０を回動軸Ｏに接近させるか、離間させる方向の駆動力を与える。これにより、２本の指４１０を接近または離間する方向に移動させることができる。
Furthermore, the
上述した、ロボット５００、及び、ハンド４００によれば、それぞれ、上記実施形態と同様の多連使いの圧電駆動装置を備えている。よって、多連の中で、異常がある圧電モーターが発生した場合であっても、異常がある圧電モーターの検出信号を除いた、正常な圧電モーターからの検出信号に基づいて追尾制御された所期の駆動信号を得ることができる。よって、安定した動作を行うことができる。
According to the
１～７…圧電素子、１０…基材、２０…駆動体、２１ａ…支持部、２１ｂ…支持部、２２…圧電アクチュエーター、３１…位置速度制御部、３２ｉ…Ｉ駆動電圧制御部、３２ｓ…Ｓ駆動電圧制御部、３２ｚ…Ｚ駆動電圧制御部、３３ｉ…ＰＷＭ波形生成部、３３ｓ…ＰＷＭ波形生成部、３３ｚ…ＰＷＭ波形生成部、３４ｉ…Ｉ駆動回路、３４ｓ…Ｓ駆動回路、３４ｚ…Ｚ駆動回路、３５…ＳＷ制御部、３６…平均化回路、３７…駆動周波数判定部、３８…駆動周波数制御部、６１…Ｓ駆動信号生成部、６２…Ｚ駆動信号生成部、６３…Ｉ駆動信号生成部、６４…周波数制御部、７０…制御部、８０…圧電モーター、８０ａ～８０ｃ…圧電モーター、９０…付勢体、９２…光学素子、９２ａ…発光素子、９２ｂ…撮像素子、９５…突起部、１００…圧電駆動装置、１１０…圧電駆動装置、１２０…圧電駆動装置、１６０…ローター、１６１…エンコーダー、１６５…ローター、１７０…ロッド、１９０…基台、２００…ロボットアーム、４００…ハンド、５００…ロボット。 DESCRIPTION OF SYMBOLS 1-7...Piezoelectric element, 10...Base material, 20...Driver, 21a...Support part, 21b...Support part, 22...Piezoelectric actuator, 31...Position speed control part, 32i...I drive voltage control part, 32s...S Drive voltage control unit, 32z...Z drive voltage control unit, 33i...PWM waveform generation unit, 33s...PWM waveform generation unit, 33z...PWM waveform generation unit, 34i...I drive circuit, 34s...S drive circuit, 34z...Z drive Circuit, 35...SW control unit, 36...Averaging circuit, 37...Drive frequency determination unit, 38...Drive frequency control unit, 61...S drive signal generation unit, 62...Z drive signal generation unit, 63...I drive signal generation Part, 64...Frequency control unit, 70...Control unit, 80...Piezoelectric motor, 80a to 80c...Piezoelectric motor, 90...Biasing body, 92...Optical element, 92a...Light emitting element, 92b...Imaging element, 95...Protrusion part , 100... Piezoelectric drive device, 110... Piezoelectric drive device, 120... Piezoelectric drive device, 160... Rotor, 161... Encoder, 165... Rotor, 170... Rod, 190... Base, 200... Robot arm, 400... Hand, 500 …robot.
Claims (8)
複数の前記圧電モーターは、同一の駆動信号により駆動されており、
前記駆動信号は、前記検出用の圧電素子からの検出信号に基づく、前記駆動信号の周波数の帰還制御を含む追尾制御が施され、
前記追尾制御が施された初期の前記駆動信号により駆動した際の前記検出信号の平均の周波数を初期周波数として記憶し、
前記初期周波数と、前記初期に続く駆動時における前記駆動信号により駆動した際の前記検出信号の平均の周波数との差分が、第１の閾値より大きいか否か確認し、
前記第１の閾値以下の場合は、前記駆動信号による駆動を継続し、
前記第１の閾値より大きい場合は、前記駆動信号が異常であると判断し、
前記第１の閾値より大きい場合は、
複数の前記圧電モーターのうち、１つの前記圧電モーターの前記検出信号を順次選択し、
選択された前記検出信号に基づき前記追尾制御が施された前記駆動信号により駆動した際の前記検出信号の周波数と、前記初期周波数との差分が、第３の閾値より大きいか否か確認し、
前記第３の閾値より大きい場合は、選択された前記圧電モーターを異常と判定し、選択された前記圧電モーターの前記検出信号の入力を切断する、
圧電駆動装置の制御方法。 A method for controlling a piezoelectric drive device in which a plurality of piezoelectric motors each having a piezoelectric element for driving and a piezoelectric element for detection are connected, the method comprising:
The plurality of piezoelectric motors are driven by the same drive signal,
The drive signal is subjected to tracking control including feedback control of the frequency of the drive signal based on the detection signal from the detection piezoelectric element,
storing an average frequency of the detection signal when driven by the drive signal at an initial stage when the tracking control is applied as an initial frequency;
Checking whether the difference between the initial frequency and the average frequency of the detection signal when driven by the drive signal during driving subsequent to the initial stage is larger than a first threshold;
If it is below the first threshold, continue driving by the drive signal;
If it is larger than the first threshold, it is determined that the drive signal is abnormal ;
If it is larger than the first threshold,
sequentially selecting the detection signal of one piezoelectric motor among the plurality of piezoelectric motors;
Checking whether the difference between the frequency of the detection signal when driven by the drive signal subjected to the tracking control based on the selected detection signal and the initial frequency is larger than a third threshold;
If it is larger than the third threshold, the selected piezoelectric motor is determined to be abnormal, and the input of the detection signal to the selected piezoelectric motor is cut off.
A method of controlling a piezoelectric drive device.
複数の前記圧電モーターは、同一の駆動信号により駆動されており、
前記駆動信号は、前記検出用の圧電素子からの検出信号に基づく、前記駆動信号の周波数の帰還制御を含む追尾制御が施され、
前記追尾制御が施された初期の前記駆動信号により駆動した際の前記検出信号の平均の周波数を初期周波数として記憶し、
前記初期周波数と、前記初期に続く駆動時における前記駆動信号により駆動した際の前記検出信号の平均の周波数との差分が、第１の閾値より大きいか否か確認し、
前記第１の閾値以下の場合は、前記駆動信号による駆動を継続し、
前記第１の閾値より大きい場合は、前記駆動信号が異常であると判断し、
前記第１の閾値より大きい場合は、
複数の前記圧電モーターのうち、１つの前記圧電モーターの前記検出信号を順次選択し、
選択された前記圧電モーターの前記検出信号を除く、複数の前記圧電モーターによる前記検出信号の平均値に基づき前記追尾制御が施された前記駆動信号により駆動した際の前記検出信号の周波数と、前記初期周波数との差分が、第４の閾値より大きいか否か確認し、
前記第４の閾値以下の場合は、選択された前記圧電モーターを異常と判定し、選択された前記圧電モーターの前記検出信号の入力を切断する、
圧電駆動装置の制御方法。 A method for controlling a piezoelectric drive device in which a plurality of piezoelectric motors each having a piezoelectric element for driving and a piezoelectric element for detection are connected, the method comprising:
The plurality of piezoelectric motors are driven by the same drive signal,
The drive signal is subjected to tracking control including feedback control of the frequency of the drive signal based on the detection signal from the detection piezoelectric element,
storing an average frequency of the detection signal when driven by the drive signal at an initial stage when the tracking control is applied as an initial frequency;
Checking whether the difference between the initial frequency and the average frequency of the detection signal when driven by the drive signal during driving subsequent to the initial stage is larger than a first threshold;
If it is below the first threshold, continue driving by the drive signal;
If it is larger than the first threshold, it is determined that the drive signal is abnormal ;
If it is larger than the first threshold,
sequentially selecting the detection signal of one piezoelectric motor among the plurality of piezoelectric motors;
the frequency of the detection signal when driven by the drive signal subjected to the tracking control based on the average value of the detection signals from a plurality of piezoelectric motors excluding the detection signal of the selected piezoelectric motor; Check whether the difference from the initial frequency is larger than a fourth threshold,
If the value is equal to or less than the fourth threshold, the selected piezoelectric motor is determined to be abnormal, and the input of the detection signal to the selected piezoelectric motor is cut off.
A method of controlling a piezoelectric drive device.
駆動装置の制御方法であって、
複数の前記圧電モーターは、同一の駆動信号により駆動されており、
前記駆動信号は、前記検出用の圧電素子からの検出信号に基づく、前記駆動信号の周波
数の帰還制御を含む追尾制御が施され、
前記追尾制御が施された初期の前記駆動信号により駆動した際の前記検出信号の平均の
周波数を初期周波数として記憶し、
第１の時刻における前記駆動信号により駆動した際の前記検出信号の周波数の変化率と
、第１の時刻よりも前の第２の時刻における前記駆動信号により駆動した際の前記検出信
号の周波数の変化率との比率が、第２の閾値より大きいか否か確認し、
前記第２の閾値以下の場合は、前記駆動信号による駆動を継続し、
前記第２の閾値より大きい場合は、前記駆動信号が異常であると判断する、
圧電駆動装置の制御方法。 A method for controlling a piezoelectric drive device in which a plurality of piezoelectric motors each having a piezoelectric element for driving and a piezoelectric element for detection are connected, the method comprising:
The plurality of piezoelectric motors are driven by the same drive signal,
The drive signal is subjected to tracking control including feedback control of the frequency of the drive signal based on the detection signal from the detection piezoelectric element,
storing an average frequency of the detection signal when driven by the drive signal at an initial stage when the tracking control is applied as an initial frequency;
a rate of change in the frequency of the detection signal when driven by the drive signal at a first time; and a rate of change in the frequency of the detection signal when driven by the drive signal at a second time before the first time. Check whether the ratio with the rate of change is greater than a second threshold,
If it is below the second threshold, continue driving by the drive signal;
If it is larger than the second threshold, determining that the drive signal is abnormal;
A method of controlling a piezoelectric drive device.
複数の前記圧電モーターのうち、１つの前記圧電モーターの前記検出信号を順次選択し、
選択された前記検出信号に基づき前記追尾制御が施された前記駆動信号により駆動した際の前記検出信号の周波数と、前記初期周波数との差分が、第３の閾値より大きいか否か確認し、
前記第３の閾値より大きい場合は、選択された前記圧電モーターを異常と判定し、選択された前記圧電モーターの前記検出信号の入力を切断する、
請求項３に記載の圧電駆動装置の制御方法。 If it is larger than the second threshold,
sequentially selecting the detection signal of one piezoelectric motor among the plurality of piezoelectric motors;
Checking whether the difference between the frequency of the detection signal when driven by the drive signal subjected to the tracking control based on the selected detection signal and the initial frequency is larger than a third threshold;
If it is larger than the third threshold, the selected piezoelectric motor is determined to be abnormal, and the input of the detection signal to the selected piezoelectric motor is cut off.
A method for controlling a piezoelectric drive device according to claim 3 .
複数の前記圧電モーターのうち、１つの前記圧電モーターの前記検出信号を順次選択し、
選択された前記圧電モーターの前記検出信号を除く、複数の前記圧電モーターによる前記検出信号の平均値に基づき前記追尾制御が施された前記駆動信号により駆動した際の前記検出信号の周波数と、前記初期周波数との差分が、第４の閾値より大きいか否か確認し、
前記第４の閾値以下の場合は、選択された前記圧電モーターを異常と判定し、選択され
た前記圧電モーターの前記検出信号の入力を切断する、
請求項３に記載の圧電駆動装置の制御方法。 If it is larger than the second threshold,
sequentially selecting the detection signal of one piezoelectric motor among the plurality of piezoelectric motors;
the frequency of the detection signal when driven by the drive signal subjected to the tracking control based on the average value of the detection signals from a plurality of piezoelectric motors excluding the detection signal of the selected piezoelectric motor; Check whether the difference from the initial frequency is larger than a fourth threshold,
If the value is equal to or less than the fourth threshold, the selected piezoelectric motor is determined to be abnormal, and the input of the detection signal to the selected piezoelectric motor is cut off.
A method for controlling a piezoelectric drive device according to claim 3 .
複数の前記圧電モーターは、同一の駆動信号により駆動されており、
前記駆動信号は、前記検出用の圧電素子からの検出信号に基づく、前記駆動信号の周波数の帰還制御を含む追尾制御が施され、
前記追尾制御が施された初期の前記駆動信号により駆動した際の前記検出信号の平均の周波数を初期周波数として記憶し、前記初期周波数における前記検出信号の電圧振幅を初期検出信号として記憶し、
前記初期周波数と、前記初期に続く駆動時における前記駆動信号により駆動した際の前記検出信号の周波数との差分が、第１の閾値より大きいか否か確認し、
前記第１の閾値以下の場合は、前記駆動信号による駆動を継続し、
前記第１の閾値より大きい場合は、前記駆動信号が異常であると判断し、
前記第１の閾値より大きい場合は、
前記駆動信号の周波数を固定し、
複数の前記圧電モーターのうち、１つの前記圧電モーターの前記検出信号を順次選択し、
選択された前記圧電モーターにおける前記検出信号の振幅電圧である選択検出信号と、前記初期検出信号との差分が、第５の閾値より大きいか否か確認し、
前記第５の閾値より大きい場合は、選択された前記圧電モーターを異常と判定し、選択された前記圧電モーターの前記検出信号の入力を切断し、
前記駆動信号の周波数の固定を解除し、前記追尾制御に戻す、
圧電駆動装置の制御方法。 A method for controlling a piezoelectric drive device in which a plurality of piezoelectric motors each having a piezoelectric element for driving and a piezoelectric element for detection are connected, the method comprising:
The plurality of piezoelectric motors are driven by the same drive signal,
The drive signal is subjected to tracking control including feedback control of the frequency of the drive signal based on the detection signal from the detection piezoelectric element,
An average frequency of the detection signal when driven by the drive signal at an initial stage after the tracking control is applied is stored as an initial frequency, and a voltage amplitude of the detection signal at the initial frequency is stored as an initial detection signal;
Checking whether the difference between the initial frequency and the frequency of the detection signal when driven by the drive signal during driving subsequent to the initial stage is larger than a first threshold;
If it is below the first threshold, continue driving by the drive signal;
If it is larger than the first threshold, it is determined that the drive signal is abnormal ;
If it is larger than the first threshold,
fixing the frequency of the drive signal;
sequentially selecting the detection signal of one piezoelectric motor among the plurality of piezoelectric motors;
Checking whether the difference between the selected detection signal, which is the amplitude voltage of the detection signal in the selected piezoelectric motor, and the initial detection signal is larger than a fifth threshold;
If it is larger than the fifth threshold, the selected piezoelectric motor is determined to be abnormal, and the input of the detection signal to the selected piezoelectric motor is cut off;
releasing the fixation of the frequency of the drive signal and returning to the tracking control;
A method of controlling a piezoelectric drive device.
複数の前記圧電モーターに、同一の駆動信号を供給する制御部と、を備え、
前記制御部は、
前記検出用の圧電素子からの検出信号に基づき、前記駆動信号の周波数の帰還制御を含
む追尾制御を施した前記駆動信号を生成し、
前記追尾制御が施された初期の前記駆動信号により駆動した際の前記検出信号の平均の
周波数を初期周波数として記憶し、
前記初期周波数と、前記初期に続く駆動時における前記駆動信号により駆動した際の前
記検出信号の平均の周波数との差分が、第１の閾値より大きいか否か確認し、
前記第１の閾値以下の場合は、前記駆動信号による駆動を継続し、
前記第１の閾値より大きい場合は、前記駆動信号が異常であると判断し、
前記制御部は、
前記差分が、前記第１の閾値より大きい場合、
複数の前記圧電モーターのうち、１つの前記圧電モーターの前記検出信号を順次選択し、
選択された前記検出信号に基づき前記追尾制御が施された前記駆動信号により駆動した際の前記検出信号の周波数と、前記初期周波数との差分が、第３の閾値より大きいか否か確認し、
前記第３の閾値より大きい場合は、選択された前記圧電モーターを異常と判定し、選択された前記圧電モーターの前記検出信号の入力を切断する、
圧電駆動装置。 a plurality of piezoelectric motors having piezoelectric elements for driving and piezoelectric elements for detection;
a control unit that supplies the same drive signal to a plurality of the piezoelectric motors,
The control unit includes:
Generating the drive signal subjected to tracking control including feedback control of the frequency of the drive signal based on the detection signal from the detection piezoelectric element,
storing an average frequency of the detection signal when driven by the drive signal at an initial stage when the tracking control is applied as an initial frequency;
Checking whether the difference between the initial frequency and the average frequency of the detection signal when driven by the drive signal during driving subsequent to the initial stage is larger than a first threshold;
If it is below the first threshold, continue driving by the drive signal;
If it is larger than the first threshold, it is determined that the drive signal is abnormal ;
The control unit includes:
If the difference is greater than the first threshold,
sequentially selecting the detection signal of one piezoelectric motor among the plurality of piezoelectric motors;
Checking whether the difference between the frequency of the detection signal when driven by the drive signal subjected to the tracking control based on the selected detection signal and the initial frequency is larger than a third threshold;
If it is larger than the third threshold, the selected piezoelectric motor is determined to be abnormal, and the input of the detection signal to the selected piezoelectric motor is cut off.
Piezoelectric drive device.
複数のアームと
前記複数のアームを接続する関節部と、を備え、
前記圧電駆動装置は、関節部に配置される、
ロボット。 A piezoelectric drive device according to claim 7 ,
comprising a plurality of arms and a joint portion connecting the plurality of arms,
the piezoelectric drive device is disposed at the joint;
robot.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2020087258A JP7450856B2 (en) | 2020-05-19 | 2020-05-19 | Control method of piezoelectric drive device, piezoelectric drive device, and robot |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2020087258A JP7450856B2 (en) | 2020-05-19 | 2020-05-19 | Control method of piezoelectric drive device, piezoelectric drive device, and robot |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2021182816A JP2021182816A (en) | 2021-11-25 |
| JP7450856B2 true JP7450856B2 (en) | 2024-03-18 |
Family
ID=78606991
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2020087258A Active JP7450856B2 (en) | 2020-05-19 | 2020-05-19 | Control method of piezoelectric drive device, piezoelectric drive device, and robot |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP7450856B2 (en) |
Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2001359286A (en) | 2000-06-14 | 2001-12-26 | Canon Inc | Vibration type actuator drive controller, fault detection/fixing method and recording medium |
| JP2008160913A (en) | 2006-12-21 | 2008-07-10 | Olympus Corp | Ultrasonic motor |
| JP2011166930A (en) | 2010-02-09 | 2011-08-25 | Seiko Epson Corp | Apparatus for control of piezoelectric actuator, piezoelectric actuator device, and printing device |
| JP2018186680A (en) | 2017-04-27 | 2018-11-22 | セイコーエプソン株式会社 | Method for controlling vibration actuator, method for detecting abnormality of vibration actuator, control apparatus for vibration actuator, robot, electronic component conveying apparatus, printer, projector, and vibration device |
-
2020
- 2020-05-19 JP JP2020087258A patent/JP7450856B2/en active Active
Patent Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2001359286A (en) | 2000-06-14 | 2001-12-26 | Canon Inc | Vibration type actuator drive controller, fault detection/fixing method and recording medium |
| JP2008160913A (en) | 2006-12-21 | 2008-07-10 | Olympus Corp | Ultrasonic motor |
| JP2011166930A (en) | 2010-02-09 | 2011-08-25 | Seiko Epson Corp | Apparatus for control of piezoelectric actuator, piezoelectric actuator device, and printing device |
| JP2018186680A (en) | 2017-04-27 | 2018-11-22 | セイコーエプソン株式会社 | Method for controlling vibration actuator, method for detecting abnormality of vibration actuator, control apparatus for vibration actuator, robot, electronic component conveying apparatus, printer, projector, and vibration device |
Also Published As
| Publication number | Publication date |
|---|---|
| JP2021182816A (en) | 2021-11-25 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP6504864B2 (en) | Robot control method, robot apparatus, program, recording medium, and article manufacturing method | |
| US9715124B2 (en) | Control device, actuator including control device, image blur correction device, interchangeable lens, image pickup apparatus, and automatic stage | |
| US6885132B2 (en) | Control apparatus for vibration type actuator, vibration type actuator system, and method for controlling vibration type actuator | |
| WO2010136961A1 (en) | Control device and method for controlling a robot | |
| JP2006503529A (en) | High resolution piezoelectric motor | |
| JP2008307634A (en) | Fitting device | |
| JP5406893B2 (en) | Robust operation of tendon-driven robotic fingers using force and position-based control laws | |
| JP7450856B2 (en) | Control method of piezoelectric drive device, piezoelectric drive device, and robot | |
| JP2020018079A (en) | Piezoelectric drive device, robot and printer | |
| JP6700679B2 (en) | Control method, article manufacturing method, robot device, control program, and recording medium | |
| US11751479B2 (en) | Method for controlling piezoelectric driving apparatus, piezoelectric driving apparatus, and robot | |
| JP7205162B2 (en) | Piezo drives, robots and printers | |
| JP6814441B2 (en) | Learning control device and learning control method for drive machines | |
| JP7363635B2 (en) | Control method of piezoelectric drive device, piezoelectric drive device, piezoelectric motor and robot | |
| Nambi et al. | Toward intuitive teleoperation of micro/nano-manipulators with piezoelectric stick-slip actuators | |
| US11881795B2 (en) | Method of controlling piezoelectric driving apparatus, method of controlling robot, and robot | |
| JP7363563B2 (en) | Anomaly detection method, piezoelectric motor and robot | |
| JP6971785B2 (en) | Drives, their control methods, and programs, as well as electronics. | |
| JP6491837B2 (en) | Motor polarity test of two-stage disk drive head suspension | |
| US20230146627A1 (en) | Robot control method and robot | |
| US20200313574A1 (en) | Control Method Of Piezoelectric Driving Device And Piezoelectric Driving Device | |
| US20230200251A1 (en) | Control method for piezoelectric motor, piezoelectric motor, and robot | |
| JP4209261B2 (en) | Method and apparatus for controlling rotational position of multi-degree-of-freedom ultrasonic motor | |
| JP7238581B2 (en) | Piezoelectric driving device control method, piezoelectric driving device, and robot | |
| JP2005086922A (en) | Method and device for controlling rotational position of multiple-degree-of-freedom ultrasonic motor |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| RD04 | Notification of resignation of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7424 Effective date: 20210922 |
|
| RD03 | Notification of appointment of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7423 Effective date: 20211104 |
|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20230424 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20231129 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20231219 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20240117 |
|
| 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: 20240205 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20240218 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 7450856 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |