JP7517867B2 - 動作速度変更時の補正量修正機能を備えた機械システム - Google Patents

Description

本発明は、機械システムに関し、特に動作速度変更時の補正量修正機能を備えた機械システムに関する。

ロボット、工作機械等の機械の動作を高速化し、タクトタイムを短縮することは作業効率に直結する。しかし、機械の動作を一定以上高速化した場合には、減速機や機械機構部の剛性不足等に起因して機械先端部に振動が発生してしまう。斯かる問題の対処法としては次の文献が公知である。

特許文献１には、機械先端部にセンサを取付けて動作中の振動を計測することで機械の動作速度を高速化しながら機械先端部の振動を学習制御する方法が記載されている。

特許文献２には、スポット溶接ロボットの高速動作によって発生する軌跡誤差や振動成分によってロボットの最適動作が阻害されるという問題を解決するため、制御対象部位に設置されたセンサの検出結果から制御対象部位の軌跡又は位置を算出し、該軌跡と目標軌跡との間の軌跡誤差、又は該位置と目標位置との間の位置誤差を補正するための、若しくはロボット機構部を動作させたときに生じる制御対象部位の振動を抑制するための学習補正量を学習制御により算出する学習制御部を備え、学習制御部は、学習補正量を算出する過程でロボット機構部に設定可能な最大動作速度を算出し、最大動作速度に至るまで１回又は複数回に渡って動作速度を増加させながら学習補正量を算出することが記載されている。

特許文献３には、生産ラインにおける運用を考慮して学習制御を行うロボットにおいて、学習制御部は、ロボット機構部の動作速度を増加又は減少するために設定される動作速度変更率の最大値を超えない範囲内で、且つ、制御対象部位で発生する振動の許容条件の範囲内で、複数回に渡って動作速度変更率を増加又は減少させる動作速度変更率調整部を備えることが記載されている。

特許文献４には、速度一定が要求されるアプリケーションで学習制御を行うロボットにおいて、学習制御部は、速度一定を教示した作業プログラムに従って行われる加工作業中にロボット機構部の制約によって生じた最大速度及び最小速度を記憶しておき、最大速度と最小速度の比に相当する速度変動の許容条件を算出し、算出した速度変動の許容条件と記憶した最大速度及び最小速度とに基づいてロボット機構部の動作速度を増加又は減少させるために使用される動作速度変更率を設定する動作速度変更率調整部を備えることが記載されている。

特開２０１１－１６７８１７号公報 特開２０１２－２４０１４２号公報 特開２０１８－１４９６０６号公報 特開２０１９－０１３９８４号公報

振動を打ち消すための補正量を算出して動作指令を補正するが、動作速度の変更直後に適用する補正量は動作速度の変更前に算出された補正量であるため、動作速度を変更したことによる振動の変化分が考慮されていない。例えば動作速度を増加させた直後にはそれに伴う振動の増加分を補正しきれずに振動が増加し、一方で、動作速度を減少させた直後には過度に補正することで振動が増加してしまう可能性がある。ひいては、動作速度の変更直後の振動の増加によって、機械がワーク等の周囲物体に干渉したり、補正量が収束するまでに時間が掛かったりすることがある。

そこで、動作速度の変更直後の振動の増加を抑制する技術が求められている。

本開示の一態様は、制御対象部位の位置を検出するためのセンサを備えた機械機構部と、機械機構部の動作を制御する制御装置と、を備えた機械システムであって、制御対象部位の目標軌跡又は目標位置に関する動作指令によって機械機構部を動作させて、センサに基づき検出された制御対象部位の位置を目標位置に近づけるための補正量を導出する補正制御部と、動作指令が与えられ、与えられた動作指令及び導出された補正量を用いて機械機構部の動作を制御する機械制御部と、を備え、補正制御部は、機械機構部の動作速度を変更しながら補正量を算出し、過去の動作速度の変更前後の補正量の差分に対して前記補正量の修正分を求め、前記修正分を前記補正量に加算することで、動作速度の変更直後に適用する補正量を修正する補正量修正部を有する、機械システムを提供する。

