Top > Search of Japanese Patents > ACTUATOR CONTROLLER AND ACTUATOR CONTROL METHOD

ACTUATOR CONTROLLER AND ACTUATOR CONTROL METHOD commons

Patent code P110005583
File No. 6073
Posted date Aug 18, 2011
Application number P2007-053861
Publication number P2008-217410A
Patent number P5002814
Date of filing Mar 5, 2007
Date of publication of application Sep 18, 2008
Date of registration Jun 1, 2012
Inventor
  • (In Japanese)大石 潔
  • (In Japanese)桂 誠一郎
  • (In Japanese)加藤 将
Applicant
  • (In Japanese)国立大学法人長岡技術科学大学
Title ACTUATOR CONTROLLER AND ACTUATOR CONTROL METHOD commons
Abstract PROBLEM TO BE SOLVED: To cooperatively control actuators while control tracking between respective axes without any delay with respect to an instruction value based on a robust acceleration control system when an actuator is saturated.
SOLUTION: This actuator controller is provided with an acceleration control system 1 applying robust acceleration control to actuators 2, a tracking control system 20 controlling tracking of the actuators 2, a torque current limiter 95 regulating an acceleration instruction current IFFi of a feedfoward component for restricting a current reference value Iref to the actuator 2 to be a previously set maximum current value IMAX or less, and a delay regulation means 86 correcting an acceleration/deceleration torque current IFBi of a feedback component and the acceleration instruction current IFFi of the feedforward component according to a position instruction regulation rate γ(n+1)i for cooperatively controlling the actuators 2 between the respective axes.
Outline of related art and contending technology (In Japanese)


近年、産業界における各種工作機械や半導体製造装置、またはロボット等の位置決め制御に代表されるモーションコントロール装置では、生産性向上を目的とした高速で高精度な制御が求められている。さらに、システム全体の低コスト化の要求から、こうした位置決め機構に、ワット数の小さなACサーボモータと安価なボールねじを用いた送り駆動系のアクチュエータが多く使用されている。従来のシステムでは、特にモータの始動時と制動時にモータがトルク飽和を引き起こすため、複数のアクチュエータにより各軸で被制御物を動作させるシステムにおいては、各軸間の被制御物を協調して動作させることができずに、目標となる軌跡追従ができないという問題がある。そのため、こうした問題を解決するべく、所望の制御特性を満足するためのトルク飽和対策技術が多く行なわれてきた。



図16は、こうした対策を施したサーボ系のシステム構成の一例を示したものである。ここでは、制御対象となるサーボモータ501が、制御装置502から与えられる電流値Iによって駆動される。制御装置502は、減算器503~505と、位置コントローラ506と、速度コントローラ507と、電流コントローラ508と、電流リミッタ509とからなり、サーボモータ501への電流値Iを監視する局部的な電流制御ループ511の外側に、サーボモータ501の位置θmを監視する位置制御ループ513と、サーボモータ501の応答速度(角速度)ωmを監視する速度制御ループ512とを各々備えて構成される。



そして、ここでの制御装置502は、サーボモータ501の実際の位置θmと、目標となる位置参照値θrefとの位置偏差を減算器503で算出して、この位置偏差を位置コントローラ506で速度参照値ωrefに変換する。速度参照値ωrefとサーボモータ501の実際の応答速度ωmとの偏差は、位置コントローラ506の後段に接続した減算器504で算出され、速度コントローラ507で電流参照値Irefに変換される。さらに、この電流参照値Irefと、サーボモータ501に与えられる実際の電流値Iとの偏差が、後述する電流リミッタ509の後段に接続した減算器505で算出され、これがサーボモータ501への制御信号すなわち電流値Iとして電流コントローラ508から出力される。これによって、サーボモータ501の実際の位置θmが、制御装置502に与えられる位置参照値θrefに追従するように、サーボモータ501への制御が行なわれる。



また、この一連の制御で、速度コントローラ507で変換された電流参照値Irefが一定の範囲を超えないように、この速度コントローラ507と減算器505との間には電流リミッタ509が接続される。これにより、サーボモータ501がトルク飽和を起こしそうな電流参照値Irefが速度コントローラ507から出力された場合でも、電流リミッタ509によってサーボモータ501への電流値Iは一定の範囲内に抑制され、サーボモータ501のトルク飽和を防ぐことができる。



そして、こうしたトルク飽和対策技術は、上記図16に示す例だけでなく、例えば特許文献1などにも開示されている。



