JP2013031234A - 一つの被駆動体を二つの電動機で駆動させる制御装置 - Google Patents

一つの被駆動体を二つの電動機で駆動させる制御装置 Download PDF

Info

Publication number
JP2013031234A
JP2013031234A JP2011163474A JP2011163474A JP2013031234A JP 2013031234 A JP2013031234 A JP 2013031234A JP 2011163474 A JP2011163474 A JP 2011163474A JP 2011163474 A JP2011163474 A JP 2011163474A JP 2013031234 A JP2013031234 A JP 2013031234A
Authority
JP
Japan
Prior art keywords
speed value
motor
speed
unit
correction amount
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
Application number
JP2011163474A
Other languages
English (en)
Other versions
JP5192571B2 (ja
Inventor
Naoto Sonoda
直人 園田
Heisuke Iwashita
平輔 岩下
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Fanuc Corp
Original Assignee
Fanuc Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Fanuc Corp filed Critical Fanuc Corp
Priority to JP2011163474A priority Critical patent/JP5192571B2/ja
Priority to US13/495,181 priority patent/US8680805B2/en
Priority to DE102012014324A priority patent/DE102012014324A1/de
Priority to CN201210259833.0A priority patent/CN102904495B/zh
Publication of JP2013031234A publication Critical patent/JP2013031234A/ja
Application granted granted Critical
Publication of JP5192571B2 publication Critical patent/JP5192571B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00—Programme-control systems
    • G05B19/02—Programme-control systems electric
    • G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
    • G05B19/416—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by control of velocity, acceleration or deceleration
    • H—ELECTRICITY
    • H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
    • H02P5/00—Arrangements specially adapted for regulating or controlling the speed or torque of two or more electric motors
    • H02P5/46—Arrangements specially adapted for regulating or controlling the speed or torque of two or more electric motors for speed regulation of two or more dynamo-electric motors in relation to one another
    • H02P5/50—Arrangements specially adapted for regulating or controlling the speed or torque of two or more electric motors for speed regulation of two or more dynamo-electric motors in relation to one another by comparing electrical values representing the speeds
    • H—ELECTRICITY
    • H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
    • H02P5/00—Arrangements specially adapted for regulating or controlling the speed or torque of two or more electric motors
    • H02P5/74—Arrangements specially adapted for regulating or controlling the speed or torque of two or more electric motors controlling two or more ac dynamo-electric motors
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/34—Director, elements to supervisory
    • G05B2219/34027—Dual servo controller, for two motors
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/41—Servomotor, servo controller till figures
    • G05B2219/41034—Two motors driven in opposite direction to take up backlash
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/41—Servomotor, servo controller till figures
    • G05B2219/41264—Driven by two motors

Landscapes

  • Engineering & Computer Science (AREA)
  • Power Engineering (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Multiple Motors (AREA)
  • Control Of Electric Motors In General (AREA)
  • Control Of Position Or Direction (AREA)

Abstract

【課題】二つの電動機間の機動力が互いに干渉することによって生じうる振動を抑制するために、二つのプロセッサで二つの電動機を制御することができる制御装置を提供する。
【解決手段】ＤＳＰ１１ａは、取得した回転サーボモータ３ａの速度値をＤＳＰ１１ｂに送信するとともに回転サーボモータ３ｂの速度値をＤＳＰ１１ｂから受信し、回転サーボモータ３ａへのトルク指令に対する補正量を、回転サーボモータ３ａの速度値と回転サーボモータ３ｂの速度値との速度値差に基づいて計算する。ＤＳＰ１１ｂは、取得した回転サーボモータ３ｂの速度値をＤＳＰ１１ａに送信するとともに回転サーボモータ３ａの速度値をＤＳＰ１１ａから受信し、回転サーボモータ３ｂへのトルク指令に対する補正量を、回転サーボモータ３ａの速度値と回転サーボモータ３ｂの速度値との速度値差に基づいて計算する。
【選択図】図１

Description

本発明は、工作機械等においてワークや工具のような一つの被駆動体を二つの電動機で駆動させる制御装置に関する。
工作機械等において、電動機の被駆動体が大型であるために一つの電動機では加減速ができない場合や、電動機と被駆動体との間のバックラッシュが大きいために被駆動体を安定した状態で移動させることができない場合には、一つの被駆動体を二つの電動機で駆動するタンデム制御が行われている。
このようなタンデム制御では、二つの電動機間の結合剛性が高い場合、二つの電動機間の僅かな同期誤差により二つの電動機間の機動力が互いに干渉し、振動が生じることがある。このような振動を抑制するために、二つの電動機の速度値差に基づいて振動を抑制する一つのプロセッサ（例えば、デジタルシグナルプロセッサ（ＤＳＰ））を有する制御装置が提案されている（例えば、特許文献１）。
特許第３４９２５８３号公報
しかしながら、一つのプロセッサの処理能力には限界がある。例えば、二つの電動機が、一つのロータ及び一つの速度検出器に対して複数のステータ巻線を有する回転型サーボモータである場合や、二つの電動機が、一つの磁石板及び一つの速度検出器に対して複数のスライダーを有する二つのリニアサーボモータである場合には、一つの電動機に対して電流制御等を含む複数のモータ駆動部の処理が必要なため、一つのプロセッサで二つの電動機を制御することができない。したがって、二つの電動機のタンデム制御で生じうる振動を抑制するために、二つのプロセッサで二つの電動機を制御しなければならない場合がある。
本発明の目的は、二つの電動機間の機動力が互いに干渉することによって生じうる振動を抑制するために、二つのプロセッサで二つの電動機を制御することができる制御装置を提供することである。
本発明による制御装置は、一つの被駆動体を第１の電動機及び第２の電動機で駆動させる制御装置であって、前記第１の電動機を制御する第１のプロセッサと、前記第２の電動機を制御する第２のプロセッサと、を備え、前記第１のプロセッサは、前記第１の電動機の速度値を取得する第１の速度値取得部と、前記第１の電動機の速度値を前記第２のプロセッサに送信するとともに前記第２の電動機の速度値を前記第２のプロセッサから受信する第１の送受信部と、前記第１の電動機の速度値と前記第２の電動機の速度値との速度値差を計算する第１の速度値差計算部と、前記第１の電動機と前記第２の電動機との間の機動力が互いに干渉することによって生じる振動を抑制するために、前記第１の電動機へのトルク指令に対する補正量を、前記速度値差に基づいて計算する第１の補正量計算部と、を有し、前記第２のプロセッサは、前記第２の電動機の速度値を取得する第２の速度値取得部と、前記第２の電動機の速度値を前記第１のプロセッサに送信するとともに前記第１の電動機の速度値を前記第１のプロセッサから受信する第２の送受信部と、前記第１の電動機の速度値と前記第２の電動機の速度値との速度値差を計算する第２の速度値差計算部と、前記第１の電動機と前記第２の電動機との間の機動力が互いに干渉することによって生じる振動を抑制するために、前記第１の電動機へのトルク指令に対する補正量を、前記速度値差に基づいて計算する第２の補正量計算部と、を有する。
好適には、前記第１の補正計算部及び前記第２の補正計算部はそれぞれ、前記速度値差の位相を進める位相補償部と、前記位相を進めた速度値差からねじれ補正量を計算するねじれ補正量計算部又は前記位相を進めた速度値差から摩擦補正を計算する摩擦補正量計算部と、を有する。
好適には、前記第１の電動機及び前記第２の電動機はそれぞれ、一つのロータと一つの速度検出器に対して複数のステータ巻線を有する回転型サーボモータである。
好適には、前記第１の電動機及び前記第２の電動機はそれぞれ、一つの磁石板と一つの速度検出器に対して複数のスライダーを有するリニアサーボモータである。
本発明によれば、第１の電動機の速度と第２の電動機の速度との差に基づいて振動を抑制するために、二つのプロセッサがいずれも第１の電動機の速度と第２の電動機の速度の両方を取得することができる。したがって、二つの電動機間の機動力が互いに干渉することによって生じうる振動を抑制するために二つのプロセッサで二つの電動機を制御することができる。
本発明による制御装置によって二つの回転型サーボモータを駆動するシステムのブロック図である。 図１の制御装置の一方のプロセッサを詳細に示すブロック図である。 図１の制御装置の他方のプロセッサを詳細に示すブロック図である。 図１の制御装置の動作のフローチャートである。 本発明による制御装置によって二つのリニアサーボモータを駆動するシステムのブロック図である。
本発明による制御装置の実施の形態を、図面を参照しながら説明する。なお、図面中、同一構成要素には同一符号を付す。
図１は、本発明による制御装置によって二つの回転型サーボモータを駆動するシステムのブロック図である。図１において、制御装置１は、制御装置１に接続されたＣＮＣ（数値制御装置）等の上位制御装置２からの作業工程に応じた指令信号に基づいて、回転型サーボモータ３ａ，３ｂの位置、速度、トルク等をそれぞれ制御する。制御装置１の制御により、回転型サーボモータ３ａ，３ｂに接続された被駆動体としてのテーブル４がボールねじ５ａ，５ｂに沿ってスライドするようになる。
制御装置１が回転型サーボモータ３ａ，３ｂの位置、速度、トルク等をそれぞれ制御するために、回転型サーボモータ３ａ，３ｂの速度（回転速度）を検出し、検出した速度を制御装置１に供給する速度検出器６ａ，６ｂをそれぞれ設ける。検出器６ａ，６ｂを、例えば、回転型サーボモータ３ａ，３ｂの速度に比例したパルスを生成するエンコーダとする。
回転型サーボモータ３ａは、一つのロータ（図示せず）と一つの速度検出器６ａに対して複数（この場合、２個）のステータ巻線３１ａ，３２ａを有し、ボールねじ５ａに連結した回転型サーボモータ３ａの駆動軸（図示せず）が、マスタ軸としての役割を果たす。一方、回転型サーボモータ３ｂは、一つのロータ（図示せず）と一つの速度検出器６ｂに対して複数（この場合、２個）のステータ巻線３１ｂ，３２ｂを有し、ボールねじ５ｂに連結した回転型サーボモータ３ｂの駆動軸（図示せず）が、スレーブ軸としての役割を果たす。
制御装置１は、プロセッサとしてのＤＳＰ１１ａ，１１ｂと、アンプ１２ａ，１２ｂ，１３ａ，１３ｂと、を有する。ＤＳＰ１１ａは、モータ駆動部４０ａ，５０ａと、制振制御部６０ａと、を有する。同様に、ＤＳＰ１１ｂは、モータ駆動部４０ｂ，５０ｂと、制振制御部６０ｂと、を有する。
図２は、図１の制御装置の一方のプロセッサを詳細に示すブロック図である。図２において、モータ駆動部４０ａは、位置制御部４１ａと、速度制御部４２ａと、加算器４３ａと、電流制御部４４ａと、を有する。位置制御部４１ａは、設定された位置ゲインに基づいて、モータ駆動部５０ａと同期を取りながら上位制御装置２から入力される位置指令信号と、速度検出器６ａからの速度のフィードバック信号を積分することによって生成される位置のフィードバック信号とに応じた動作を行う。速度制御部４２ｂは、設定された速度ゲインに基づいて、位置制御部４１ａからの速度指令信号と、速度検出器６ａからの速度のフィードバック信号とに応じた動作を行う。
加算器４３ａは、一方の入力部に入力される速度制御部４２ａからのトルク指令信号と、他方の入力部に入力される後述する補正量信号とを加算し、加算器４３ａの出力信号を電流制御部４４ａに供給する。電流制御部４４ａは、加算器４３ａの出力信号と、アンプ１２ａからの電流のフィードバック信号とに応じた動作を行う。アンプ１２ａは、アンプ１２ａに入力される電流制御部４４ａの出力信号に応じて、回転サーボモータ３ａへの供給電力を制御する。
同様に、モータ駆動部５０ａは、位置制御部５１ａと、速度制御部５２ａと、加算器５３ａと、電流制御部５４ａと、を有する。位置制御部５１ａは、設定された位置ゲインに基づいて、モータ駆動部４０ａと同期を取りながら上位制御装置２から入力される位置指令信号と、速度検出器６ａからの速度のフィードバック信号を積分することによって生成される位置のフィードバック信号とに応じた動作を行う。速度制御部５２ａは、設定された速度ゲインに基づいて、位置制御部５１ａからの速度指令信号と、速度検出器６ａからの速度のフィードバック信号とに応じた動作を行う。
加算器５３ａは、一方の入力部に入力される速度制御部５２ａからのトルク指令信号と、他方の入力部に入力される後述する補正量信号とを加算し、加算器５３ａの出力信号を電流制御部５４ａに供給する。電流制御部５４ａは、加算器５３ａの出力信号と、アンプ１３ａからの電流のフィードバック信号とに応じた動作を行う。アンプ１３ａは、アンプ１３ａに入力される電流制御部５４ａの出力信号に応じて、回転サーボモータ３ａへの供給電力を制御する。
制振制御部６０ａは、回転型サーボモータ３ａと回転型サーボモータ３ｂとの間の機動力が互いに干渉することによって生じる振動を抑制する。このために、制振制御部６０ａは、速度値取得部６１ａと、送受信部６２ａと、メモリ６３ａと、速度値計算部６４ａと、補正量計算部６５ａと、を有する。
速度値取得部６１ａは、速度検出器６ａからの速度フィードバックの信号を回転型サーボモータ３ａの速度値として所定のサンプリング周期Ｔ（例えば、Ｔ＝１ミリ秒）で取得し、回転型サーボモータ３ａの速度フィードバック値としてメモリ６３ａに記憶させる。
送受信部６２ａは、メモリ６３ａに記憶された回転型サーボモータ３ａの速度値をＤＳＰ１１ｂに送信するとともに、速度値取得部６１ａが回転型サーボモータ３ａの速度値を取得するのと同様な方法でＤＳＰ１１ｂが取得した回転型サーボモータ３ｂの速度値を、ＤＳＰ１１ｂから受信する。なお、ＤＳＰ１１ａとＤＳＰ１１ｂとの間の通信は、上位制御装置２の制御に基づいて、ＤＳＰ１１ａとＤＳＰ１１ｂとの間に介在するＩＩＣバスのような通信経路７（図１）を用いて行われる。
速度値差計算部６４ａは、回転型サーボモータ３ａの速度値及び回転型サーボモータ３ｂの速度値をメモリ６３ａから読み出し、回転型サーボモータ３ａの速度値と回転型サーボモータ３ｂの速度値との間の速度値差を計算する。
補正量計算部６５ａは、回転型サーボモータ３ａと回転型サーボモータ３ｂとの間の機動力が互いに干渉することによって生じる振動を抑制するために、回転型サーボモータ３ａへのトルク指令に対する補正量を計算する。このために、補正量計算部６５ａは、位相補償部６６ａと、ねじれ補正部６７ａと、摩擦補正部６８ａと、を有する。
位相補償部６６ａは、速度値差計算部６４ａが出力する速度値差信号の位相を進める機能を有する。ねじれ補正部６７ａは、位相補償部６６ａによって位相が進められた速度差信号からねじれ補正量信号を生成する。摩擦補正部６８ａは、位相補償部６６ａによって位相が進めた速度差信号から摩擦補正量信号を生成する。加算器６９ａは、一方の入力部に入力されるねじれ補正部６７ａからのねじれ補正量信号と、他方の入力部に入力される摩擦補正部６８ａからの摩擦補正量信号とを加算し、ねじれ補正量信号と摩擦補正量信号との和に相当する補正量信号を加算器４３ａの他方の入力部及び加算器５３ａの他方の入力部に供給する。したがって、電流制御部４４ａには、速度制御部４２ａからのトルク指令信号に加算器６９ａからの補正量信号を加算した信号が入力され、電流制御部５４ａには、速度制御部５２ａからのトルク指令信号に加算器６９ａからの補正量信号を加算した信号が入力される。
位相補償部６６ａは、図１に示すシステムの遅れを補償することによって制振効果を向上させることができる。また、ねじれ補正部６７ａは、ねじれ補正（ばね補正）を行うことによって、回転型サーボモータ３ａと回転型サーボモータ３ｂとの間の機動力が互いに干渉することによって生じる振動を抑制することができる。さらに、摩擦補正部６８ａは、摩擦補正を行うことによって、回転型サーボモータ３ａと回転型サーボモータ３ｂとの間の機動力が互いに干渉することによって生じる振動を抑制することができる。
図３は、図１の制御装置の他方のプロセッサを詳細に示すブロック図である。図３において、モータ駆動部４０ｂは、図２の位置制御部４１ａ、速度制御部４２ａ及び電流制御部４４ａと同様な機能をそれぞれ有する位置制御部４１ｂ、速度制御部４２ｂ及び電流制御部４４ｂを有し、図２の加算器４３ａの代わりに減算器４３ｂを有する。
同様に、モータ駆動部５０ｂは、図２の位置制御部５１ａ、速度制御部５２ａ及び電流制御部５４ａと同様な機能をそれぞれ有する位置制御部５１ｂ、速度制御部５２ｂ及び電流制御部５４ｂを有し、図２の加算器５３ａの代わりに減算器５３ｂを有する。
制振制御部６０ｂは、図２の速度値取得部６１ａ、送受信部６２ａ、メモリ６３ａ、速度値計算部６４ａ及び補正量計算部６５ａと同様な機能をそれぞれ有する速度値取得部６１ｂ、送受信部６２ｂ、メモリ６３ｂ、速度値計算部６４ｂ及び補正量計算部６５ｂを有する。
モータ駆動部４０ｂが図２の加算器４３ａの代わりに減算器４３ｂを有し、モータ駆動部５０ｂが図２の加算器５３ａの代わりに減算器５３ｂを有するので、電流制御部４４ｂには、速度制御部４２ｂからのトルク指令信号から加算器６９ａからの補正量信号を減算した信号が入力され、電流制御部５４ａには、速度制御部５２ａからのトルク指令信号から加算器６９ａからの補正量信号を減算した信号が入力される。
図４は、図１の制御装置の動作のフローチャートである。このフローチャートは、上位制御装置２からのテーブル４を駆動する旨の指令信号をＤＳＰ１１ａ及びＤＳＰ１１ｂが受信した後に所定回数実行される。
先ず、ステップＳ１−１において、速度値取得部６１ａは、回転型サーボモータ３ａの速度値を取得し、ステップＳ２−１において、速度値取得部６１ｂは、回転型サーボモータ３ｂの速度値を取得する。
次に、ステップＳ２−１において、送受信部６２ａは、回転型サーボモータ３ａの速度値をＤＳＰ１１ｂに送信し、ステップＳ２−２において、送受信部６２ｂは、回転型サーボモータ３ｂの速度値をＤＳＰ１１ａに送信する。
次に、ステップＳ３−１において、送受信部６２ａは、回転型サーボモータ３ｂの速度値をＤＳＰ１１ｂから受信し、ステップＳ３−２において、送受信部６２ａは、回転型サーボモータ３ａの速度値をＤＳＰ１１ａから受信する。
次に、ステップＳ４−１において、速度差値計算部６４ａは、回転型サーボモータ３ａの速度値と回転型サーボモータ３ｂの速度値との間の速度値差を計算し、ステップＳ４−２において、速度差値計算部６４ｂは、回転型サーボモータ３ａの速度値と回転型サーボモータ３ｂの速度値との間の速度値差を計算する。
次に、ステップＳ５−１において、位相補償部６６ａは、速度値差計算部６４ａが出力する速度値差信号の位相補償量を計算し、ステップＳ５−２において、位相補償部６６ｂは、速度値差計算部６４ｂが出力する速度値差信号の位相補償量を計算する。
次に、ステップＳ６−１において、ねじれ補正部６７ａは、位相補償部６６ａによって位相補償された速度差信号からねじれ補正量を計算し、ステップＳ６−２において、ねじれ補正部６７ｂは、位相補償部６６ｂによって位相補償された速度差信号からねじれ補正量を計算する。
次に、ステップＳ７−１において、摩擦補正部６８ａは、位相補償部６６ａによって位相補償された速度差信号から摩擦補正量を計算し、ステップＳ７−２において、摩擦補正部６８ｂは、位相補償部６６ｂによって位相補償された速度差信号から摩擦補正量を計算する。
次に、ステップＳ８−１において、加算器４３ａは、速度制御部４２ａからのトルク指令に補正量（この場合、ねじれ補正量と摩擦補正量との和）を加算し、加算器５３ａは、速度制御部５２ａからのトルク指令に補正量を加算し、ＤＳＰ１１ａ側の処理を終了する。また、ステップＳ８−２において、減算器４３ｂは、速度制御部４２ｂからのトルク指令から補正量を減算し、減算器５３ｂは、速度制御部５２ｂからのトルク指令から補正量を減算し、ＤＳＰ１１ｂ側の処理を終了する。
本実施の形態によれば、回転型サーボモータ３ａの速度値と回転型サーボモータ３ｂの速度値との間の速度差値に基づいて振動を抑制するために、二つのＤＳＰ１１ａ及びＤＳＰ１１ｂがいずれも回転型サーボモータ３ａの速度値と回転型サーボモータ３ｂの速度値の両方を取得することができる。したがって、回転型サーボモータ３ａと回転型サーボモータ３ｂとの間の機動力が互いに干渉することによって生じうる振動を抑制するために、二つのＤＳＰ１１ａ及びＤＳＰ１１ｂで二つの回転型サーボモータ３ａ及び回転型サーボモータ３ｂを制御することができる。
図５は、本発明による制御装置によって二つのリニアサーボモータを駆動するシステムのブロック図である。図５において、制御装置１は、制御装置１に接続されたＣＮＣ（数値制御装置）等の上位制御装置２からの作業工程に応じた指令信号に基づいて、リニアサーボモータ１３ａ，１３ｂの位置、速度、トルク等をそれぞれ制御する。制御装置１の制御により、リニアサーボモータ１３ａ，１３ｂに接続された被駆動体としてのテーブル１４が磁石板１５ａ，１５ｂに沿ってスライドするようになる。
リニアサーボモータ１３ａは、一つの磁石板１５ａと一つの速度検出器６ａに対して複数（この場合、２個）のスライダー３３ａ，３４ａを有する。一方、リニアサーボモータ１３ｂは、一つの磁石板１５ｂと一つの速度検出器６ｂに対して複数（この場合、２個）のスライダー３３ｂ，３４ｂを有する。
本実施の形態によれば、制御装置１が上述したように制振制御を行うことによって、リニアサーボモータ１３ａとリニアサーボモータ１３ｂとの間の機動力が互いに干渉することによって生じうる振動を抑制するために、二つのＤＳＰ１１ａ及びＤＳＰ１１ｂで二つのリニアサーボモータ３ａ及びリニアサーボモータ３ｂを制御することができる。
本発明は、上記実施の形態に限定されるものではなく、幾多の変更及び変形が可能である。例えば、上記実施の形態において、本発明による制御装置によって二つの回転型サーボモータ又は二つのリニアサーボモータを制御する場合について説明したが、二つの振動型サーボモータ等も本発明による制御装置によって制御することができる。
また、被駆動体として、アーム、それらに着脱されるワーク等を用いることもできる。さらに、上記実施の形態では、ねじれ補正と摩擦補正の両方を行う場合について説明したが、ねじれ補正と摩擦補正のうちのいずれか一方のみを行ってもよい。
１ 制御装置
２ 上位制御装置
３ａ，３ｂ 回転型サーボモータ
４，１４ テーブル
５ａ，５ｂ ボールねじ
６ａ，６ｂ 速度検出器
７ 通信経路
１１ａ，１１ｂ ＤＳＰ
１２ａ，１２ｂ，１３ａ，１３ｂ アンプ
１３ａ，１３ｂ リニアサーボモータ
１５ａ，１５ｂ 磁石板
３１ａ，３１ｂ，３２ａ，３２ｂ ステータ巻線
３３ａ，３３ｂ，３４ａ，３４ｂ スライダー
４０ａ，４０ｂ，５０ａ，５０ｂ モータ駆動部
６０ａ，６０ｂ 制振制御部
４１ａ，４１ｂ，５１ａ，５１ｂ 位置制御部
４２ａ，４２ｂ，５２ａ，５２ｂ 速度制御部
４３ａ，５３ａ，６９ａ，６９ｂ 加算器
４３ｂ，５３ｂ 減算器
４４ａ，４４ｂ，５４ａ，５４ｂ 電流制御部
６１ａ，６１ｂ 速度値取得部
６２ａ，６２ｂ 送受信部
６３ａ，６３ｂ メモリ
６４ａ，６４ｂ 速度値差計算部
６５ａ，６５ｂ 補正量計算部
６６ａ，６６ｂ 位相補償部
６７ａ，６７ｂ ねじれ補正部
６８ａ，６８ｂ 摩擦補正部
本発明による制御装置は、一つの被駆動体を第１の電動機及び第２の電動機で駆動させる制御装置であって、前記第１の電動機を制御する第１のプロセッサと、前記第２の電動機を制御する第２のプロセッサと、を備え、前記第１のプロセッサは、前記第１の電動機の速度値を取得する第１の速度値取得部と、前記第１の電動機の速度値を前記第２のプロセッサに送信するとともに前記第２の電動機の速度値を前記第２のプロセッサから受信する第１の送受信部と、前記第１の速度値取得部が取得した前記第１の電動機の速度値と前記第１の送受信部が受信した前記第２の電動機の速度値との速度値差を計算する第１の速度値差計算部と、前記第１の電動機と前記第２の電動機との間の機動力が互いに干渉することによって生じる振動を抑制するために、前記第１の電動機へのトルク指令に対する補正量を、前記第１の速度値取得部が取得した前記第１の電動機の速度値と前記第１の送受信部が受信した前記第２の電動機の速度値との速度値差に基づいて計算する第１の補正量計算部と、を有し、前記第２のプロセッサは、前記第２の電動機の速度値を取得する第２の速度値取得部と、前記第２の電動機の速度値を前記第１のプロセッサに送信するとともに前記第１の電動機の速度値を前記第１のプロセッサから受信する第２の送受信部と、前記第２の送受信部が受信した前記第１の電動機の速度値と前記第２の速度値取得部が取得した前記第２の電動機の速度値との速度値差を計算する第２の速度値差計算部と、前記第１の電動機と前記第２の電動機との間の機動力が互いに干渉することによって生じる振動を抑制するために、前記第２の電動機へのトルク指令に対する補正量を、前記第２の送受信部が受信した前記第１の電動機の速度値と前記第２の速度値取得部が取得した前記第２の電動機の速度値差に基づいて計算する第２の補正量計算部と、を有する。

Claims (4)

  1. 一つの被駆動体を第１の電動機及び第２の電動機で駆動させる制御装置であって、
    前記第１の電動機を制御する第１のプロセッサと、
    前記第２の電動機を制御する第２のプロセッサと、
    を備え、
    前記第１のプロセッサは、
    前記第１の電動機の速度値を取得する第１の速度値取得部と、
    前記第１の電動機の速度値を前記第２のプロセッサに送信するとともに前記第２の電動機の速度値を前記第２のプロセッサから受信する第１の送受信部と、
    前記第１の電動機の速度値と前記第２の電動機の速度値との速度値差を計算する第１の速度値差計算部と、
    前記第１の電動機と前記第２の電動機との間の機動力が互いに干渉することによって生じる振動を抑制するために、前記第１の電動機へのトルク指令に対する補正量を、前記速度値差に基づいて計算する第１の補正量計算部と、を有し、
    前記第２のプロセッサは、
    前記第２の電動機の速度値を取得する第２の速度値取得部と、
    前記第２の電動機の速度値を前記第１のプロセッサに送信するとともに前記第１の電動機の速度値を前記第１のプロセッサから受信する第２の送受信部と、
    前記第１の電動機の速度値と前記第２の電動機の速度値との速度値差を計算する第２の速度値差計算部と、
    前記第１の電動機と前記第２の電動機との間の機動力が互いに干渉することによって生じる振動を抑制するために、前記第２の電動機へのトルク指令に対する補正量を、前記速度値差に基づいて計算する第２の補正量計算部と、を有する制御装置。
  2. 前記第１の補正計算部及び前記第２の補正計算部はそれぞれ、
    前記速度値差の位相を進める位相補償部と、
    前記位相を進めた速度値差からねじれ補正量を計算するねじれ補正量計算部又は前記位相を進めた速度値差から摩擦補正を計算する摩擦補正量計算部と、
    を有する請求項１に記載の制御装置。
  3. 前記第１の電動機及び前記第２の電動機はそれぞれ、一つのロータと一つの速度検出器に対して複数のステータ巻線を有する回転型サーボモータである請求項１又は２に記載の制御装置。
  4. 前記第１の電動機及び前記第２の電動機はそれぞれ、一つの磁石板と一つの速度検出器に対して複数のスライダーを有するリニアサーボモータである請求項１又は２に記載の制御装置。
JP2011163474A 2011-07-26 2011-07-26 一つの被駆動体を二つの電動機で駆動させる制御装置 Active JP5192571B2 (ja)

Priority Applications (4)

Application Number Priority Date Filing Date Title
JP2011163474A JP5192571B2 (ja) 2011-07-26 2011-07-26 一つの被駆動体を二つの電動機で駆動させる制御装置
US13/495,181 US8680805B2 (en) 2011-07-26 2012-06-13 Control device that drives one driven object by two motors
DE102012014324A DE102012014324A1 (de) 2011-07-26 2012-07-19 Steuervorrichtung, die ein angetriebenes Objekt durch zwei Motoren antreibt
CN201210259833.0A CN102904495B (zh) 2011-07-26 2012-07-25 通过两个电动机驱动一个被驱动体的控制装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2011163474A JP5192571B2 (ja) 2011-07-26 2011-07-26 一つの被駆動体を二つの電動機で駆動させる制御装置

Publications (2)

Publication Number Publication Date
JP2013031234A true JP2013031234A (ja) 2013-02-07
JP5192571B2 JP5192571B2 (ja) 2013-05-08

Family

ID=47503201

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2011163474A Active JP5192571B2 (ja) 2011-07-26 2011-07-26 一つの被駆動体を二つの電動機で駆動させる制御装置

Country Status (4)

Country Link
US (1) US8680805B2 (ja)
JP (1) JP5192571B2 (ja)
CN (1) CN102904495B (ja)
DE (1) DE102012014324A1 (ja)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2014155290A (ja) * 2013-02-07 2014-08-25 Sanken Electric Co Ltd 永久磁石同期電動機の制御装置
JP2014214959A (ja) * 2013-04-25 2014-11-17 パナソニック株式会社 断熱箱体
JP5642848B1 (ja) * 2013-07-19 2014-12-17 ファナック株式会社 一つの被駆動体を駆動するために二つのモータを制御するモータ制御装置
JP2017060327A (ja) * 2015-09-17 2017-03-23 山洋電気株式会社 モータ制御装置

Families Citing this family (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5698777B2 (ja) * 2013-03-13 2015-04-08 ファナック株式会社 モータの加速度に応じたプリロードトルク値を生成するモータ制御装置
JP5742879B2 (ja) * 2013-05-21 2015-07-01 トヨタ自動車株式会社 車両用の回転電機の制御装置
CN103490678B (zh) * 2013-10-17 2016-06-22 双峰格雷斯海姆医药玻璃（丹阳）有限公司 主从机同步控制方法及系统
JP5778750B2 (ja) * 2013-12-24 2015-09-16 ファナック株式会社 同期誤差を低減する機能を有する射出成形機の制御装置
JP6331225B2 (ja) * 2015-08-19 2018-05-30 株式会社安川電機 モータ制御装置、位置制御システム、及びモータ制御方法
JP6444934B2 (ja) * 2016-04-26 2018-12-26 ファナック株式会社 モータ温度に応じて動作を変更する制御装置及び制御方法
JP6937470B2 (ja) * 2016-05-10 2021-09-22 パナソニックＩｐマネジメント株式会社 モータ制御システム
JP6753247B2 (ja) * 2016-09-27 2020-09-09 オムロン株式会社 制御装置、制御プログラムおよび制御方法
JP6817237B2 (ja) * 2018-01-24 2021-01-20 ミネベアミツミ株式会社 モータ駆動システム、モータ駆動制御装置、モータ駆動制御装置の制御方法、及びモータ駆動制御装置の制御プログラム。
CN109699070B (zh) * 2018-12-28 2021-01-01 湖南深拓智能设备股份有限公司 主、从机旋转设备及其同步控制方法
CN110311597B (zh) * 2019-07-30 2021-11-05 南京航空航天大学 一种离心式电力作动器的控制方法
CN113285632A (zh) * 2020-02-19 2021-08-20 广西汽车集团有限公司 一种双电机同步控制方法及装置
CN112114539B (zh) * 2020-09-25 2023-11-28 成都易慧家科技有限公司 一种双电机驱动推拉门窗的控制系统及其方法

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH10326107A (ja) * 1997-03-25 1998-12-08 Mitsubishi Electric Corp サーボ制御方法およびサーボ制御システム
JP3492583B2 (ja) * 2000-03-27 2004-02-03 ファナック株式会社 サーボ制御装置
JP2005176493A (ja) * 2003-12-11 2005-06-30 Yaskawa Electric Corp モータ駆動装置の非常停止方法
JP2008022638A (ja) * 2006-07-13 2008-01-31 Seiko Epson Corp 複数の電動モータを用いた駆動システム及びその制御方法
JP2008043046A (ja) * 2006-08-07 2008-02-21 Aida Eng Ltd サーボモータの制御方法
JP2010088188A (ja) * 2008-09-30 2010-04-15 Sanyo Electric Co Ltd モータ制御回路

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE4434525A1 (de) 1994-09-27 1996-03-28 Siemens Ag Regelung für den relativen Gleichlauf von mechanisch gekoppelten Werkzeugmaschinenachsen
DE10156781C1 (de) 2001-11-19 2003-02-27 Siemens Ag Aktive Kompensation von mechanischen Schwingungen und Verformungen in industriellen Bearbeitungsmaschinen
JP4361071B2 (ja) * 2005-07-08 2009-11-11 ファナック株式会社 サーボ制御装置
KR20120089775A (ko) 2008-04-15 2012-08-13 파나소닉 주식회사 모터 장치, 및 그들을 구비한 모터 구동 시스템 및 집적 회로 장치
DE102008044341A1 (de) 2008-12-04 2010-06-10 Dr. Johannes Heidenhain Gmbh Reglerstruktur für mehrere mechanisch gekoppelte Antriebseinheiten
WO2011155015A1 (ja) * 2010-06-07 2011-12-15 トヨタ自動車株式会社 ハイブリッド車両およびその制御方法

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH10326107A (ja) * 1997-03-25 1998-12-08 Mitsubishi Electric Corp サーボ制御方法およびサーボ制御システム
JP3492583B2 (ja) * 2000-03-27 2004-02-03 ファナック株式会社 サーボ制御装置
JP2005176493A (ja) * 2003-12-11 2005-06-30 Yaskawa Electric Corp モータ駆動装置の非常停止方法
JP2008022638A (ja) * 2006-07-13 2008-01-31 Seiko Epson Corp 複数の電動モータを用いた駆動システム及びその制御方法
JP2008043046A (ja) * 2006-08-07 2008-02-21 Aida Eng Ltd サーボモータの制御方法
JP2010088188A (ja) * 2008-09-30 2010-04-15 Sanyo Electric Co Ltd モータ制御回路

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2014155290A (ja) * 2013-02-07 2014-08-25 Sanken Electric Co Ltd 永久磁石同期電動機の制御装置
JP2014214959A (ja) * 2013-04-25 2014-11-17 パナソニック株式会社 断熱箱体
JP5642848B1 (ja) * 2013-07-19 2014-12-17 ファナック株式会社 一つの被駆動体を駆動するために二つのモータを制御するモータ制御装置
US9164495B2 (en) 2013-07-19 2015-10-20 Fanuc Corporation Motor controller controlling two motors for driving single driven object
JP2017060327A (ja) * 2015-09-17 2017-03-23 山洋電気株式会社 モータ制御装置
TWI730000B (zh) * 2015-09-17 2021-06-11 日商山洋電氣股份有限公司 馬達控制裝置

Also Published As

Publication number Publication date
CN102904495B (zh) 2014-07-16
CN102904495A (zh) 2013-01-30
US8680805B2 (en) 2014-03-25
JP5192571B2 (ja) 2013-05-08
DE102012014324A1 (de) 2013-01-31
US20130026964A1 (en) 2013-01-31

Similar Documents

Publication Publication Date Title
JP5192571B2 (ja) 一つの被駆動体を二つの電動機で駆動させる制御装置
JP5863860B2 (ja) 加工時の軸間の干渉を低減するサーボ制御装置
US8093856B2 (en) Position control apparatus for numerically controlled machine
JP5340423B2 (ja) モータ制御装置
JP6653542B2 (ja) モータ制御装置
KR940003005B1 (ko) 동기형 교류 서보모터의 속도제어방법
JP5947075B2 (ja) 同期モータの制御装置、同期モータの制御方法
JP5389251B2 (ja) 並列駆動システム
JP5739400B2 (ja) 被駆動体の位置補正機能を有するサーボ制御装置
JP2000250614A (ja) バックラッシ補正装置および数値制御システム
JPWO2008041598A1 (ja) サーボ制御装置
US9876448B2 (en) Position control apparatus
JP6392805B2 (ja) 複数モータ駆動用サーボ制御装置
JP4867105B2 (ja) 数値制御装置
JP2016051398A (ja) 軸間干渉を補正するモータ制御装置
JP4226420B2 (ja) 位置制御装置
JP4258262B2 (ja) ツイン同期制御方法及び装置
JP2015143969A (ja) 工作機械制御装置、工作機械制御方法、及びプログラム
JP4134599B2 (ja) 同期制御装置
US10613509B2 (en) Controller for a drive mechanism driven by a plurality of motors
JP2004086434A (ja) 速度指令型同期制御装置
JP6391489B2 (ja) モータ制御装置
JP2004310261A (ja) モータ制御装置
JP5616262B2 (ja) 数値制御工作機械
JP2016068171A (ja) ロボットの制御装置および制御方法

Legal Events

Date Code Title Description
A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20121116

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: 20130108

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20130131

R150 Certificate of patent or registration of utility model

Ref document number: 5192571

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

Free format text: JAPANESE INTERMEDIATE CODE: R150

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20160208

Year of fee payment: 3