本開示の一態様によれば、過去の動作速度の変更前後の補正結果に基づき、動作速度の変更直後に適用する補正量を修正するため、修正した補正量が動作速度の変更に伴う振動の増加分を抑制することになる。ひいては、動作速度変更時における周囲物体への機械の干渉を抑制でき、また、補正量の収束時間を低減できることになる。

一実施形態に係る機械システムの構成を示す概略図である。 機械機構部の一例を示す側面図である。 制御装置の一例を示すブロック図である。 補正量の修正例を示すタイムチャートである。 補正量の修正例を示すグラフである。 補正量の適用時間の修正例を示すグラフである。 補正量の修正の変形例を示すグラフである。 一実施形態に係る機械システムの動作を示すフローチャートである。

以下、添付図面を参照して本開示の実施形態を詳細に説明する。各図面において、同一又は類似の構成要素には同一又は類似の符号が付与されている。また、以下に記載する実施形態は、特許請求の範囲に記載される発明の技術的範囲及び用語の意義を限定するものではない。

図１は本実施形態に係る機械システム１０の構成を示している。機械システム１０は、制御対象部位の位置を検出するためのセンサ１１を備えた機械機構部１２と、センサ１１を用いて機械機構部１２の動作を制御する制御装置１３と、を備えている。センサ１１及び機械機構部１２は、動力線や信号線等の線条体１４を介して制御装置１３に接続されるが、無線を介して接続されてもよい。センサ１１は、制御対象部位である機械先端部１５に取付けられるが、振動を発生し得る部位であれば他の制御対象部位に取付けられてもよい。センサ１１は、制御対象部位の位置を検出可能なセンサであればよく、例えば加速度センサ、ジャイロセンサ、慣性センサ、力センサ、レーザトラッカ、カメラ、モーションキャプチャシステム等でよい。

図２は機械機構部１２の一例を示している。機械機構部１２は、例えば多関節ロボットであるが、パラレルリンク型ロボット、ヒューマノイド、工作機械、建設機械等の他の機械機構部でもよい。多関節ロボットの場合、機械機構部１２は複数の関節軸Ｊ１～Ｊ６を備え、各関節軸Ｊ１～Ｊ６には、例えばサーボモータ等の駆動源、減速機等（図示せず）のアクチュエータが配設される。関節軸Ｊ１の近傍にはワールド座標系Ｃ１が規定され、フランジ１６の近傍にはインタフェイス座標系Ｃ２が規定されるが、他のユーザ座標系が規定されてもよい。制御装置１３は、これら座標系に基づく制御対象部位の目標軌跡又は目標位置（以下「目標位置」と称する。）に関する動作指令に応じて機械機構部１２を動作させ、センサ１１に基づき検出された制御対象部位の位置（以下「センサ位置」と称する。）をこれら座標系に基づく位置に適宜変換する。

図３は制御装置１３の一例を示している。制御装置１３は、ＣＰＵ（central processing unit）、ＦＰＧＡ（field-programmable gate array）、ＡＳＩＣ（application specific integrated circuit）等のプロセッサ、半導体集積回路等を備えたコンピュータ装置でよい。制御装置１３は機械制御部１８及び補正制御部１９を備えているが、補正制御部１９は上位コンピュータ装置等の外部装置に実装されてもよい。機械制御部１８は動作プログラム１７に従って動作指令が与えられ、与えられた動作指令及び導出された補正量を用いて機械機構部１２の動作を制御する。動作指令は、例えば時間に関する位置指令でよいが、速度指令、加速度指令、トルク指令等でもよい。