一方、本願出願人などは、モータを代表とするアクチュエータを加速度指令で駆動させる加速度制御系(加速度コントローラ)を実現し、これによる高速高性能のサーボ制御系の実装を提案してきた。加速度制御系は高速な制御を可能にするが、その反面、モータへの操作量の電流指令や電圧指令が制限される(飽和する)ことがよくある。そのため、従来の特許文献1や上記図16に提示されるような手法は、全て位置サーボや速度サーボを前提とした技術であるため、動的な遅れが生じたり、トルク指令の向きが変わるなどして、加速度制御系に対する対策としては不十分なものであった。
【特許文献1】
特開平7-62052号公報

Field of industrial application (In Japanese)


本発明は、トルク飽和などの発生時にも、各軸で被制御物を遅れなく軌跡追従制御させることができるアクチュエータ制御装置およびアクチュエータ制御方法に関する。

Scope of claims (In Japanese)
【請求項1】
 
各軸に可動する複数のアクチュエータの動作を個々に制御するアクチュエータ制御装置であって、
前記アクチュエータへの外乱を推定する外乱オブザーバを備え、この外乱オブザーバで得た外乱推定値を外乱補償電流に変換し、前記外乱補償電流でフィードバック補償した前記アクチュエータへの電流参照値により、当該アクチュエータをロバスト加速度制御する加速度制御部と、
前記アクチュエータを軌跡追従制御させるために、フィードバック成分の電流参照値とフィードフォワード成分の電流参照値を算出する軌跡追従制御部と、
前記フィードバック成分の電流参照値,前記フィードフォワード成分の電流参照値,および前記外乱補償電流を合計した前記アクチュエータへの電流参照値を、予め設定した最大電流値以下に制限するために、
何れか一つの軸で前記アクチュエータへの電流参照値が前記最大電流値を越えて電流飽和を起こすと、全ての軸で位置指令の調整率をそれぞれ算出し、この軸毎の調整率の中から前記電流飽和の許容分が一番大きな軸に対応した最小値の調整率を用いて、軸毎に前記フィードフォワード成分の電流参照値を調整する電流リミッタと、
前記電流リミッタから与えられる前記最小値の調整率から、前記フィードバック成分の電流参照値および前記フィードフォワード成分の電流参照値を修正する調整部と、をそれぞれ備え
前記i軸目のフィードバック成分の電流参照値をIFBi,前記i軸目のフィードフォワード成分の電流参照値をIFFi,前記i軸目の外乱補償電流をIRBi,前記i軸目のアクチュエータへの電流参照値をIiref,前記最大電流値に相当し、前記アクチュエータを構成するモータの最大トルク電流をIMAXとしたときに、
前記各軸の電流リミッタは、前記i軸目のアクチュエータへの電流参照値Iirefの絶対値が最大トルク電流IMAXを越えていれば、前記ロバスト制御を維持するための前記i軸目の現サンプルnの最大加減速トルク電流IaccMAX(n)iを次の式で算出し、
【数1】
 


次の式からi軸目の最大加速度θ・・max(n)iを算出して(但し、Ktはトルク定数,Jniはi軸目の慣性モーメントのノミナル値)、
【数2】
 


前記位置指令の前記調整率γ(n+1)iを次の式で算出し(但し、Tsは現サンプルから次のサンプルまでのサンプリング時間,θ・res(n)iはi軸目の現サンプルにおける速度応答値,θcmd(n+1)iはi軸目の次のサンプルにおける位置指令値,θcmd(n)iはi軸目の現サンプルにおける位置指令値)、
【数3】
 


前記i軸目のアクチュエータへの電流参照値Iirefの絶対値が最大トルク電流IMAX未満である場合は、前記位置指令の前記調整率γ(n+1)iを1にするものであることを特徴とするアクチュエータ制御装置。

【請求項2】
 
前記外乱オブザーバの極を無限大にしたことを特徴とする請求項1記載のアクチュエータ制御装置。

【請求項3】
 
記各軸の電流リミッタは、全ての軸で前記位置指令の前記調整率γ(n+1)iを算出すると、各軸iの前記調整率γ(n+1)iの中から最小値γ(n+1)minを抽出して、
前記フィードフォワード成分の電流参照値を調整した値IFFi(n)を、次の式から算出する(但し、Ktnはトルク定数のノミナル値,fi(t)はi軸目の位置指令値の時間関数,θires(n)はi軸目の現サンプルにおける速度応答値,θcmdi(n)はi軸目の現サンプルにおける位置指令値)
【数4】
 


ことを特徴とする請求項1記載のアクチュエータ制御装置。

【請求項4】
 
前記各軸の調整部は、次の式から前記位置指令の調整率γ(n+1)に基づく次サンプルでの修正時間t(n+1)を算出し(但し、t(n)は現時間)、
【数5】
 


