JP2005227858A - 駆動機構設計支援装置と駆動機構設計支援方法及び記憶媒体 - Google Patents
駆動機構設計支援装置と駆動機構設計支援方法及び記憶媒体 Download PDFInfo
- Publication number
- JP2005227858A JP2005227858A JP2004033583A JP2004033583A JP2005227858A JP 2005227858 A JP2005227858 A JP 2005227858A JP 2004033583 A JP2004033583 A JP 2004033583A JP 2004033583 A JP2004033583 A JP 2004033583A JP 2005227858 A JP2005227858 A JP 2005227858A
- Authority
- JP
- Japan
- Prior art keywords
- model
- drive mechanism
- actuator
- actuator circuit
- virtual
- 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.)
- Pending
Links
Images
Abstract
【課題】慣性要素と粘性要素及び弾性要素の全ての影響を含めた動作をシミュレーションして駆動機構の評価を正確に行う。
【解決手段】制御装置103と連動する仮想機構モデルの動作計算を開始すると、制御装置103の駆動制御部108は、目標値に対する制御量を制御プログラム109により算出する。駆動制御部108は算出した制御量に基づく制御信号である印加電圧をシミュレーション装置102に出力する。シミュレーション装置102のシミュレーション実行部107は、入力した印加電圧とアクチュエータ回路部105で得たアクチュエータ回路モデルに基づいてアクチュエータ回路モデルの電流を所定時間間隔毎に算出し、駆動機構モデル部106で得た仮想機構モデルの算出した電流に応じた挙動を算出して解析する。
【選択図】 図2
【解決手段】制御装置103と連動する仮想機構モデルの動作計算を開始すると、制御装置103の駆動制御部108は、目標値に対する制御量を制御プログラム109により算出する。駆動制御部108は算出した制御量に基づく制御信号である印加電圧をシミュレーション装置102に出力する。シミュレーション装置102のシミュレーション実行部107は、入力した印加電圧とアクチュエータ回路部105で得たアクチュエータ回路モデルに基づいてアクチュエータ回路モデルの電流を所定時間間隔毎に算出し、駆動機構モデル部106で得た仮想機構モデルの算出した電流に応じた挙動を算出して解析する。
【選択図】 図2
Description
この発明は、慣性要素や粘性要素及び弾性要素等の各種駆動機構を仮想機構モデル上で構築して動作させてシミュレーションする駆動機構設計支援装置と駆動機構設計支援方法及び記憶媒体に関するものである。
各種駆動機構を開発するとき、試作した実機による駆動機構の設計評価は作業負担や時間とコストが大きいため、シミュレーションモデルによる設計評価が広まっている。しかし、駆動機構の実機による評価とシミュレーションモデルによる評価では入力が異なり、実機による評価において入力は制御装置からの制御信号であるのに対して、シミュレーションモデルによる評価では、入力として実験データからのプロファイルを用いている。このように入力が異なると出力も異なるため、実機と比較して機能の再現性が高い駆動機構のシミュレーションモデルを利用しても、不正確な評価になる可能性がある。従来、これを防ぐためには、制御装置と駆動機構ともども実機で評価せざるを得なかった。
この実機とシミュレーションモデルの入力を同一にして正確な設計評価を行う方法として、制御装置と連動するシミュレーションモデルを利用することが考えられる。すなわち、、制御装置を含めた全体システムの中にある駆動機構をシミュレーション評価する。そのためには制御系と駆動系を相互作用させた連成解析が必要である。しかし、制御系をシミュレーションモデル上で構成するためには、制御アルゴリズムの知識と技術が必要である。これは、機械系が専門技術である駆動機構の設計者にとっては大きな負担となる。また、制御装置には駆動回路(ドライバ)のように、電子系の技術もあり、実装の知識と技術も兼ね備えないとシミュレーション上で連成解析をするのは困難である。
このような問題を解決する有効な方法は、実際の制御装置と仮想の駆動機構を連動させて、駆動機構の設計評価をする方法である。このような技術が実現されると、制御系のシミュレーション技術を必要とすることなく、制御装置を含めた全体システム中の駆動機構を設計評価できる。また、実際の制御装置と連動させることで、制御装置の不安定性や雑音による制御信号の乱れに対しても、駆動系の動作を評価可能になる等の利点が得られる。
このように実際の制御装置と仮想の駆動機構を連動させて、駆動機構の設計評価をする方法が特許文献1に開示されている。特許文献1に示されたシミュレーションシステムは、制御プログラムを実行して機構機構を制御するソフトウエア実行装置と、機構機構の仮想機構モデルを構築し、ソフトウエア実行装置からの入力データに応じたシミュレーション計算により仮想機構モデルを動作させて、駆動機構の動作をリアルタイムで解析するようにしている。そして駆動機構の動作を解析するため、駆動機構の全ての慣性要素、例えば駆動軸と複数のギアのような一連の従動関節の慣性をエネルギ保存側を用いて駆動関節となる駆動軸から見たときの値である等価慣性に変換し、駆動関節と一連の従動関節全ての摩擦を減速比を用いて駆動関節から見た等価摩擦に変換し、この等価慣性と等価摩擦の影響を受けた駆動機構のシミュレーション動作で設計の評価をしている。
しかし、一般に駆動機構を構成する物体の運動は、慣性要素と粘性要素及び弾性要素の3要素によって構成するのが望ましく、弾性要素の影響を含めた動作をシミュレーションして駆動の振動を評価する必要があるが、特許文献1に示されたシミュレーションシステムでは駆動の振動を評価できず、駆動機構の評価を正確に行えないという短所があった。
特開2003−30251号公報
この発明はかかる問題を解消し、慣性要素と粘性要素及び弾性要素の全ての影響を含めた動作をシミュレーションして駆動機構の評価を正確に行うことができる駆動機構設計支援装置と駆動機構設計支援方法及び記憶媒体を提供することを目的とするものである。
この発明の駆動機構設計支援装置は、入力装置とシミュレーション装置と制御装置及び出力装置を有し、前記入力装置は、解析する駆動機構のアクチュエータや駆動機構を構成する慣性要素と粘性要素及び弾性要素のパラメータ情報を前記シミュレーション装置に入力し、前記シミュレーション装置は、アクチュエータ回路部と駆動機構モデル部及びシミュレーション実行部を有し、前記アクチュエータ回路部は、前記入力装置から入力するアクチュエータのパラメータ情報により、前記駆動機構のアクチュエータの挙動を解析するアクチュエータ回路モデルを形成し、前記駆動機構モデル部は、前記入力装置から入力する駆動機構を構成する慣性要素と粘性要素及び弾性要素により仮想機構モデルを形成し、前記シミュレーション実行部は、前記アクチュエータ回路部で形成したアクチュエータ回路モデルと前記駆動機構モデル部で形成した仮想機構モデルに基づいて、前記制御装置から入力する制御信号に応じた仮想機構モデルの挙動を所定の微小時間間隔毎に解析し、解析した結果をセンサ信号に変換して制御装置に送り、前記制御装置は、駆動制御部と制御プログラムを有し、前記駆動制御部は前記シミュレーション装置から送られたセンサ信号に応じた制御量と前記制御プログラムにより制御信号を生成し、前記出力装置は、前記シミュレーション装置に入力する制御信号と前記シミュレーション実行部で解析した仮想機構モデルの挙動を示す状態量及びセンサ信号を出力することを特徴とする。
前記シミュレーション実行部は、前記制御装置から制御信号として入力する印加電圧と前記アクチュエータ回路モデルに基づいてアクチュエータ回路モデルの電流を所定時間間隔毎に算出し、算出した電流に応じた前記仮想機構モデルの挙動を解析する。
また、前記シミュレーション実行部は、前記アクチュエータ回路モデルの変化に応じてアクチュエータ回路モデルの抵抗要素と誘導要素及び逆起電力定数の特性値を変更し、変更した特性値に応じて前記仮想機構モデルの挙動を微小時間間隔ごとに解析する。
さらに、前記シミュレーション実行部は、算出したアクチュエータ回路モデルの電流と前記仮想機構モデルに基づいてアクチュエータの瞬間速度と瞬間位置を決定する。
また、前記シミュレーション実行部は、算出したアクチュエータ回路モデルの電流と前記仮想機構モデルを構成する部品間の等価慣性と等価負荷、減速比、減衰定数及び剛性定数に基づいて前記仮想機構モデルの挙動を解析する。
この発明の駆動機構設計支援方法は、解析する駆動機構のアクチュエータのパラメータ情報により、前記駆動機構のアクチュエータの挙動を解析するアクチュエータ回路モデルを形成し、駆動機構を構成する慣性要素と粘性要素及び弾性要素により仮想機構モデルを形成し、形成したアクチュエータ回路モデルと仮想機構モデルに基づいて、制御装置から入力する制御信号に応じた仮想機構モデルの挙動を所定の微小時間間隔毎に解析し、解析した結果を出力するとともに前記制御装置にフィードバックすることを特徴とする。
この駆動機構設計支援方法は、制御装置から制御信号として入力する印加電圧と前記アクチュエータ回路モデルに基づいてアクチュエータ回路モデルの電流を所定時間間隔毎に算出し、算出した電流に応じた仮想機構モデルの挙動を解析したり、アクチュエータ回路モデルの変化に応じてアクチュエータ回路モデルの抵抗要素と誘導要素及び逆起電力定数の特性値を変更し、変更した特性値に応じて仮想機構モデルの挙動を微小時間間隔ごとに解析したり、アクチュエータ回路モデルの電流と仮想機構モデルに基づいてアクチュエータの瞬間速度と瞬間位置を決定したり、あるいはアクチュエータ回路モデルの電流と仮想機構モデルを構成する部品間の等価慣性と等価負荷、減速比、減衰定数及び剛性定数に基づいて前記仮想機構モデルの挙動を解析する。
この発明の記憶媒体は、前記駆動機構設計支援方法のプログラムを格納し、コンピュータで読み取り可能なことを特徴とする。
この発明は、解析する駆動機構のアクチュエータのパラメータ情報により、駆動機構のアクチュエータ回路モデルを形成し、駆動機構を構成する慣性要素と粘性要素及び弾性要素により仮想機構モデルを形成し、形成したアクチュエータ回路モデルと仮想機構モデルに基づいて、制御装置から入力する制御信号に応じた仮想機構モデルの挙動を所定の微小時間間隔毎に解析するから、制御装置と連動した駆動機構の評価を正確に行うことができる。
また、制御装置から制御信号として入力する印加電圧とアクチュエータ回路モデルに基づいてアクチュエータ回路モデルの電流を所定時間間隔毎に算出し、算出した電流に応じた仮想機構モデルの挙動を解析することにより、内部の電圧降下を補償する電流制御を備えた制御装置を含む全体システム内の駆動機構の動作を評価することができる。
さらに、アクチュエータの変化に応じたアクチュエータ回路の抵抗やインダクタンス要素等の特性値の変更を可能にして、アクチュエータの変化に応じた駆動機構の挙動を所定の微小時間間隔ごとに解析することにより、制御装置を含む全体システム内の駆動機構の動作に対して回路変化が寄与する程度を評価することができる。
また、アクチュエータ回路電流に応じたアクチュエータの瞬間速度と瞬間位置を解析することにより、速度制御と位置制御を備えた制御装置を含む全体システム内の駆動機構の動作を評価することができる。
また、駆動機構内の連結する部品同士の等価慣性や等価負荷、減速比、減衰定数、剛性定数の変更に応じた駆動機構の挙動を解析することにより、駆動機構の動作に対して慣性要素と粘性要素と弾性要素が寄与する程度を評価することができる。
図1はこの発明の駆動機構設計支援装置の構成を示すブロック図である。図に示す駆動機構設計支援装置100はコンピュータによって構成され、入力装置101とシミュレーション装置102と制御装置103及び出力装置104を有する。入力装置101は、解析する駆動機構のアクチュエータや駆動機構を構成する慣性要素と粘性要素及び弾性要素のパラメータ情報をシミュレーション装置102に入力する。シミュレーション装置102は、アクチュエータ回路部105と駆動機構モデル部106及びシミュレーション実行部107を有する。アクチュエータ回路部105は、入力装置101から入力するアクチュエータのパラメータ情報により、解析する駆動機構のアクチュエータの挙動を解析するアクチュエータ回路モデルを得る。駆動機構モデル部106は、入力装置101から入力する駆動機構を構成する慣性要素と粘性要素及び弾性要素により、駆動機構の挙動を解析する仮想機構モデルを得る。シミュレーション実行部107は、CPUやROMやRAMを有し、アクチュエータ回路部105で得たアクチュエータ回路モデルと駆動機構モデル部106で得た仮想機構モデルの挙動を解析する。このシミュレーション実行部107でアクチュエータ回路モデルと仮想機構モデルを解析するとき、アクチュエータ回路モデルと仮想機構モデルに基づいて、制御装置103からの制御信号である印加電圧に応じた仮想機構モデルの挙動を所定の微小時間間隔毎に計算して、センシング時間間隔ごとに制御装置102にセンサ信号を送る。制御装置103は、駆動制御部108と制御プログラム109を有し、駆動制御部108は送られたセンサ信号に応じた制御量を制御プログラム109により計算して制御信号をシミュレーション装置102に送る。出力装置104は、制御信号やセンサ信号あるいは仮想機構モデルの状態量を出力する。
この駆動機構設計支援装置100で駆動機構モデル部106で得た仮想機構モデルが制御装置108と連動して動作をするときの解析処理を、図2のフローチャートを参照して説明する。
制御装置103と連動する仮想機構モデルの動作計算を開始すると、制御装置103の駆動制御部108は、目標値に対する制御量を制御プログラム109により算出する(ステップS1)。駆動制御部108は算出した制御量に基づく制御信号である印加電圧をシミュレーション装置102に出力する(ステップS2)。シミュレーション装置102のシミュレーション実行部107は、駆動制御部108から制御信号である印加電圧を入力すると(ステップS11)、入力した印加電圧とアクチュエータ回路部105で得たアクチュエータ回路モデルに基づいてアクチュエータ回路モデルの電流を所定時間間隔毎に算出し(ステップS12)、駆動機構モデル部106で得た仮想機構モデルの算出した電流に応じた挙動を算出して解析する(ステップS13)。
この仮想機構モデルの挙動を解析するとき、アクチュエータ印加電圧に応じたアクチュエータの瞬間電流を解析したり、アクチュエータの変化に応じたアクチュエータ回路の抵抗やインダクタンス要素等の特性値の変更を可能にして、アクチュエータの変化に応じた仮想機構モデルの挙動を所定の微小時間間隔ごとに解析したり、あるいはアクチュエータ回路電流に応じたアクチュエータの瞬間速度と瞬間位置を解析したり、仮想機構モデル内の連結する部品同士の等価慣性や等価負荷、減速比、減衰定数、剛性定数の変更に応じた駆動機構の挙動を解析する。
そしてシミュレーション実行部107は、算出した仮想駆動モデルの挙動をセンサ信号に換算して制御装置103に出力する(ステップS14)。制御装置103の駆動制御部108は、センサ信号を入力すると(ステップS3)、入力したセンサ信号を制御プログラム109へフィードバックする(ステップS4、S1)6)。この一連の解析処理を仮想駆動モデルの全ての挙動に対して繰り返す(ステップS4,S1〜S3,S15,S11〜S14)。このようにして制御装置を含めた全体システム中の駆動機構の動作を評価することができる。
また、アクチュエータ印加電圧に応じたアクチュエータの瞬間電流を解析することにより、モータ内部の電圧降下を補償する電流制御を備えた制御装置を含む全体システム内の駆動機構の動作を評価することができる。
さらに、アクチュエータの変化に応じたアクチュエータ回路の抵抗やインダクタンス要素等の特性値の変更を可能にして、アクチュエータの変化に応じた駆動機構の挙動を所定の微小時間間隔ごとに解析することにより、制御装置を含む全体システム内の駆動機構の動作に対して回路変化が寄与する程度を評価できる。
また、アクチュエータ回路電流に応じたアクチュエータの瞬間速度と瞬間位置を解析することにより、速度制御と位置制御を備えた制御装置を含む全体システム内の駆動機構の動作を評価することができる。
また、駆動機構内の連結する部品同士の等価慣性や等価負荷、減速比、減衰定数、剛性定数の変更に応じた駆動機構の挙動を解析することにより、駆動機構の動作に対して慣性要素と粘性要素と弾性要素が寄与する程度を評価することができる。
この駆動機構設計支援装置100で例えば画像読取装置のモータ印加電圧に応じた第1キャリッジ速度変動を解析して設計を支援する方法について説明する。
画像読取装置の機械構造は図3の構成図に示すように、DCモータ1の回転をタイミングベルト15を介してシャフト16に固定された減速プーリ2に伝達して減速プーリ2を回転する。このシャフト16には減速プーリ2とワイヤプーリ3,14が固定され、減速プーリ2の回転によりワイヤプーリ3,14は回転する。このワイヤプーリ3にはワイヤ17が掛け回され、ワイヤプーリ14にはワイヤ18が掛け回されている。ワイヤ17とワイヤ18は第1キャリッジ9に固定され、両端をこせぞれ固定部17a,17bと固定部18a、18bに固定されている。ワイヤ17の張力はプーリ4とプーリ5によって、その力方向が変えられ、ワイヤ18の張力はプーリ11とプーリ12によって、その力方向が変えられ、第1キャリッジ9を引いて動かす。第2キャリッジ10には両端に回転軸が設けられ、回転軸にはプーリ7,8,19,20が固定されている。このプーリ7,8,19,20は巻き回したワイヤ17,18の張力によって回転と移動をして、第2キャリッジ10を移動する。
この画像読取装置の駆動機構を評価する項目として、第1キャリッジ9の副走査方向の速度変動がある。副走査方向の速度変動が大きいと、読み取った画像の画質が低下する。そのため画像読取装置の駆動機構の設計では速度変動を抑えるように設計する。その設計評価を駆動機構設計支援装置100でシミュレーションで行うときの解析処理を図4のフローチャートを参照して説明する。
まず、駆動機構設計支援装置100の入力装置101でアクチュエータや駆動機構を構成する慣性要素と粘性要素及び弾性要素のパラメータ情報をシミュレーション装置102に入力して、シミュレーション装置102のアクチュエータ回路部105にアクチュエータ回路モデルを得て、駆動機構モデル部106に仮想機構モデルを得る。この仮想機構モデルを得るとき、第1キャリッジ9の副走査方向の速度変動を評価する場合は、図3に示す画像読取装置の駆動機構を図5に示すように、DCモータ1と減速プーリ2とワイヤプーリ3とプーリ4,5,6と第1キャリッジ9及び第2キャリッジ10でモデル化して仮想機構モデルとする。すなわち、第1キャリッジ9の副走査方向のみの機構に着目することにより、解析するときの計算量の低減を図る。しかし、制御装置と実時間で連動するためには、この図5に示す駆動機構でも計算時間の大きいモデルである。そこで、駆動機構の構成要素を減らすことで、実時間で計算できるようにする。ここでは、駆動機構の中でも低い固有振動数成分による振動を評価することを目的として絞ることで構成要素を減らす。この駆動機構の中では、タイミングベルト15に起因する固有振動数が低いので、タイミングベルト15を介してDCモータ1の駆動トルクを減速プーリ2に伝える2慣性系でモデル化する。
この状態で仮想機構モデルの解析処理を開始すると、制御装置103の駆動制御部108は、画像読取装置の仮想機構モデルにスキャン動作を行わせるために、DCモータ1を回転させる命令を出す。このDCモータ1を回転するとき、あらかじめ格納した制御プログラム109に設定された制御プロファイルと仮想機構モデルにおける現在のDCモータ1の回転角度から、モータ回転角速度の目標値を決定し(ステップS21)、決定した目標値と現在のDCモータ1の回転角速度を比較して、DCモータ1に印加する電圧値を算出する(ステップS22)。駆動制御部108は算出した電圧値を基にしたPWM(パルス幅変調)信号をシミュレーション装置102に出力する(ステップS23)。このとき、出力されたPWM信号を必要に応じて加工しても良い。具体的には、シミュレーション装置102を壊さないために電圧を減幅したり、計算負荷を低減させるためにローパスフィルタを通したりする。
シミュレーション装置102のシミュレーション実行部107は、制御装置103からPWM信号を入力すると、入力したPWM信号の電圧測定値をデジタル情報に変換してモータ印加電圧の値とする(ステップS31)。次に、シミュレーション実行部107は、印加電圧の応じてモータ回路に流れる電流iを算出する(ステップS32)。このモータ回路に流れる電流iは、一般のモータの回路方程式である下記(1)式を解くことにより求めることができる。
(1)式において、Lはモータ回路のインダクタンス(H)、Rはモータ回路の抵抗(Ω)、Keは逆起電力定数{V/(rad/s)}、Vはモータ回路を流れる電流(A)、ωはモータの回転角速度(rad/s)である。
また、インダクタンスLの値が抵抗Rと比較して小さい場合には、インダクタンスLを(1)式から削除した下記(2)式を解いても良い。
R1+Keω=V (2)
また、電流値をモータ回路に送って電流制御を行う場合があるが、その場合は、モータ回路の電流値をフィードバックする。
R1+Keω=V (2)
また、電流値をモータ回路に送って電流制御を行う場合があるが、その場合は、モータ回路の電流値をフィードバックする。
シミュレーション実行部107は算出したモータ回路の電流から第1キャリッジ9の速度を求め処理に入る。この第1キャリッジ9の速度を求めとき、前記タイミングベルト15を介してDCモータ1の駆動トルクを減速プーリ2に伝える2慣性系でモデル化した仮想機構モデルで、タイミングベルト15に接するDCモータ1を駆動軸、減速プーリ2を従動軸と考え、算出したモータ回路の電流により駆動軸と従動軸の回転角速度を算出する(ステップS33)。この駆動軸と従動軸の回転角速度を算出するとき、シミュレーション実行部107は、まず、駆動軸の等価慣性モーメントJeq1と従動軸の等価慣性モーメントJeq2を算出する。この駆動軸と従動軸についてはエネルギー保存則が成り立ち、駆動軸と従動軸の等価慣性モーメントJeq1,Jeq2について下記(3)式と(4)式が成り立つ。
(3)式と(4)式において、Jn(n=1〜8)は、図5に示すようにDCモータ1の慣性モーメント(N・m)と減速プーリ3とワイヤプーリ3とプーリ5〜8の慣性モーメント(N・m)を示し、M1は第1キャリッジ9の質量(kg)、M2は第2キャリッジ10の質量(kg)、Rn(n=1〜8)は、DCモータ1と減速プーリ3とワイヤプーリ3及びプーリ5〜8の半径(m)、x9は第1キャリッジ9の変位(m)、x10は第2キャリッジ10の変位(m)、θn(n=1〜8)はDCモータ1と減速プーリ3とワイヤプーリ3及びプーリ5〜8が回転した角度を示す。
(3)式から駆動軸の等価慣性モーメントJeq1は、DCモータ1の等価慣性モーメントJ1と同値であることがわかり、シミュレーション実行部107は駆動軸の等価慣性モーメントJeq1をDCモータ1の等価慣性モーメントJ1で算出する。また、(4)式は、下記(5)式に変形できる。
また、減速プーリ3とワイヤプーリ3及びプーリ5〜8に対して滑ることがないと仮定すると、DCモータ1と減速プーリ3とワイヤプーリ3とプーリ5〜8の角度比及び第1キャリッジ9と第2キャリッジ10の位置比について、下記(6)式から(14)式までが成り立つ。
前記(6)式は、駆動軸と従動軸間の減速比R=R2/R1の逆数である。また、(5)式に(7)式から(14)式を代入すると、従動軸の等価慣性モーメントJeq2は下記(15)式で表せ、シミュレーション実行部107は、従動軸の等価慣性モーメントJeq2を(15)式で算出する。
また、第1キャリッジ9の速度を求めるためには、従動軸の回転角速度を求める必要がある。そのためにシミュレーション実行部107は、算出した駆動軸の等価慣性モーメントJeq1と従動軸の等価慣性モーメントJeq2を使用して、下記(16)式と(17)式に示す駆動軸と従動軸の運動方程式を解いて、駆動軸の回転角速度dθ1/dtと従動軸の回転角速度dθ2/dtを算出する。
(16)式と(17)式において、Jeq1は駆動軸の等価慣性モーメント(kg・m2)、Jeq2は従動軸の等価慣性モーメント(kg・m2)、iは駆動軸に接続するモータ回路を流れる電流(A)、Ktはモータのトルク定数(N・m/A)、cは駆動軸と従動軸間の減衰定数{N・m/(rad/s)}、kは駆動軸と従動軸間の剛性定数(N・m/rad)、Bは駆動軸の粘性制動定数{N・m/(rad/s)}、TLは駆動軸の等価負荷トルク(N・m)、Rは駆動軸と従動軸間の減速比を示す。ここで、駆動軸等価負荷トルクTLは、第1キャリッジ9の定常速度時に各駆動機構にかかる負荷を駆動軸に全て換算した値としている。
シミュレーション実行部107は、算出した駆動軸すなわちDCモータ1の回転角速度dθ1/dtを制御装置103の駆動制御部108にフィードバック情報として入力して制御する場合、(16)式を解いて駆動軸の回転角速度dθ1/dtを求めたら、求めた駆動軸の回転角速度dθ1/dtを2相のパルス信号に変換してセンサ信号とし、制御装置103と同期をとって出力する(ステップS34)。このように求めた駆動軸の回転角速度dθ1/dtをセンサ信号に変換して制御装置103に出力することにより、制御装置108とより早い時間間隔で信号の交換を行うことができる。
ここでシミュレーション実行部107で駆動軸の回転角速度dθ1/dtを2相のパルス信号に変換するとき、図6のフローチャートに示すように、駆動軸の回転角速度dθ1/dtから毎秒のエンコーダのパルス数を算出する(ステップS341)。この毎秒のエンコーダのパルス数P(pulse/s)は下記(18)式で示される。
P=(PN/2π)(dθ1/dt) (18)
(18)式において、PNはDCモータ1の1回転に対してエンコーダが出力するパルス数である。また、パルス数Pの逆数はパルス周期である。
P=(PN/2π)(dθ1/dt) (18)
(18)式において、PNはDCモータ1の1回転に対してエンコーダが出力するパルス数である。また、パルス数Pの逆数はパルス周期である。
シミュレーション実行部107は、駆動軸の回転角速度dθ1/dtから毎秒のエンコーダのパルス数を算出すると、算出したパルス数Pのパルス周期でA相のパルス信号を制御装置103に出力し、A相パルス信号に対して駆動軸の回転が正転時には1/4周期遅らせ、逆転時には1/4周期進めたB相のパルス信号を制御装置103に出力する(ステップS342)。
制御装置103の駆動制御部108は入力したA相とB相のパルス信号から駆動軸の回転角速度を算出する(ステップS25)。この駆動軸の回転角速度を算出するとき、まず、パルス信号を一定時間間隔でカウントして毎秒のパルス数Pを算出する。次に、(18)式を変形した下記(19)式を用いて駆動軸の回転角速度ωを算出する。
ω=2π(P/PN) (19)
ω=2π(P/PN) (19)
また、ワイヤ17,18が伸び縮みしたり、ワイヤプーリ3とプーリ5〜8に対して滑ったりすることがないと仮定すると、(13)式より駆動軸すなわちDCモータ1の回転角速度に対する第1キャリッジ9の速度dx9/dtは下記(20)式で示される。
dx9/dt=R3(dθ2/dt) (20)
dx9/dt=R3(dθ2/dt) (20)
シミュレーション実行部107は、(17)式により算出した従動軸の回転角速度dθ2/dtと(20)式により、第1キャリッジ9の移動速度を算出して出力装置104に出力する(ステップS35)。
この解析処理を第1キャリッジ9の移動範囲の全てを評価するまで、一定微小時間間隔毎に繰り返す(ステップS26,S21〜S25,S36,S31〜S35)。
このようにして制御装置103と連動させて画像読取装置の仮想機構モデルを解析することにより第1キャリッジ9の速度を求め、求めた速度から、図3に示す画像読取装置の駆動機構を実際の制御装置と組み合せた場合に、第1キャリッジ9の速度のムラがどの程度になるのかを評価することができる。
100;駆動機構設計支援装置、101;入力装置、
102;シミュレーション装置、103;制御装置、104;出力装置、
105;アクチュエータ回路部、106;駆動機構モデル部、
107;シミュレーション実行部、108;駆動制御部、109;制御プログラム、
1;DCモータ、2;減速プーリ、3,14;ワイヤプーリ、
4,5,6,7,8,11,12,13,19,20;プーリ、
15;タイミングベルト、16;シャフト、17,18;ワイヤ。
102;シミュレーション装置、103;制御装置、104;出力装置、
105;アクチュエータ回路部、106;駆動機構モデル部、
107;シミュレーション実行部、108;駆動制御部、109;制御プログラム、
1;DCモータ、2;減速プーリ、3,14;ワイヤプーリ、
4,5,6,7,8,11,12,13,19,20;プーリ、
15;タイミングベルト、16;シャフト、17,18;ワイヤ。
Claims (11)
- 入力装置とシミュレーション装置と制御装置及び出力装置を有し、
前記入力装置は、解析する駆動機構のアクチュエータや駆動機構を構成する慣性要素と粘性要素及び弾性要素のパラメータ情報を前記シミュレーション装置に入力し、
前記シミュレーション装置は、アクチュエータ回路部と駆動機構モデル部及びシミュレーション実行部を有し、前記アクチュエータ回路部は、前記入力装置から入力するアクチュエータのパラメータ情報により、前記駆動機構のアクチュエータの挙動を解析するアクチュエータ回路モデルを形成し、前記駆動機構モデル部は、前記入力装置から入力する駆動機構を構成する慣性要素と粘性要素及び弾性要素により仮想機構モデルを形成し、前記シミュレーション実行部は、前記アクチュエータ回路部で形成したアクチュエータ回路モデルと前記駆動機構モデル部で形成した仮想機構モデルに基づいて、前記制御装置から入力する制御信号に応じた仮想機構モデルの挙動を所定の微小時間間隔毎に解析し、解析した結果をセンサ信号に変換して制御装置に送り、
前記制御装置は、駆動制御部と制御プログラムを有し、前記駆動制御部は前記シミュレーション装置から送られたセンサ信号に応じた制御量と前記制御プログラムにより制御信号を生成し、
前記出力装置は、前記シミュレーション装置に入力する制御信号と前記シミュレーション実行部で解析した仮想機構モデルの挙動を示す状態量及びセンサ信号を出力することを特徴とする駆動機構設計支援装置。 - 前記シミュレーション実行部は、前記制御装置から制御信号として入力する印加電圧と前記アクチュエータ回路モデルに基づいてアクチュエータ回路モデルの電流を所定時間間隔毎に算出し、算出した電流に応じた前記仮想機構モデルの挙動を解析する請求項1記載の駆動機構設計支援装置。
- 前記シミュレーション実行部は、前記アクチュエータ回路モデルの変化に応じてアクチュエータ回路モデルの抵抗要素と誘導要素及び逆起電力定数の特性値を変更し、変更した特性値に応じて前記仮想機構モデルの挙動を微小時間間隔ごとに解析する請求項2記載の駆動機構設計支援装置。
- 前記シミュレーション実行部は、算出したアクチュエータ回路モデルの電流と前記仮想機構モデルに基づいてアクチュエータの瞬間速度と瞬間位置を決定する請求項2記載の駆動機構設計支援装置。
- 前記シミュレーション実行部は、算出したアクチュエータ回路モデルの電流と前記仮想機構モデルを構成する部品間の等価慣性と等価負荷、減速比、減衰定数及び剛性定数に基づいて前記仮想機構モデルの挙動を解析する請求項2記載の駆動機構設計支援装置。
- 解析する駆動機構のアクチュエータのパラメータ情報により、前記駆動機構のアクチュエータの挙動を解析するアクチュエータ回路モデルを形成し、駆動機構を構成する慣性要素と粘性要素及び弾性要素により仮想機構モデルを形成し、形成したアクチュエータ回路モデルと仮想機構モデルに基づいて、制御装置から入力する制御信号に応じた仮想機構モデルの挙動を所定の微小時間間隔毎に解析し、解析した結果を出力するとともに前記制御装置にフィードバックすることを特徴とする駆動機構設計支援方法。
- 前記制御装置から制御信号として入力する印加電圧と前記アクチュエータ回路モデルに基づいてアクチュエータ回路モデルの電流を所定時間間隔毎に算出し、算出した電流に応じた前記仮想機構モデルの挙動を解析する請求項6記載の駆動機構設計支援方法。
- 前記アクチュエータ回路モデルの変化に応じてアクチュエータ回路モデルの抵抗要素と誘導要素及び逆起電力定数の特性値を変更し、変更した特性値に応じて前記仮想機構モデルの挙動を微小時間間隔ごとに解析する請求項6記載の駆動機構設計支援方法。
- 前記アクチュエータ回路モデルの電流と前記仮想機構モデルに基づいてアクチュエータの瞬間速度と瞬間位置を決定する請求項6記載の駆動機構設計支援方法。
- 前記アクチュエータ回路モデルの電流と前記仮想機構モデルを構成する部品間の等価慣性と等価負荷、減速比、減衰定数及び剛性定数に基づいて前記仮想機構モデルの挙動を解析する請求項6記載の駆動機構設計支援装置。
- 請求項6乃至10のいずれかに記載の駆動機構設計支援方法のプログラムを格納し、コンピュータで読み取り可能なことを特徴とする記憶媒体。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2004033583A JP2005227858A (ja) | 2004-02-10 | 2004-02-10 | 駆動機構設計支援装置と駆動機構設計支援方法及び記憶媒体 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2004033583A JP2005227858A (ja) | 2004-02-10 | 2004-02-10 | 駆動機構設計支援装置と駆動機構設計支援方法及び記憶媒体 |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2005227858A true JP2005227858A (ja) | 2005-08-25 |
Family
ID=35002551
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2004033583A Pending JP2005227858A (ja) | 2004-02-10 | 2004-02-10 | 駆動機構設計支援装置と駆動機構設計支援方法及び記憶媒体 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2005227858A (ja) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008197062A (ja) * | 2007-02-15 | 2008-08-28 | Ricoh Co Ltd | 転写ベルト駆動機構のモデル化方法及びそのモデル化方法を用いた制御系の設計支援方法 |
US7536135B2 (en) | 2005-11-29 | 2009-05-19 | Ricoh Company, Limited | Rotor drive controlling unit and an image formation apparatus |
CN102880746A (zh) * | 2012-09-04 | 2013-01-16 | 上海发电设备成套设计研究院 | 汽轮机转子体积平均温度计算的惯性环节系数的确定方法 |
-
2004
- 2004-02-10 JP JP2004033583A patent/JP2005227858A/ja active Pending
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7536135B2 (en) | 2005-11-29 | 2009-05-19 | Ricoh Company, Limited | Rotor drive controlling unit and an image formation apparatus |
JP2008197062A (ja) * | 2007-02-15 | 2008-08-28 | Ricoh Co Ltd | 転写ベルト駆動機構のモデル化方法及びそのモデル化方法を用いた制御系の設計支援方法 |
CN102880746A (zh) * | 2012-09-04 | 2013-01-16 | 上海发电设备成套设计研究院 | 汽轮机转子体积平均温度计算的惯性环节系数的确定方法 |
CN102880746B (zh) * | 2012-09-04 | 2015-01-28 | 上海发电设备成套设计研究院 | 汽轮机转子体积平均温度计算的惯性环节系数的确定方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Tjahjowidodo et al. | Theoretical modelling and experimental identification of nonlinear torsional behaviour in harmonic drives | |
JP5269158B2 (ja) | 制御方法及び制御装置 | |
JP6409803B2 (ja) | シミュレーション装置、シミュレーション方法、制御プログラム、および記録媒体 | |
JP6324641B1 (ja) | 異常診断装置及び異常診断方法 | |
JP5759013B2 (ja) | 制御プログラム、制御方法及び制御装置 | |
JP6091523B2 (ja) | サーボ制御装置 | |
WO2018029910A1 (ja) | パラレルリンク機構の制御装置 | |
CN109434873B (zh) | 机器人关节伺服电机转矩常数的测量方法 | |
JP2006236035A (ja) | 駆動制御系設計支援装置、駆動制御系設計支援プログラム、駆動機構設計支援装置、駆動機構設計支援プログラム及び記録媒体 | |
JP2005227858A (ja) | 駆動機構設計支援装置と駆動機構設計支援方法及び記憶媒体 | |
TWI578172B (zh) | 消耗電能推定裝置 | |
JP4045860B2 (ja) | 動力伝達系の試験装置とその制御方法 | |
JP2964736B2 (ja) | 二慣性系における結合軸の機械時定数同定方法 | |
JP4839242B2 (ja) | 転写ベルト駆動機構のモデル化方法及びそのモデル化方法を用いた制御系の設計支援方法 | |
JP2005085177A (ja) | 機構制御プログラム設計支援装置、機構制御プログラム設計支援システム、機構制御プログラム設計支援プログラム及び記憶媒体 | |
Tjahjowidodo et al. | Positioning controller for mechanical systems with a mini harmonic drive servo actuator | |
WO2021181787A1 (ja) | 制御装置 | |
JP2007014126A (ja) | システム同定装置 | |
JP2006074896A (ja) | モータ制御装置 | |
KR20200136917A (ko) | 모터 구동 장치 | |
JP6393246B2 (ja) | モータ駆動制御装置及びモータ駆動制御装置の制御方法 | |
JP2005092640A (ja) | 駆動機構のシミュレーション装置、シミュレーション方法、及びシミュレーションプログラム | |
Katebi et al. | Optimal control design for fast coordinate measuring machine | |
JP2006031111A (ja) | 指令パラメータ設定方法とモーション制御装置 | |
JP2005092260A (ja) | 画像読取り装置の駆動機構設計支援装置および駆動機構設計支援方法、プログラム、記憶媒体 |