機械制御部１８は、機械機構部１２に設けたモータ等の駆動源（図示せず）の位置を検出する位置検出器（図示せず）を用いて、制御対象部位の実位置、実速度、実加速度、実トルク等を、目標位置、目標速度、目標加速度、目標トルク等に一致させるように位置、速度、加速度、トルク等のフィードバック制御を行う。しかしながら、斯かる制御を行っても機械機構部１２の動作を高速化した場合には、減速機や機械機構部の剛性不足等に起因して機械先端部１５に振動が発生し、現在位置が目標位置から位置ずれして位置偏差を生じることがある。このため補正制御部１９が振動を打ち消すための補正量を導出し、機械制御部１８が導出された補正量に基づき動作指令を補正して機械機構部１２の動作を制御することで、振動を抑制するとよい。

補正制御部１９は、制御対象部位の振動成分である差分量を算出する差分量算出部２１を備えているとよい。差分量は、例えばセンサ位置と目標位置の差分量でよいが、センサ速度と目標速度の差分量、センサ加速度と目標加速度の差分量、センサトルクと目標トルクの差分量でもよい。このため、センサ位置と目標位置、センサ速度と目標速度、センサ加速度と目標加速度、センサトルクと目標トルク等を時系列に関連付けて第１メモリ２０に記憶しておくとよい。

また補正制御部１９は、算出された差分量（振動成分）に基づき、センサ位置を目標位置に近づけるための補正量を算出する補正量算出部２２を備えているとよい。補正量は、振動を打ち消すために動作指令を補正するものでよく、例えば位置補正量、速度補正量、加速度補正量、トルク補正量等でもよい。また補正量は、時系列データであるとよい。補正量算出部２２は、過去の補正量と、算出された差分量とに基づき、新たな補正量を算出する学習制御を行うが、差分量のみに基づき補正量を算出してもよい。学習制御を行うため又は後述する補正量の修正を行うため、過去及び現在の補正量を時系列に関連付けて第２メモリ２３に記憶しておくとよい。

さらに補正制御部１９は、算出された差分量（振動成分）に基づき、動作速度を変更するために使用される動作速度変更率を調整する動作速度変更率調整部２５を備えているとよい。動作速度変更率は、動作速度に乗算する倍率でよく、例えば１１０％、９０％等として表される。動作速度変更率調整部２５は、動作速度変更率の最大値を超えない範囲内で、且つ、振動の許容条件（例えば振幅の許容値等でよい。）の範囲内で、過去の動作速度変更率を新たな動作速度変更率に調整するとよい。動作速度変更率を調整するため又は後述する補正量の修正のため、過去及び現在の動作速度変更率を時系列に関連付けて第２メモリ２３に記憶しておくとよい。また過去及び現在の動作速度変更率を過去及び現在の補正量と時系列に関連付けて第２メモリ２３に記憶しておくとよい。さらに動作速度変更率の最大値及び振動の許容条件を満たすように動作速度変更率を調整するため、動作速度変更率の最大値と振動の許容条件を第４メモリ２４に記憶しておくとよい。

加えて補正制御部１９は、過去の動作速度の変更前後の補正結果に基づき、動作速度の変更直後に適用する補正量を修正する補正量修正部２６を備えているとよい。例えば補正量修正部２６は、過去の動作速度変更率の調整前後の補正結果に基づき、動作速度変更率の調整直後に適用する補正量を修正するとよい。修正した補正量は動作速度の変更に伴う振動の増加分を抑制することになる。ひいては、動作速度変更時における周囲物体への機械の干渉を抑制でき、また、補正量の収束時間を低減できることになる。

また補正制御部１９は、動作速度の変更直後に適用する補正量の適用時間を修正する適用時間修正部２７を備えているとよい。例えば適用時間修正部２７は、動作速度変更率の調整前後の動作速度変更率に基づき、動作速度変更率の調整直後に適用する補正量の適用時間を修正するとよい。適用時間を修正した補正量の適用タイミングは動作速度の変更直後の動作に一致するようになるため、修正した補正量が動作速度の変更に伴う振動の増加分を適時に抑制するようになる。ひいては、動作速度変更時における周囲物体への機械の干渉を抑制でき、また、補正量の収束時間を低減できることになる。なお、補正制御部１９は、補正量修正部２６を備えず、適用時間修正部２７のみを備えていてもよい。修正した補正量は過去及び現在の補正量として第２メモリ２３に記憶しておくとよい。