この修正時間に基づき、前記フィードバック成分の電流参照値および前記フィードフォワード成分の電流参照値を修正するものであることを特徴とする請求項3記載のアクチュエータ制御装置。

【請求項5】
 
各軸に可動する複数のアクチュエータの動作を個々に制御するアクチュエータ制御方法であって、
前記アクチュエータへの外乱を推定する外乱オブザーバを備え、この外乱オブザーバで得た外乱推定値を外乱補償電流に変換し、前記外乱補償電流でフィードバック補償した前記アクチュエータへの電流参照値により、当該アクチュエータをロバスト加速度制御する加速度制御ステップと、
前記アクチュエータを軌跡追従制御させるために、フィードバック成分の電流参照値とフィードフォワード成分の電流参照値を算出する軌跡追従ステップと、
前記フィードバック成分の電流参照値,前記フィードフォワード成分の電流参照値,および前記外乱補償電流を合計した前記アクチュエータへの電流参照値を、予め設定した最大電流値以下に制限するために、何れか一つの軸で前記アクチュエータへの電流参照値が前記最大電流値を越えて電流飽和を起こすと、全ての軸で位置指令の調整率をそれぞれ算出し、この軸毎の調整率の中から前記電流飽和の許容分が一番大きな軸に対応した最小値の調整率を用いて、軸毎に前記フィードフォワード成分の電流参照値を調整する電流制限ステップと、
前記電流制限ステップから与えられる前記最小値の調整率から、前記フィードバック成分の電流参照値および前記フィードフォワード成分の電流参照値を修正する調整ステップと、からなり、
前記i軸目のフィードバック成分の電流参照値をIFBi,前記i軸目のフィードフォワード成分の電流参照値をIFFi,前記i軸目の外乱補償電流をIRBi,前記i軸目のアクチュエータへの電流参照値をIiref,前記最大電流値に相当し、前記アクチュエータを構成するモータの最大トルク電流をIMAXとしたときに、
前記電流制限ステップは、軸毎に前記i軸目のアクチュエータへの電流参照値Iirefの絶対値が最大トルク電流IMAXを越えていれば、前記ロバスト制御を維持するための前記i軸目の現サンプルnの最大加減速トルク電流IaccMAX(n)iを次の式で算出し、
【数6】
 


次の式からi軸目の最大加速度θ・・max(n)iを算出して(但し、Ktはトルク定数,Jniはi軸目の慣性モーメントのノミナル値)、
【数7】
 


前記位置指令の前記調整率γ(n+1)iを次の式で算出し(但し、Tsは現サンプルから次のサンプルまでのサンプリング時間,θ・res(n)iはi軸目の現サンプルにおける速度応答値,θcmd(n+1)iはi軸目の次のサンプルにおける位置指令値,θcmd(n)iはi軸目の現サンプルにおける位置指令値)、
【数8】
 


前記i軸目のアクチュエータへの電流参照値Iirefの絶対値が最大トルク電流IMAX未満である場合は、前記位置指令の前記調整率γ(n+1)iを1にすることを特徴とするアクチュエータ制御方法。

【請求項6】
 
前記外乱オブザーバの極を無限大にしたことを特徴とする請求項5記載のアクチュエータ制御方法。

【請求項7】
 
記電流制限ステップは、全ての軸で前記位置指令の前記調整率γ(n+1)iを算出すると、各軸iの前記調整率γ(n+1)iの中から最小値γ(n+1)minを抽出して、
前記フィードフォワード成分の電流参照値を調整した値IFFi(n)を、次の式から算出する(但し、Ktnはトルク定数のノミナル値,fi(t)はi軸目の位置指令値の時間関数,θires(n)はi軸目の現サンプルにおける速度応答値,θcmdi(n)はi軸目の現サンプルにおける位置指令値)
【数9】
 


ことを特徴とする請求項5記載のアクチュエータ制御方法。

【請求項8】
 
前記調整ステップは、次の式から前記位置指令の調整率γ(n+1)に基づく次サンプルでの修正時間t(n+1)を算出し(但し、t(n)は現時間)、
【数10】
 


この修正時間に基づき、前記フィードバック成分の電流参照値および前記フィードフォワード成分の電流参照値を修正することを特徴とする請求項7記載のアクチュエータ制御方法。
IPC(International Patent Classification)
F-term
Drawing

※Click image to enlarge.

JP2007053861thum.jpg
State of application right Registered
(In Japanese)上記の特許・技術に関心のある方は、下記問い合わせ先にご相談下さい。


PAGE TOP

close
close
close
close
close
close
close