さらに補正制御部１９は、現在の補正量と過去の補正量を比較し、現在の動作速度変更率と過去の動作速度変更率を比較する比較部２８を備えているとよい。例えば比較部２８は、現在の補正量と過去の補正量との比が所定範囲内であるか否かを判定し、現在の動作速度変更率と過去の動作速度変更率の比が所定範囲内であるか否かを判定するとよい。これにより、補正量及び動作速度変更率が収束したか否かを判定できる。収束した補正量と収束した動作速度変更率を機械システム１０の電源切断後に再利用するため、収束した補正量と収束した動作速度変更率を時系列に関連付けて第３メモリ２９に記憶しておくとよい。収束した補正量と収束した動作速度変更率を電源切断後であっても記憶しておくため、第３メモリ２９は不揮発性メモリであるとよい。収束した補正量と収束した動作速度変更率を機械システム１０の電源投入後に第３メモリ２９から第２メモリ２３に読み出して再利用するとよい。なお、第１メモリ２０、第２メモリ２３、第４メモリ２４は、揮発性メモリでよいが、不揮発性メモリでもよい。

図４は補正量の修正例を示すタイムチャートである。図４には、動作速度変更率の初期値をＯ０に設定し、第一回から第六回までの補正回Ｔ１～Ｔ６において動作速度変更率がＯ１からＯ４へ調整されていき、第七回の補正回で補正量と動作速度変更率が収束した例が示されている。このとき、補正量算出部２２の出力（補正量）がＡ１からＡ６へ変化し、補正量修正部２６の出力（動作速度の変更に伴い修正した補正量）がＡ１'からＡ６'へ変化し、適用時間修正部２７の出力（適用時間をさらに修正した補正量）がＡ１'ｔからＡ６'ｔへ変化し、適用時間修正部２７の出力（適用時間のみを修正した補正量）がＡ１ｔからＡ６ｔへ変化していくとする。

例えば第二回のＴ２時に動作速度変更率がＯ１からＯ２へ調整された場合、補正量修正部２６は、過去の動作速度変更率の調整前後（例えばＯ０からＯ１への調整前後）の補正結果、つまり動作速度変更率Ｏ０で動作させて適用時間のみを修正した補正量Ａ１ｔと、動作速度変更率Ｏ１で動作させて算出した補正量Ａ２と、に基づき、動作速度変更率をＯ１からＯ２へ調整した直後の補正量Ａ２を修正するとよい。修正後の補正量Ａ２’は例えば次式から求めることができる。

式中、Ａ２－Ａ１ｔは過去の動作速度変更率の調整前後（Ｏ０からＯ１への調整前後）の補正量の差分を表し、Ｏ２－Ｏ１は現在の動作速度変更率調整量（Ｏ１からＯ２への調整量）であり、Ｏ１－Ｏ０は過去の動作速度変更率調整量（Ｏ０からＯ１への調整量）であり、（Ｏ２－Ｏ１）／（Ｏ１－Ｏ０）は現在及び過去の動作速度変更率調整量の比である。

つまり補正量修正部２６は、過去の動作速度変更率の調整前後の補正量の差分に対して現在及び過去の動作速度変更率調整量の比を乗算することで補正量の修正分（（Ａ２－Ａ１ｔ）×（Ｏ２－Ｏ１）／（Ｏ１－Ｏ０））を求め、補正量の修正分を動作速度変更率の調整時に算出された補正量Ａ２に加算することで補正量Ａ２の修正を行うとよい。

同様に第三回のＴ３時に動作速度変更率がＯ２からＯ３へ調整された場合、補正量修正部２６は、過去の動作速度変更率の調整前後（Ｏ１からＯ２への調整前後）の補正結果、つまり動作速度変更率Ｏ１で動作させて算出し適用時間のみを修正した補正量Ａ２ｔと、動作速度変更率Ｏ２で動作させて算出した補正量Ａ３と、に基づき、動作速度変更率をＯ２からＯ３へ調整した直後の補正量Ａ３を修正するとよい。修正後の補正量Ａ３'は例えば次式から求めることができる。

つまり補正量修正部２６は、過去の動作速度変更率の調整前後の補正量の差分（Ａ３－Ａ２ｔ）に対して現在及び過去の動作速度変更率調整量の比（（Ｏ３－Ｏ２）／（Ｏ２－Ｏ１））を乗算することで補正量の修正分（（Ａ３－Ａ２ｔ）×（Ｏ３－Ｏ２）／（Ｏ２－Ｏ１））を求め、補正量の修正分を動作速度変更率の調整時に算出された補正量Ａ３に加算することで補正量Ａ３の修正を行うとよい。

また第四回のＴ４時と第五回のＴ５時には動作速度変更率がＯ３のまま調整されていないため、補正量修正部２６は補正量Ａ４、Ａ５を修正する必要はない。つまり、修正後の補正量Ａ４'は修正前の補正量Ａ４と同じでよく、修正後の補正量Ａ５'は修正前の補正量Ａ５と同じでよい。

さらに第六回のＴ６時に動作速度変更率がＯ３からＯ４へ調整された場合、補正量修正部２６は、過去の動作速度変更率の調整前後（Ｏ２からＯ３への調整前後）の補正結果、つまり動作速度変更率Ｏ２で動作させて算出し適用時間のみを修正した補正量Ａ３ｔと、動作速度変更率Ｏ３で動作させて算出した補正量Ａ４と、に基づき、動作速度変更率をＯ３からＯ４へ調整した直後の補正量Ａ６を修正するとよい。修正後の補正量Ａ６'は例えば次式から求めることができる。

つまり補正量修正部２６は、過去の動作速度変更率の調整前後の補正量の差分（Ａ４－Ａ３ｔ）に対して現在及び過去の動作速度変更率調整量の比（（Ｏ４－Ｏ３）／（Ｏ３－Ｏ２））を乗算することで補正量の修正分（（Ａ４－Ａ３ｔ）×（Ｏ４－Ｏ３）／（Ｏ３－Ｏ２））を求め、補正量の修正分を動作速度変更率の調整時に算出された補正量Ａ６に加算することで補正量Ａ６の修正を行うとよい。

なお、補正量の修正で使用される「過去の動作速度変更率の調整前後の補正結果」は、「直前」の動作速度変更率の調整前後の補正結果でよいが、「それ以前」の動作速度変更率の調整前後の補正結果でもよい。例えば第六回のＴ６時に動作速度変更率がＯ３からＯ４へ調整された場合、補正量修正部２６は、「直前」の動作速度変更率の調整（Ｏ２からＯ３への調整）前後の補正結果（Ａ４－Ａ３ｔ）を使用するのではなく、「それ以前」の動作速度変更率の調整（Ｏ１からＯ２への調整）前後の補正結果（Ａ３－Ａ２ｔ）を使用してもよい。この場合、修正後の補正量Ａ６'は例えば次式から求めることができる。

図５は補正量の修正例を示すグラフである。太い実線及び細い実線は夫々、過去の動作速度変更率の調整（１００％から１１０％への調整）前後の補正量Ａ１ｔ（動作速度変更率１００％で動作させて算出し適用時間のみを修正した補正量）と補正量Ａ２（動作速度変更率１１０％で動作させて算出した補正量）とを表している。また太い破線は、過去の動作速度変更率の調整前後の補正量の差分Ａ２－Ａ１ｔを表している。さらに細い破線は、過去の動作速度変更率の調整前後の補正量の差分Ａ２－Ａ１ｔに基づき、動作速度変更率の調整（１１０％から１２０％への調整）直後に適用する補正量Ａ２を修正した補正量Ａ２'（適用時間修正前）を表している。このグラフによれば、修正した補正量Ａ２’が修正前の補正量Ａ２より大きくなっていることが分かる。つまり修正した補正量Ａ２’は動作速度の変更に伴う振動の増加分を抑制できることが分かる。

図６は補正量の適用時間の修正例を示すグラフである。太い破線は、動作速度変更率１００％で動作させて修正した適用時間修正前の補正量Ａ１'を表している。また太い実線は、動作速度変更率１００％で動作させて修正した適用時間修正後の補正量Ａ１'ｔを表している。第一回のＴ１時に動作速度変更率が１００％から１１０％へ調整された場合、機械先端部１５は動作開始から１１秒後に到達していた位置に１０秒後に到達するようになるため、動作速度変更率１００％で動作させて修正した補正量Ａ１'を動作速度変更率１１０％の動作にそのまま適用すると、補正量の適用タイミングが動作速度の変更に伴う動作に一致しなくなってしまう。そこで、適用時間修正部２７は、補正量Ａ１'の適用時間を１００％／１１０％に縮めるように補正量Ａ１'を修正するとよい。適用時間を修正した補正量Ａ１'ｔの適用タイミングは動作速度変更率１１０％へ調整した直後の動作に一致するようになるため、修正した補正量Ａ１'ｔが動作速度の変更に伴う振動の増加分を適時に抑制できるようになる。

図７は補正量の修正の変形例を示している。補正量修正部２６は、ピーク値を含む区間に時系列の補正量を分割し、区間毎に求めた修正前後の補正量のピーク値に基づき動作速度変更率の調整直後に適用する補正量を区間毎に修正する点で、前述のものと異なる。例えば補正量修正部２６は、補正量が０である時点を境界として補正量の山に分割すればよい。そして、補正量修正部２６は、区間毎に求めた修正前後の補正量のピーク値に基づき区間修正率を区間毎に求め、区間内の任意の補正量に対して区間修正率を乗算することで補正量を区間毎に修正するとよい。

例えば第一区間の場合、補正量修正部２７は、次式から、過去の動作速度変更率の調整（１００％から１１０％への調整）前後の補正量のピーク値の差分（Ａ２_Ｐ１－Ａ１ｔ_Ｐ１）に基づき、修正後の補正量のピーク値Ａ２'_P1を区間毎に求める。

次に補正量修正部２７は、次式から、修正前後の補正量のピーク値の比（Ａ２'_P1／Ａ２_P1）に基づき、区間修正率Ｉ１を区間毎に求める。

そして補正量修正部２７は、第一区間内の任意の補正量Ａ２に対して区間修正率Ｉ１を乗算することで動作速度変更率の調整直後に適用する補正量Ａ２を区間毎に修正するとよい。第一区間の修正後の補正量Ａ２’は例えば次式から求めることができる。

また、例えば第四区間より後の区間では、補正量のピーク値の変化が小さいため、補正量修正部２７は補正量を修正しないと判定してもよい。

このように振動の影響が大きい時点を示す補正量のピーク値に基づき区間修正率を求め、動作速度変更率の調整直後に適用する補正量を区間修正率に基づき修正することで、計算速度向上、メモリ容量節約といった種々の利点を得ることができる。

図８は本実施形態に係る機械システム１０の動作を示すフローチャートである。先ずステップＳ１０では、振動の許容条件が作業者によって手動で設定される。このため機械システム１０は振動の許容条件を入力する手段を備えているとよい。ステップＳ１１では、動作指令に基づき機械機構部を動作させ、動作速度の最大値ω_max_jとトルクの最大値τ_max_j（ｊは軸番号）を夫々記憶しておき、その動作に対して設定可能な動作速度変更率の最大値α_maxを予め算出する。動作速度変更率の最大値α_maxは例えば次式から求めることができる。ここで、ω_alw_j、τ_alw_jは夫々、動作速度の許容値、トルクの許容値である。

なお、機械システム１０は動作速度変更率の最大値を入力する手段を備えていてもよく、この場合には動作速度変更率の最大値は作業者によって手動で設定される。

ステップＳ１２では、動作速度変更率の最大値を超えない範囲内で且つ振動の許容条件の範囲内で初期設定した動作速度変更率に基づき機械機構部１２を動作させ、センサ位置と目標位置との差分量を算出する。差分量は、センサ速度と目標速度の差分量、センサ加速度と目標加速度の差分量、センサトルクと目標トルクの差分量等でもよい。ステップＳ１３では、差分量に基づきセンサ位置を目標位置に近づけるための補正量を算出する。補正量は学習制御に基づき算出されてもよい。

ステップＳ１４では、差分量に基づき動作速度変更率を調整する。例えば差分量が振動の許容条件を満たしていない場合には動作速度変更率を減少させ、差分量が振動の許容条件を満たしている場合には動作速度変更率を増加させる。この際、動作速度変更率の上限を動作速度変更率の最大値α_maxで制限するとよい。

ステップＳ１５では、過去の動作速度変更率の調整前後の補正結果に基づき、動作速度変更率の調整直後に適用する補正量を修正する。過去の動作速度変更率の調整前後の補正結果は、過去の動作速度変更率の調整前後の補正量の差分を使用してもよいし、又は修正前後の補正量のピーク値に基づき求めた区間修正率を使用してもよい。これにより、修正した補正量は動作速度の変更に伴う振動の増加分を抑制することになる。ひいては、動作速度変更時における周囲物体への機械の干渉を抑制でき、また、補正量の収束時間を低減できることになる。

ステップＳ１６では、動作速度変更率の調整前後の動作速度変更率に基づき、動作速度変更率の調整直後に適用する補正量の適用時間を修正する。これにより、適用時間を修正した補正量の適用タイミングが動作速度の変更直後の動作に一致するようになるため、修正した補正量が動作速度の変更に伴う振動の増加分を適時に抑制するようになる。ひいては、動作速度変更時における周囲物体への機械の干渉を抑制でき、また、補正量の収束時間を低減できることになる。

ステップＳ１７では、現在の補正量と過去の補正量との比、及び現在の動作速度変更率と過去の動作速度変更率との比が所定範囲内か否かを夫々判定する。つまり補正量と動作速度変更率が夫々収束したか否かを判定する。補正量と動作速度変更率の少なくとも一方が収束していない場合には（ステップＳ１７のＮＯ）、ステップＳ１２に戻り、補正量と動作速度変更率が収束するまで補正制御を繰り返す。補正量と動作速度変更率の双方が収束した場合には（ステップＳ１７のＹＥＳ）、ステップＳ１８において収束した補正量と収束した動作速度変更率を不揮発性メモリに記憶して終了する。

以上の実施形態によれば、過去の動作速度の変更前後の補正結果に基づき、動作速度の変更直後に適用する補正量を修正するため、修正した補正量が動作速度の変更に伴う振動の増加分を抑制することになる。ひいては、動作速度変更時における周囲物体への機械の干渉を抑制でき、また、補正量の収束時間を低減できることになる。

なお、前述のプロセッサで実行されるプログラムや前述のフローチャートを実行するプログラムは、コンピュータ読取り可能な非一時的記録媒体、例えばＣＤ－ＲＯＭ等に記録して提供してもよいし、或いは有線又は無線を介してＷＡＮ（wide area network）又はＬＡＮ（local area network）上のサーバ装置から配信して提供してもよい。

本明細書において種々の実施形態について説明したが、本発明は、前述の実施形態に限定されるものではなく、特許請求の範囲に記載された範囲内において種々の変更を行えることを認識されたい。

１０ 機械システム
１１ センサ
１２ 機械機構部
１３ 制御装置
１４ 線条体
１５ 機械先端部
１６ フランジ
１７ 動作プログラム
１８ 機械制御部
１９ 補正制御部
２０ 第１メモリ
２１ 差分量算出部
２２ 補正量算出部
２３ 第２メモリ
２４ 第４メモリ
２５ 動作速度変更率調整部
２６ 補正量修正部
２７ 適用時間修正部
２８ 比較部
２９ 第３メモリ
Ｔ１～Ｔ６ 補正回
Ｏ０～Ｏ４ 動作速度変更率
Ａ１～Ａ６ 補正量
Ａ１'～Ａ６' 動作速度の変更に伴い修正した補正量
Ａ１'ｔ～Ａ６'ｔ 適用時間をさらに修正した補正量
Ａ１ｔ～Ａ６ｔ 適用時間のみを修正した補正量
Ａ１ｔ_P1 第一区間の補正量Ａ１ｔのピーク値
Ａ２_P1 第一区間の補正量Ａ２のピーク値
Ｉ１ 第一区間の区間修正率

Claims (9)

1. 制御対象部位の位置を検出するためのセンサを備えた機械機構部と、前記機械機構部の動作を制御する制御装置と、を備えた機械システムであって、
   前記制御対象部位の目標軌跡又は目標位置に関する動作指令によって前記機械機構部を動作させて、前記センサに基づき検出された前記制御対象部位の位置を前記目標位置に近づけるための補正量を導出する補正制御部と、
   前記動作指令が与えられ、与えられた前記動作指令及び導出された補正量を用いて前記機械機構部の動作を制御する機械制御部と、
   を備え、
   前記補正制御部は、前記機械機構部の動作速度を変更しながら前記補正量を算出し、過去の前記動作速度の変更前後の補正量の差分に対して前記補正量の修正分を求め、前記修正分を前記補正量に加算することで、前記動作速度の変更直後に適用する前記補正量を修正する補正量修正部を有する、
   機械システム。
2. 前記補正制御部は前記動作速度を変更するための動作速度変更率を調整しながら前記補正量を算出し、前記補正量修正部は、過去の前記動作速度変更率の調整前後の補正結果に基づき、前記動作速度変更率の調整直後に適用する前記補正量を修正する、請求項１に記載の機械システム。
3. 前記補正量修正部は、過去の前記動作速度変更率の調整前後の前記補正量と、現在及び過去の動作速度変更率調整量と、に基づき、前記動作速度変更率の調整直後に適用する前記補正量を修正する、請求項２に記載の機械システム。
4. 前記補正制御部は、前記動作速度変更率の調整前後の前記動作速度変更率に基づき、前記動作速度変更率の調整直後に適用する前記補正量の適用時間を修正する適用時間修正部をさらに備える、請求項２又は３に記載の機械システム。
5. 前記補正制御部は、前記補正量修正部及び前記適用時間修正部の少なくとも一方による前記補正量の修正分を考慮して前記動作速度変更率の調整直後に適用する前記補正量を修正し、修正された前記補正量と、修正された前記補正量を適用して発生した振動成分と、に基づき、新たな前記補正量を算出する学習制御を行う、請求項４に記載の機械システム。
6. 前記補正量修正部は、過去の前記動作速度変更率の調整前後の前記補正量の差分に対して現在及び過去の動作速度変更率調整量の比を乗算することで前記補正量の修正分を求め、前記補正量の修正分を前記動作速度変更率の調整時に算出された前記補正量に加算することで前記補正量の修正を行う、請求項２から５のいずれか一項に記載の機械システム。
7. 前記補正量は時系列データであり、前記補正量修正部は、ピーク値を含む区間に前記補正量を分割し、前記区間毎に求めた修正前後の前記補正量の前記ピーク値に基づき前記動作速度変更率の調整直後に適用する前記補正量を前記区間毎に修正する、請求項２から６のいずれか一項に記載の機械システム。
8. 前記補正量修正部は、前記修正前後の前記補正量のピーク値に基づき区間修正率を区間毎に求め、前記区間内の任意の前記補正量に対して前記区間修正率を乗算することで前記補正量を区間毎に修正する、請求項７に記載の機械システム。
9. 前記センサが、加速度センサ、ジャイロセンサ、慣性センサ、力センサ、レーザトラッカ、カメラ、又はモーションキャプチャシステムである、請求項１から６のいずれか一項に記載の機械システム。

Images