(57)【要約】【課題】  ループなどの望ましくない経路動作のない、産業用ロボットなどのマニピュレータの動作を制御する方法および装置を提供する。【解決手段】  姿態（位置および方位）の所与の点列のスプラインによる内挿に関連する、産業用ロボットなどのマニピュレータの動作を制御するための方法において、運動の構成要素は別個にパラメータ化される。このため、マークされたロボット軸の方位へのその後の変更が、ロボットのデカルト運動経路に対して望ましくない影響を与えることはない。この発明はまた、四元数またはオイラー角による方位制御のための好適なアルゴリズムも提案している。【選択図】        図７
2004284004.tif 000002
【特許請求の範囲】
【請求項１】
姿態（位置および方位）の所与の点列がスプラインにより内挿される、産業用ロボットなどのマニピュレータの動作を制御するための方法であって、運動の構成要素が別個にパラメータ化される、マニピュレータの動作を制御するための方法。
【請求項２】
マニピュレータの位置はその方位とは別個にパラメータ化される、請求項１に記載の方法。
【請求項３】
補助軸の動作は、マニピュレータの位置および／または方位とは別個にパラメータ化される、請求項１に記載の方法。
【請求項４】
方位制御は四元数（ｑi，ｉ＝１，…，ｎ）により起こる、請求項１に記載の方法。
【請求項５】
個々の点間の最小限の方位再設定のために、以下のステップ、つまり、
−
【数１】
2004284004.tif 000046
という条件で
【数２】
2004284004.tif 000047
に従った四次元単位球上の各四元数の表現
（ここでα、β（およびｒ＝１）は回転ベクトルｖ＝ｖ（α，β）の球座標を与える）
−以下のステップによる運動最適対（ｖi，ψi）の決定
ａ）すべてのｉ＝１，…，ｎ−１についてｑiTｑi+1≧０となるようなｑiの符号の適合
ｂ）すべてのｉ＝１，…，ｎについて、
【数３】
2004284004.tif 000048
という条件での可能な対（ｖi，ψi）の決定
ｃ）
【数４】
2004284004.tif 000049
という条件でのランダム開始対（ＶiStart，ψiStart）の選択
（ｉＳｔａｒｔεＩを選択する場合、完全に自由に選択可能な回転ベクトルｖiStartは不必要に固定され、それは次善の方位に至り得る。なぜなら開始対はそれ自体もはや適合されないためである）
ｄ）ｊ＝ｉＳｔａｒｔを除くすべてのｊ∈｛１，…，ｎ｝について、ステップｅ）〜ｇ）に従った基準対（ｖi，ψi）から始まる１つの対（ｖj，ψj）の各場合での正確な決定
（ここでｉ∈｛１，…，ｎ｝は隣接指数であり、つまりｉ＝ｊ＋１またはｉ＝ｊ−１であり、また、ｉ＝ｉＳｔａｒｔまたは基準対のいずれかは既にステップｅ）〜ｇ）に従って適合されている）
ｅ）
【数５】
2004284004.tif 000050
となるような、ｋ*，ｈ*∈Ｚの決定
ｆ）次にｊ∈Ｉについて、
【数６】
2004284004.tif 000051
の決定、または
【数７】
2004284004.tif 000052
について
【数８】
2004284004.tif 000053
の決定
ｇ）次に各場合における（ｖj，ψj）の選択
（ここでｊ∈Ｉについて
【数９】
2004284004.tif 000054
またはｊ∈Ｉについて
【数１０】
2004284004.tif 000055
である）
−以下のステップによる球座標表現におけるｖiからの対（αi，βi）の決定
ｈ）すべてのｉ∈Ｉについて、ｖiの標準球座標（αi，βi）の計算
【数１１】
2004284004.tif 000056
ｉ）Ｊ：＝｛ｖj≠（０，０，±１）の条件でｊ∈Ｉ｝，
Ｌ：＝｛ｖj＝（０，０，±１）の条件でｊ∈Ｉ｝の規定、およびしたがってＲ×Ｒからの拡張球座標の規定
−ｉ∈Ｊについて
【数１２】
2004284004.tif 000057
−ｉ∈Ｌについて
【数１３】
2004284004.tif 000058
ｊ）ｊＳｔａｒｔ∈Ｊの条件でのランダム開始対（αjStart，βjStart）の固定
ｋ）ｊ＝ｊＳｔａｒｔを除くすべてのｊ∈Ｉについて、各場合においてステップｌ）およびｍ）に従った拡張極座標の決定
（ここでｉ∈Ｉはｊの近接指数であり、そのためｉとｊとの間にはｋ∈Ｉはなく、また、ｉ＝ｊＳｔａｒｔまたは基準対（αi，βi）のいずれかは既にステップｌ）およびｍ）に従って適合されている）
ｌ）
【数１４】
2004284004.tif 000059
という条件の下での値ｈ*，ｋ*，ｌ*，ｍ*∈Ｚのｊ∈Ｊの決定、または
【数１５】
2004284004.tif 000060
という条件の下での値ｋ*∈Ｚのｊ∈Ｌについての決定
ｍ）次に（αj，βj）の選択
（ここでｊ∈Ｊについて
【数１６】
2004284004.tif 000061
またはｊ∈Ｌについて
【数１７】
2004284004.tif 000062
である）
ｎ）ステップａ）〜ｍ）に従って決定された三重数の数の選択
｛ｉ∈Ｊについて（αi，βi，ψi）
（αi，βi，ψi）＝｛ｉ∈Ｌについて（*，βi，ψi）
｛ｉ∈Ｉについて（*，*，ψi）
（ここで*で示された構成要素はランダムに選択可能である）
ｏ）三重数（αi，βi，ψi）における選択可能な構成要素の適合
−ステップｎ）において選択された三重数（αi，βi，ψi）のスプラインによる内挿
および
−ｑ（α，β，ψ）における内挿関数の使用
が連続して実行される、請求項４に記載の方法。
【請求項６】
（αi，βi，ψi）の自由に選択可能な構成要素の適合は、
｛１≦ｐ＜ｊＭｉｎについてαjMin，
αp＝｛
｛ｊＭａｘ＜ｐ≦ｎについてαjMax
および
｛１≦ｐ＜ｉＭｉｎについてβiMin，
βp＝｛
｛ｉＭａｘ＜ｐ≦ｎについてβiMax
となるよう、
【数１８】
2004284004.tif 000063
を用いて起こる、請求項５に記載の方法。
【請求項７】
すべてのｉ＜ｐ＜ｊについて隣接するｉ，ｊ∈Ｊ、つまり
【数１９】
2004284004.tif 000064
に対して、
【数２０】
2004284004.tif 000065
を選択し、それに応じて、すべてのｉ＜ｐ＜ｊについて隣接するｉ，ｊ∈Ｉ、つまり
【数２１】
2004284004.tif 000066
に対して、
【数２２】
2004284004.tif 000067
を選択する、請求項６に記載の方法。
【請求項８】
方位制御はオイラー角Ａ1，Ｂi，Ｃi（ｉ＝１，…，ｎ）を介した連続した回転により起こり、各場合において、直接連続する回転が互いに垂直な軸のまわりで起こる、請求項１に記載の方法。
【請求項９】
拡張オイラー角Ａi，Ｂi，Ｃi∈Ｒが用いられる、請求項８に記載の方法。
【請求項１０】
最小限の方位再設定のために連続して以下のステップ、つまり、
−以下のステップによる方位（Ａi，Ｂi，Ｃi）の表現
ａ）標準オイラー角（Ａi，Ｂi，Ｃi）の決定
ｂ）Ｉ：＝｛ｉ＝１，…，ｎ｜Ｂi≠π／２＋２ｋπ，ｋ∈Ｚ｝およびｉ∈Ｉについて、
【数２３】
2004284004.tif 000068
の規定
ｃ）Ｊ：＝｛ｉ＝１，…，ｎ｜Ｂi＝π／２＋２ｋπ，ｋεＺ｝およびｉ∈Ｊについて
【数２４】
2004284004.tif 000069
の規定
ｄ）Ｌ：＝｛ｉ＝１，…，ｎ｜Ｂi＝−π／２＋２ｋπ，ｋ∈Ｚ｝およびｉ∈Ｌについて、
【数２５】
2004284004.tif 000070
の規定
ｅ）ｉＳｔａｒｔ∈Ｉ、たとえばｉＳｔａｒｔ＝ｍｉｎ｛ｉ∈Ｉ｝という条件でのランダム開始対（ＡiStart，ＢiStart，ＣiStart）の選択
ｆ）ｊ＝ｉＳｔａｒｔから離れたすべてのｊ∈｛１，…，ｎ）について、ステップｇ）
およびｈ）に従った拡張オイラー角（Ａj，Ｂj，Ｃj）の決定
（ここでｉ∈｛１，…，ｎ｝は近接指数であり、つまりｉ＝ｊ＋１またはｉ＝ｊ−１であり、加えて、ｉ＝ｉＳｔａｒｔまたは基準対（Ａi，Ｂi，Ｃi）のいずれかは既にステップｇ）およびｈ）に従って適合されている）
ｇ）ｊ∈Ｉについて、ｇ*，ｈ*，ｋ*またはｌ*，ｍ*，ｏ*についての最小値を仮定して
【数２６】
2004284004.tif 000071
の決定、および
【数２７】
2004284004.tif 000072
の選択
ｈ）ｊ∈Ｊまたはｊ∈Ｌについて、ｈ，ｋ∈Ｚおよびｔ∈Ｒを条件とした
【数２８】
2004284004.tif 000073
の規定；
【数２９】
2004284004.tif 000074
を条件とした、ｈ*∈Ｚの決定；
ｔに対するｄＡj（ｔ）またはｄＣj（ｋ，ｔ）のゼロ点の計算；
（ここでｔａ0,jはｄＡj（ｔ）のゼロ点であり、ｔｃ0,j（ｋ）はパラメータｋに依存するｄＣj（ｋ，ｔ）のゼロ点である）
ゼロ点の最小間隔が存在するよう、つまり、
【数３０】
2004284004.tif 000075
となるようなｋ*∈Ｚの選択；
ｔａ0,jとｔｃ0,j（ｋ*）との間のｔ*ランダムの選択；
（なぜならそこには
【数３１】
2004284004.tif 000076
の実行が常にあるためである）
および、
【数３２】
2004284004.tif 000077
の選択
−三重数（Ａi，Ｂi，Ｃi）のスプラインによる内挿、および回転マトリックスＲ（Ａ，Ｂ，Ｃ）における内挿関数の使用
が行なわれ、オイラー角Ａ，Ｂ，Ｃは、一般的な性質の制限なく、瞬間的なｚ軸、ｙ軸またはｘ軸のまわりでの回転を示す、請求項９に記載の方法。
【請求項１１】
ｔ*＝１／２（ｔａ0,j＋ｔｃ0,j（ｋ*））が選択される、請求項１０に記載の方法。
【請求項１２】
姿態（位置および方位）の所与の点列をスプラインにより内挿するための内挿ユニットを有する、ロボットなどのマニピュレータの動作を制御するための装置であって、内挿ユニットは内挿中の運動の構成要素の別個のパラメータ化のために構成されている、マニピュレータの動作を制御するための装置。
【請求項１３】
内挿ユニットは、マニピュレータの位置および方位の別個のパラメータ化のために構成されている、請求項１２に記載の装置。
【請求項１４】
内挿ユニットは、一方では補助軸の動作の、他方ではマニピュレータの位置および／または方位の別個のパラメータ化のために構成されている、請求項１２に記載の装置。
【請求項１５】
内挿ユニットは、四元数（ｑi，ｉ＝１，…，ｎ）による方位制御のために設置される、請求項１２に記載の装置。
【請求項１６】
内挿ユニットは、以下のステップ、つまり、
−
【数３３】
2004284004.tif 000078
という条件で
【数３４】
2004284004.tif 000079
に従った四次元単位球上の各四元数の表現
（ここでα、β（およびｒ＝１）は回転ベクトルｖ＝ｖ（α，β）の球座標を与える）
−以下のステップによる運動最適対（ｖi，ψi）の決定
ａ）すべてのｉ＝１，…，ｎ−１についてｑiTｑi+1＞０となるようなｑiの符号の適合
ｂ）すべてのｉ＝１，…，ｎについて、
【数３５】
2004284004.tif 000080
という条件での可能な対（ｖi，ψi）の決定
ｃ）ｉＳｔａｒｔ∈Ｉ：＝｛ｉ＝１，…，ｎ｜ｑi≠（±１，０，０，０）｝という条件でのランダム開始対（ｖiStart，ψiStart）の選択
ｄ）ｊ＝ｉＳｔａｒｔを除くすべてのｊ∈｛１，…，ｎ）について、ステップｅ）〜ｇ）に従った基準対（ｖi，ψi）から始まる１つの対（ｖj，ψj）の各場合での正確な決定
（ここでｉ∈｛１，…，ｎ｝は隣接指数であり、つまりｉ＝ｊ＋１またはｉ＝ｊ−１であり、また、ｉ＝ｉＳｔａｒｔまたは基準対のいずれかは既にステップｅ）〜ｇ）に従って適合されている）
ｅ）
【数３６】
2004284004.tif 000081
となるような、ｋ*，ｈ*∈Ｚの決定
ｆ）次にｊ∈Ｉについて、
【数３７】
2004284004.tif 000082
の決定、または
【数３８】
2004284004.tif 000083
について
【数３９】
2004284004.tif 000084
の決定
ｇ）次に各場合における（ｖj，ψj）の選択
（ここでｊ∈Ｉについて
【数４０】
2004284004.tif 000085
または
【数４１】
2004284004.tif 000086
について
【数４２】
2004284004.tif 000087
である）
−以下のステップによる球座標表現におけるｖiからの対（αi，βi）の決定
ｈ）すべてのｉ∈Ｉについて、ｖiの標準球座標（αi，βi）の計算
【数４３】
2004284004.tif 000088
ｉ）Ｊ：＝｛ｖj≠（０，０，±１）の条件でｊ∈Ｉ｝，
Ｌ：＝｛ｖj＝（０，０，±１）の条件でｊ∈Ｉ｝の規定、およびしたがってＲ×Ｒからの拡張球座標の規定
−ｉ∈Ｊについて
【数４４】
2004284004.tif 000089
−ｉ∈Ｌについて
【数４５】
2004284004.tif 000090
ｊ）ｊＳｔａｒｔ∈Ｊの条件でのランダム開始対（αjStart，βiStart）の固定
ｋ）ｊ＝ｊＳｔａｒｔを除くすべてのｊ∈Ｉについて、各場合においてステップｌ）およびｍ）に従った拡張極座標の単一の決定
（ここでｉ∈Ｉはｊの近接指数であり、そのためｉとｊとの間にはｋ∈Ｉはなく、また、ｉ＝ｊＳｔａｒｔまたは基準対（αi，βi）のいずれかは既にステップｌ）およびｍ）に従って適合されている）
ｌ）
【数４６】
2004284004.tif 000091
という条件の下での値ｈ*，ｋ*，ｌ*，ｍ*∈Ｚのｊ∈Ｊの決定、または
【数４７】
2004284004.tif 000092
という条件の下での値ｋ*∈Ｚのｊ∈Ｌについての決定
ｍ）次に（αj，βj）の選択
（ここでｊ∈Ｊについて
【数４８】
2004284004.tif 000093
またはｊ∈Ｌについて
【数４９】
2004284004.tif 000094
である）
ｎ）ステップａ）〜ｍ）に従って決定された三重数の数の選択
【数５０】
2004284004.tif 000095
（ここで*で示された構成要素はランダムに選択可能である）
ｏ）三重数（αi，βi，ψi）における選択可能な構成要素の適合
−ステップｎ）において選択された三重数（αi，βi，ψi）のスプラインによる内挿
および
−ｑ（α，β，ψ）における内挿関数の使用
を行なうために設置される、請求項１５に記載の装置。
【請求項１７】
内挿ユニットは、
｛１≦ｐ＜ｊＭｉｎについてαjMin，
αp＝｛
｛ｊＭａｘ＜ｐ≦ｎについてαjMax
および
｛１≦ｐ＜ｉＭｉｎについてβiMin，
βp＝｛
｛ｉＭａｘ＜ｐ≦ｎについてβiMax
となるよう、
【数５１】
2004284004.tif 000096
を用いて、（αi，βi，ψi）の自由に選択可能な構成要素を適合するために設置される、
請求項１６に記載の装置。
【請求項１８】
内挿ユニットは、すべてのｉ＜ｐ＜ｊについて隣接するｉ，ｊ∈Ｊ、つまり
【数５２】
2004284004.tif 000097
に対して、
【数５３】
2004284004.tif 000098
を決定するために、および、それに応じて、すべてのｉ＜ｐ＜ｊについて隣接するｉ，ｊ∈Ｉ、つまり
【数５４】
2004284004.tif 000099
に対して、
【数５５】
2004284004.tif 000100
を決定するために設置される、請求項１７に記載の装置。
【請求項１９】
内挿ユニットは、オイラー角Ａi，Ｂi，Ｃiを介した連続した回転による方位制御のために設置され、各場合において、直接連続する回転が互いに垂直な軸のまわりで起こる、請求項１２に記載の装置。
【請求項２０】
内挿ユニットは、拡張オイラー角Ａi，Ｂi，Ｃi∈Ｒの使用のために設置される、請求項１９に記載の装置。
【請求項２１】
内挿ユニットは、以下のステップ、つまり、
−以下のステップによる方位（Ａi，Ｂi，Ｃi）の表現
ａ）標準オイラー角（Ａi，Ｂi，Ｃi）の決定
ｂ）Ｉ：＝｛ｉ＝１，…，ｎ｜Ｂi≠π／２＋２ｋπ，ｋ∈Ｚ｝およびｉ∈Ｉについて
、
【数５６】
2004284004.tif 000101
の規定
ｃ）Ｊ：＝｛ｉ＝１，…，ｎ｜Ｂi＝π／２＋２ｋπ，ｋ∈Ｚ｝およびｉ∈Ｊについて
【数５７】
2004284004.tif 000102
の規定
ｄ）Ｌ：＝｛ｉ＝１，…，ｎ｜Ｂi＝−π／２＋２ｋπ，ｋ∈Ｚ｝およびｉ∈Ｌについて、
【数５８】
2004284004.tif 000103
の規定
ｅ）ｉＳｔａｒｔ∈Ｉという条件でのランダム開始対（ＡiStart，ＢiStart，ＣiStart）の選択
ｆ）ｊ＝ｉＳｔａｒｔから離れたすべてのｊ∈｛１，…，ｎ｝について、ステップｇ）およびｈ）に従った拡張オイラー角（Ａj，Ｂj，Ｃj）の決定
（ここでｉ∈｛１，…，ｎ｝は近接指数であり、つまりｉ＝ｊ＋１またはｉ＝ｊ−１であり、加えて、ｉ＝ｉＳｔａｒｔまたは基準対（Ａi，Ｂi，Ｃi）のいずれかは既にステップｇ）およびｈ）に従って適合されている）
ｇ）ｊ∈Ｉについて、ｇ*，ｈ*，ｋ*またはｌ*，ｍ*，ｏ*についての最小値を仮定して
【数５９】
2004284004.tif 000104
の決定、および
【数６０】
2004284004.tif 000105
の選択
ｈ）ｊ∈Ｊまたはｊ∈Ｌについて、ｈ，ｋ∈Ｚおよびｔ∈Ｒを条件とした
【数６１】
2004284004.tif 000106
の規定；
【数６２】
2004284004.tif 000107
を条件とした、ｈ*∈Ｚの決定；
ｔに対するｄＡj（ｔ）またはｄＣj（ｋ，ｔ）のゼロ点の決定；
（ここでｔａ0,jはｄＡj（ｔ）のゼロ点であり、ｔｃ0,j（ｋ）はｄＣj（ｋ，ｔ）のゼロ点である）
ゼロ点の間隔が最小であるよう、つまり、
【数６３】
2004284004.tif 000108
となるようなｋ*∈Ｚの選択；
ｔａ0,jとｔｃ0,j（ｋ*）との間のｔ*ランダムの選択；および、
【数６４】
2004284004.tif 000109
の選択
−三重数（Ａi，Ｂi，Ｃi）のスプラインによる内挿、および回転マトリックスＲ（Ａ，Ｂ，Ｃ）における内挿関数の使用
の連続的な実行のために設置される、請求項２０に記載の装置。
【請求項２２】
内挿ユニットは、ｔ*＝１／２（ｔａ0,j＋ｔｃ0,j（ｋ*））の選択のために設置される、請求項２１に記載の装置。
【発明の詳細な説明】
【技術分野】
【０００１】
発明の分野
この発明は、姿態（位置および方位）の所与の点列のスプラインによる内挿を含む、産業用ロボットなどのマニピュレータの動作を制御するための方法、および、この発明に従った方法を実行するためにより特定的に好適である装置に関する。
【背景技術】
【０００２】
発明の背景
制御されたマニピュレータ、たとえば産業用ロボットの動作は一般に、多次元空間における予め設定された点列によって決定される。多軸の産業用ロボットの場合、これらの点の各々は、位置のデカルト座標と、三次元のユークリッド空間における方位に対する座標と、随意で補助軸の座標とを取り入れている。
【０００３】
原則として、ロボット動作は厳密には予め定められておらず、その代わり単に数々の固定点を有しており、それらは実行されるべき操作、たとえば加工物を取上げることおよび降ろすこと、障害物を回避することなどに基づいている。固定点は、対応する姿態を開始し保持することによって、動作制御の目的のために用いられるロボット制御へ手動で教えられ、次に、実行されるロボット動作が適合されなければならない点列として利用可能となる。つまり、すべての固定点は、結果として生じる経路曲線を明確に規定する。
【０００４】
点列の代わりに役に立つ機能説明を得るため、および、動きの全構成要素におけるロボット動作の連続性を可能とするために、点列は一般に内挿される。内挿により得られる点列の機能説明は数々の目的にかなう。第１に、データ量が圧縮され、第２に、点列に含まれない値に関する情報をたとえば外挿により得ることが可能である。最後に、より高い評価率が起こる。なぜなら、関数の評価はしばしば、表における参照よりも早く実施可能であるためである。
【０００５】
前述の点列を内挿するための動作制御を工業的に実践する場合、特に得られる曲線の円滑さに関して特化された要求を満たすスプライン関数と、その一次導関数の連続性および微分可能性と、その二次導関数の連続性とがしばしば用いられる。経路曲線の一次および二次導関数は、曲線に沿って動かされる物体の速度または加速度で識別可能であるため、前記特徴は産業用ロボットの効率的な動作制御にとって非常に重要である。
【０００６】
産業用ロボットのスプライン内挿を用いた動作制御のための公知の方法が、ホルシュ（Horsh）およびユットラー（Juttler）による論文（「コンピュータ支援設計（Computer-Aided Design）」、第３０巻、２１７−２２４頁、１９９８年）に記載されている。ロボット動作の軌跡は、好適な指数または次数の多項式によって区分的に表現される。
【０００７】
産業用ロボットのスプライン内挿による動作制御のためのその公知の方法では、方位、デカルト位置、およびおそらくは補助軸の位置への変更が大幅に異なる形で起こる（たとえば方位の大きな変更に対する最小限のデカルト変更）内挿されるべき点列の区分において、望ましくない不経済な動作経路が起こり得る、という欠点が判明している。特に、そのような場合、動作ループが起こり得る。つまり、ロボット動作の１つ以上の構成要素が後方および前方への非効率な動きを局所的に招く。なぜなら、点列のこの特定の区分における動作誘導は、動きの他の構成要素の著しい変更によって支配されるためである。また、動きの個々の構成要素をその後著しく変更すること、たとえば強力な方位再設定をその後プログラミングすることが、動きの他の構成要素の挙動に影響を与える可能性があり、
そのため、たとえば再設定の結果、経路のデカルト軌跡も変わって、それがユーザに受け入れられないということは、本質的に固定された動作経路にとって不利であると考えられる。
【０００８】
たとえばスプラインの形でのデカルト動作の方位誘導のため、四元数がしばしば用いられる。四元数とは、実数のスカラ部および複素数の３ベクトルとして表現可能な四重数の形の一般化複素数である。四元数は回転のマトリックス表現と密接に関連しており、したがって、コンピュータアニメーションでの方位誘導のために、およびロボット制御の目的のために好んで使用される。したがって、ロボット方位の点列は、四元数空間における四次元スプラインによって表現される。
【０００９】
これに関連して方位動作の最適で均一なパラメータ化を得るために、四元数空間におけるスプラインはできるだけ単位球の表面上にあるべきである。このようにしてのみ、単位球上の四元数スプラインの射影の均一なパラメータ化を達成することが可能である。なぜなら、四元数を回転マトリックスへ変換する際、各四元数は標準化されなければならないためである。単位球上への射影中の四次元の四元数スプラインの３自由度への減少（四元数スプラインまたは個々の四元数の標準化）を通して、標準化されたスプラインの歪んだパラメータ化という危険が生じ、それは次に、このように制御されるロボットの望ましくない動作挙動をもたらす可能性がある。
【００１０】
この公知のスプライン内挿方法には、しばしば運動パラメータｔと呼ばれ、時間座標τに関連している共通のパラメータによる動作またはスプラインのパラメータ化が存在する（ホルシュおよびユットラー、２２１頁の左上を参照）。所与の点列Ｐi（ｉ＝１，…，ｎ）について、パラメータ間隔［ｔi，ｔi+1］の長さは一般に、関連する点Ｐi，Ｐi+1の間隔に比例すると考えられる。前記間隔内に、デカルト距離と、方位へのおよび随意で補助軸への変更との双方が導入される。しかしながら、単一のパラメータのみによるパラメータ化は前述の欠点をもたらすということがわかっている。
【非特許文献１】ホルシュおよびユットラー、「コンピュータ支援設計」、第３０巻、２１７−２２４頁、１９９８年
【発明の開示】
【発明が解決しようとする課題】
【００１１】
この発明の課題は、ループなどの望ましくない不経済な経路動作がないように前述の種類の方法および装置をさらに開発することである。加えて、動作または運動制御は、点から点への方位再設定が最小限となるように起こるべきである。
【課題を解決するための手段】
【００１２】
発明の概要
前述の種類の方法の場合、設定された課題は、運動の構成要素が別個にパラメータ化されるという理由で、この発明によって解決される。前述の種類の装置では、内挿中の運動の構成要素の別個のパラメータ化のために構成された内挿装置をそれが有しているという理由で、設定された課題が解決される。
【００１３】
この発明によれば、たとえばデカルト位置および方位など互いに影響を及ぼしてはならないＰiの全構成要素の別個のパラメータ化を介して、前述の欠点が回避される。
【００１４】
この発明のさらなる展開によれば、マニピュレータのデカルト位置は、関連する方位とは別個にパラメータ化されるかまたはパラメータ化可能である。
【００１５】
制御すべきマニピュレータが補助軸を有する場合、この発明のさらなる展開によれば、
補助軸の動作は、マニピュレータの位置および／または方位とは別個にパラメータ化されるかまたはパラメータ化可能である。
【００１６】
空間での回転動作の説明における四元数の公知の好適な特徴を利用するため、この発明の好ましい展開によれば、方位誘導は四元数（ｑi，ｉ＝１，…，ｎ）により起こり、この発明に従った装置はそのような方位誘導のために設置される。
【００１７】
また、これに代えて、この発明のさらなる展開によれば、方位誘導はオイラー角Ａ1，Ｂi，Ｃi（ｉ＝１，…，ｎ）を用いた連続した回転により起こり、この発明に従った装置はそのような方位誘導のために設置され、各場合において、直接連続する回転が互いに垂直な軸のまわりで起こる。
【００１８】
好ましくは、これに関連して、Ａi，Ｂi，Ｃi∈Ｒ（Ｒ：実数の量）の延長された、または拡張されたオイラー角が用いられる。
【発明の効果】
【００１９】
このように、この発明によれば、方位の均一なパラメータ化が常に確実とされ、その表現のために３自由度しか必要とされない。これに関連して、標準オイラー角はこの発明により合計Ｒ3へ拡張され、それは最小限の方位再設定を確実にする。驚くべきことに、オイラー角の規定範囲の制限を解除することによってはるかにより経済的な動作経路が決定可能であることがわかっている。
【００２０】
この発明のさらなる利点および特徴は、特許請求の範囲から、および次に続く添付図面に関する特定の実施例の説明から収集可能である。
【発明を実施するための最良の形態】
【００２１】
図面の詳細な説明
簡略化された二次元的表現において、図１ａは、産業用ロボットの運動についてのデカルト運動軌跡Ｂを示す。２つのデカルト座標ｘ（ｔ），ｙ（ｔ）を見ることができるが、それらは共通のパラメータｔに依存しており、それは一般に時間座標に関連している。Ｓで経路軌跡Ｂはループを有する。つまり、パラメータｔの関連する間隔にわたって、ロボットは、ｘおよび／またはｙ方向において、一般に不経済なために望ましくない前方および後方への動作を行なうが、それは実際には回避されるべきである。曲線Ｂは、多次元空間におけるロボット動作の経路を与える点Ｐｉの予め定められた列を内挿する。点Ｐiは動作制御を担当するロボット制御へ教えられることが可能であり、または、これは操縦プロセス中にたとえばセンサ情報などからオンラインで得られる。ロボット動作中にＰiを内挿するため、標準スプラインが用いられる（ホルシュおよびユットラー、上記引用文中）。以下、
【００２２】
【数１】
2004284004.tif 000003
【００２３】
は（ｍ個の補助軸Ｅ１〜Ｅｍを有する６軸ロボットについて）内挿されるべきロボット位置である。このため、求められるものは、所望の軌跡のスプラインＳｐのパラメータ化、つまり、
すべてのｉ＝１，…，ｎおよびｔi＜ｔ2＜ｔ3＜…＜ｔnについてＳｐ（ｔi）＝Ｐi
であり、それは最適な円滑曲線をもたらす。好ましい軌跡を得るため、パラメータ化間隔［ｔi，ｔi+1］の長さは一般に、関連する点Ｐi，Ｐi+1の間隔に比例して選択される。前
記間隔内に、デカルト距離と、方位変更およびおそらくは補助軸の変更との双方が導入されなければならない。この手順は望ましくないループを回避するために意図されている。
【００２４】
スプラインは一般に、接合点での多項式の選択可能な特徴（たとえば、三次または三乗関数を有する三乗スプライン内挿の場合、一次導関数および／または連続的な二次導関数の連続性と微分可能性）を有する断片的な多項式内挿である。
【００２５】
図１ａにおいて、方位、デカルト位置およびおそらくは補助軸への修正が大幅に異なる（たとえば大きな方位変更を同時に有する最小限のデカルト修正）区分［Ｐi，Ｐi+1］で示されるように、単一のパラメータｔを用いたパラメータ化は、方位誘導およびデカルト位置にとって同時には好適でない長さのパラメータ間隔［ｔi，ｔi+1］をもたらし得る。そのような場合、ループは依然として起こり得る（図１ａ）。
【００２６】
その後プログラムされ、マークされた方位の再設定も、共通パラメータ間隔［ｔi，ｔi+1］を変更、たとえば延長して、デカルト軌跡を変更することができるが、それは実際には受け入れられない。
【００２７】
「教えられた」デカルト位置（Ｘ，Ｙ，Ｚ）に加え、点Ｐｉの所与の列を単一の連続する曲線を介して内挿する場合、（たとえばオイラー角（Ａ，Ｂ，Ｃ）および対応する補助軸位置（Ｅ１，Ｅ２，…）により表現される）方位も内挿され、同時に、点から点への方位再設定が最小限に抑えられる。加えて、方位への単なる変更がデカルト曲線または補助軸軌跡を修正してはならず、逆もまた同様である。このため、この発明は、互いに影響を及ぼすことができないＰｉの全構成要素の別個のパラメータ化を提案している。たとえば、デカルト位置、方位（オイラー角または四元数の説明から独立して）および異なる補助軸を別個にパラメータ化することが可能であり、たとえば以下のようである。
【００２８】
【数２】
2004284004.tif 000004
【００２９】
単調に増加する中間パラメータ化
すべてのｉ＝１，…，ｎについてｏ（ｔi）＝ｏiを満たすｏ（ｔ）
すべてのｉ＝１，…，ｎ，ｋ＝１，…，ｍについてｅｋ（ｔi）＝ｅｋiを満たすｅｋ（ｔ）
を介して所望の内挿特性が保証され、図１ｂに示す軌跡が得られて、以下の所望の要件を満たす。
【００３０】
【数３】
2004284004.tif 000005
【００３１】
所与の次数の微分可能性のために中間パラメータ化の単調さを維持するために、たとえば内挿スプラインを利用することが可能であり、それらは、スプラインが関連する多角形
の進路に近接してランダムに強制され得るさらなるパラメータを含んでいる（たとえば、ヘルムート・スパース（Helmuth Spath）、『スプラインアルゴリズム（Spline Algorithms）』、第４版、Ｒ．オルデンブルグ出版社（R. Oldenbourg Verlag）、１９８６年、「一般化三乗スプライン関数（Generalized Cubic Spline Functions）」を参照）。
【００３２】
１つの点での単なる方位変更はしたがって、方位のパラメータ化または中間パラメータ化のみを変更するが、デカルト経路または補助軸のそれを変更することはない。
【００３３】
方位誘導は、四元数またはオイラー角を用いて起こり得る。
【００３４】
１．四元数を用いた方位誘導
空間における各方位再設定は、好適なベクトルｖ∈Ｒ3（｜ｖ｜＝１という条件で）および角度ψについての回転によって表現され得る。この対（ベクトル，角度）と関連する四元数ｑとの間には、以下の関連が存在する。
【００３５】
【数４】
2004284004.tif 000006
【００３６】
このため、−ｖによる−ψの回転は、同じ方位に至るだけでなく、同じ四元数にも至る。
【００３７】
しかしながら、ｖによる反対方向、つまり−（２π−ψ）の回転も当然同じ方位に至るが、関連する四元数として−ｑが得られる（符号は回転方向に関する情報を含む）。対（回転ベクトル，角度）と関連する四元数との間には、以下の関連がしたがって存在する。
【００３８】
【数５】
2004284004.tif 000007
【００３９】
単位四元数ｑ＝（±１，０，０，０）についてψ＝０または２π、およびｓｉｎ（１／２ψ）＝０であるため、ベクトルｖはランダムに選択可能である。単位円上の残りの四元数すべてについて、ψ≠０またはψ≠２πという条件で２つの対（ｖ，ψ）、（−ｖ，−ψ）を決定することが常に可能である。
【００４０】
方位マトリックスへ変換する際、四元数は標準化される。つまり、ゼロとは異なる或る四元数の正の倍数すべてが、同じ方位マトリックスおよび回転方向に至る。
【００４１】
四元数空間における単位球の表面上に常に配置され、そこで方位スプラインの次元が一次元分（４から３へ）減少される四元数スプラインによって絶対的に均一にパラメータ化された方位制御を発見するために、この発明は、スプラインの決定のために連続して以下のステップを行なうことを提案している（以下、Ｎは自然数の量を示し、Ｚは整数の量を示す）。
【００４２】
−
【００４３】
【数６】
2004284004.tif 000008
【００４４】
という条件で
【００４５】
【数７】
2004284004.tif 000009
【００４６】
に従った四次元単位球上の各四元数の表現
ここでα、β（およびｒ＝１）は回転ベクトルｖ＝ｖ（α，β）の球座標を与える。
【００４７】
−以下のステップによる運動最適対（ｖi，ψi）の決定
ａ）すべてのｉ＝１，…，ｎ−１についてｑiTｑi+1≧０となるようなｑiの符号の適合
ｂ）すべてのｉ＝１，…，ｎについて、
【００４８】
【数８】
2004284004.tif 000010
【００４９】
という条件での可能な対（ｖi，ψi）の決定
ｃ）
【００５０】
【数９】
2004284004.tif 000011
【００５１】
という条件でのランダム開始対（ＶiStart，ψiStart）の選択
【００５２】
【数１０】
2004284004.tif 000012
【００５３】
を選択する場合、完全に自由に選択可能な回転ベクトルｖiStartは不必要に固定され、それは次善の方位に至り得る。なぜなら開始対はそれ自体もはや適合されないためである。
【００５４】
ｄ）ｊ＝ｉＳｔａｒｔを除くすべてのｊ∈｛１，…，ｎ｝について、ステップｅ）〜ｇ）に従った基準対（ｖi，ψi）から始まる１つの対（ｖj，ψj）の各場合での正確な決定
ここでｉ∈｛１，…，ｎ｝は隣接指数であり、つまりｉ＝ｊ＋１またはｉ＝ｊ−１である。また、ｉ＝ｉＳｔａｒｔまたは基準対のいずれかは既にステップｅ）〜ｇ）に従って適合されている。
【００５５】
ｅ）
【００５６】
【数１１】
2004284004.tif 000013
【００５７】
となるような、ｋ*，ｈ*∈Ｚの決定
ｆ）次にｊ∈Ｉについて、
【００５８】
【数１２】
2004284004.tif 000014
【００５９】
の決定、またはｊ∈Ｉについて
【００６０】
【数１３】
2004284004.tif 000015
【００６１】
の決定
ｇ）次に各場合における（ｖj，ψj）の選択
ここで
【００６２】
【数１４】
2004284004.tif 000016
【００６３】
について
【００６４】
【数１５】
2004284004.tif 000017
【００６５】
または
【００６６】
【数１６】
2004284004.tif 000018
【００６７】
について
【００６８】
【数１７】
2004284004.tif 000019
【００６９】
である。
【００７０】
ｖjは原則として、
【００７１】
【数１８】
2004284004.tif 000020
【００７２】
についてランダムに選択可能である。特定の選択（ｖj＝ｖi）は（すべての（ｖj，ψj）が適合されるまで）単に暫定的であり、ステップｄ）で完全な基準対が常に存在すること、および、完全に選択可能な回転ベクトルが無視される（つまり飛ばされる）ことを保証する。そのため最終的には、自由には選択できない隣接する回転ベクトル間の間隔の最小化が常に存在する。
【００７３】
すべての対（ｖi，ψi）がステップｅ）〜ｇ）に従って適合されると、自由に選択可能なｖi（ｉ∈Ｉという条件で）はもはや必要とされず、削除または取消しできる。
【００７４】
−以下のステップによる球座標表現におけるｖiからの対（αi，βi）の決定
ｈ）すべてのｉ∈Ｉについて、ｖiの標準球座標（αi，βi）の決定
【００７５】
【数１９】
2004284004.tif 000021
【００７６】
ｉ）Ｊ：＝｛ｖj≠（０，０，±１）の条件でｊ∈Ｉ｝，
Ｌ：＝｛ｖj＝（０，０，±１）の条件でｊ∈Ｉ｝の規定、およびしたがってＲ×Ｒからの拡張球座標の規定
−ｉ∈Ｊについて
【００７７】
【数２０】
2004284004.tif 000022
【００７８】
−ｉ∈Ｌについて
【００７９】
【数２１】
2004284004.tif 000023
【００８０】
（ｉ∈Ｌについてβi＝±π／２であるため、（αi（ｘ）＋π，π−βi（ｋ））はさらなる解を提供しない。）
ｊ）ｊＳｔａｒｔ∈Ｊ、たとえばｊＳｔａｒｔ＝ｍｉｎ｛ｊ∈Ｊ｝などの条件でのランダム開始対（αiStart，βiStart）の固定
（ｊＳｔａｒｔ∈Ｌは好ましくない。なぜなら、自由に選択可能なパラメータαjはその場合前もって固定されており、それは次善の解をもたらすためである。）
ｋ）各場合においてｊ＝ｊＳｔａｒｔを除くすべてのｊ∈Ｉについて、ステップｌ）およびｍ）に従った拡張極座標の決定
ここでｉ∈Ｉはｊの近接指数であり、そのためｉとｊとの間にはｋ∈Ｉはない。また、ｉ＝ｊＳｔａｒｔまたは基準対（αi，βi）のいずれかは既にステップｌ）およびｍ）に従って適合されている。
【００８１】
ｌ）
【００８２】
【数２２】
2004284004.tif 000024
【００８３】
という条件の下での値ｈ*，ｋ*，ｌ*，ｍ*∈Ｚのｊ∈Ｊの決定、または
【００８４】
【数２３】
2004284004.tif 000025
【００８５】
という条件の下での値ｋ*∈Ｚのｊ∈Ｌについての決定
ｍ）次に（αj，βj）の選択
ここでｊ∈Ｊについて
【００８６】
【数２４】
2004284004.tif 000026
【００８７】
またはｊ∈Ｌについて
【００８８】
【数２５】
2004284004.tif 000027
【００８９】
である。ｊ∈Ｌについて、αjは原則としてランダムに選択可能である。
【００９０】
特定の選択（αj＝αi）は（すべての（αj，βj）が適合されるまで）単に暫定的であり、ステップｌ）で完全な基準対が常に存在すること、および、自由に選択可能なα角度が無視される（つまり飛ばされる）ことを保証しており、そのため或るα角度から次の（隣接する）自由には選択できないα角度への間隔が最小限に抑えられる。
【００９１】
すべての対（αj，βj）がステップｌ）およびｍ）に従って適合されると、自由に選択可能なαj（ｊ∈Ｌという条件で）はもはや必要とされず、削除可能である。
【００９２】
ｎ）ステップａ）〜ｍ）に従って決定された三重数の数の選択
｛ｉ∈Ｊについて（αi，βi，ψi）
（αi，βi，ψi）＝｛ｉ∈Ｌについて（*，βi，ψi）
｛ｉ∈Ｉについて（*，*，ψi）
ここで*で示された構成要素はランダムに選択可能である。
【００９３】
ｏ）三重数（αi，βi，ψi）における選択可能な構成要素の適合
−ステップｎ）において選択された三重数（αi，βi，ψi）のスプラインによる内挿
および
−ｑ（α，β，ψ）における内挿関数の使用
このように決定されたロボット動作のための内挿された経路曲線は、空間における方位などの運動の個々の構成要素への変更がその後起こった場合でも、図１ａに示す望ましくないループ形成をより特定的に回避する。なぜなら、そのような運動の構成要素は、この発明によれば、各場合においてそれら独自のパラメータ化を有しており、それは運動の他の構成要素へ否定的な影響を全く与えることなく適合可能であるためである。
【００９４】
（αi，βi，ψi）の自由に選択可能な構成要素の適合は、上述のアルゴリズムのさらなる展開に従い、
｛１≦ｐ＜ｊＭｉｎについてαjMin，
αp＝｛
｛ｊＭａｘ＜ｐ≦ｎについてαjMax
および
｛１≦ｐ＜ｉＭｉｎについてβiMin，
βp＝｛
｛ｉＭａｘ＜ｐ≦ｎについてβiMax
となるよう、
【００９５】
【数２６】
2004284004.tif 000028
【００９６】
を用いて起こる。
【００９７】
すべてのｉ＜ｐ＜ｊについて隣接するｉ，ｊ∈Ｊ、つまりｐ∈Ｊに対して、
【００９８】
【数２７】
2004284004.tif 000029
【００９９】
を選択し、それに応じて、すべてのｉ＜ｐ＜ｊについて隣接するｉ，ｊεＩ、つまりｐ∈Ｉに対して、
【０１００】
【数２８】
2004284004.tif 000030
【０１０１】
を選択することも可能である。
【０１０２】
この発明に従った四元数に基づく運動制御を、以下の表１に、およびフローチャートによる図５に簡潔に示す。
【０１０３】
【表１】
2004284004.tif 000031
【０１０４】
２．オイラー角を用いた方位制御または誘導
定義により「古典的な」オイラー角は［−π，π］×［−π／２，π／２］×［−π，π］というＲ3の一部に制限されているものの、この発明によれば、すべてのオイラー角制限は撤回される。Ｒ×Ｒ×Ｒ（Ｒ3）からの「拡張オイラー角」を用いた方位表現の可能な変形すべての中で、最小限の方位再設定につながるものが求められる。
【０１０５】
各場合において合同で回転されるシステムにおける軸のまわりを回転する角度Ａ、ＢおよびＣによる３つの回転を連続して行なう場合、前記角度はオイラー角として言及される。回転がそのまわりで起こる軸の順序とは独立して、各方位について１２の異なる種類のオイラー角、たとえばＸ−Ｙ−Ｚオイラー角、Ｘ−Ｙ−Ｘオイラー角などがある。
【０１０６】
Ａ、ＢおよびＣがたとえばＺ−Ｙ−Ｘオイラー角である場合、総回転Ｒは以下の式から得られる。
【０１０７】
【数２９】
2004284004.tif 000032
【０１０８】
ここでＲｏｔ（ｖ，ω）は、ｖについての角度ωの回転を示す。
【０１０９】
以下の考察はオイラー角全種類へ移すことができる。このため、無制限に、Ｚ−Ｙ−Ｘオイラー角への限定があり得る。この場合、目標方位は以下の理由により開始方位（基準システムＩ）から得られる。
【０１１０】
−基準システムＩでは、回転はＺ軸のまわりでＡ起こる（結果：基準システムＩ′）。
【０１１１】
−ダッシュが１つついた基準システムＩ′では、回転はｙ′軸のまわりでＢ起こる（結果：基準システムＩ″）。
【０１１２】
−ダッシュが２つついた基準システムＩ″では、回転はｘ″軸のまわりでＣ起こる（結果：目標方位Ｒ）。
【０１１３】
これは図２ａにおいて、Ｚ−Ｙ−Ｘオイラー角について例示的に示されている。はじめに、基準システムＩはＺ軸のまわりでのＡ＝π／４の回転（正の反時計回りの回転方向）によって変換され、基準システムＩ′へ変換される。その後、新しく規定されたｙ′軸のまわりでのＢ＝π／３の回転により、基準システムＩ′は新しい基準システムＩ″へ変換される。最後に、軸ｘ″のまわりでのＣ＝π／４の回転により、これは所望の目標方位となる。
【０１１４】
基準システムＩ″のｘ″軸のみを考慮すると（または目標方位の場合）、角度ＡおよびＢは、開始方位に対するそれらの球座標を明確に表わす。角度対（Ａ＋π，π−Ｂ）で同じｘ″が得られる。
【０１１５】
しかしながら、この場合、ｙ″およびｚ″は、（Ａ，Ｂ，Ｃ）での場合に対して角度π分回転される。このため、オイラー角（Ａ＋π，π−Ｂ，Ｃ＋π）を用いた場合、同じ目標方位が得られる。このため、前述の例では、（π／４，π／３，π／４）の代わりに三重数（５／４π，２／３π，５／４π）となる。これを図２ｂ）に示す。
【０１１６】
この発明によれば、そのようなオイラー角適合は、最小限の方位再設定のために連続して以下のステップが行なわれ、一般的な性質の制限なく、オイラー角Ａ，Ｂ，Ｃが瞬間的なｚ軸、ｙ軸またはｘ軸のまわりでの回転を示すために引起こされる。
【０１１７】
−以下のステップによる方位（Ａi，Ｂi，Ｃi）の表現
ａ）標準オイラー角（Ａi，Ｂi，Ｃi）の決定
ｂ）Ｉ：＝｛ｉ＝１，…，ｎ｜Ｂi≠±π／２＋２ｋπ，ｋ∈Ｚ｝およびｉ∈Ｉについて、
【０１１８】
【数３０】
2004284004.tif 000033
【０１１９】
の規定
ｃ）Ｊ：＝｛ｉ＝１，…，ｎ｜Ｂi＝π／２＋２ｋπ，ｋ∈Ｚ｝およびｉ∈Ｊについて、
【０１２０】
【数３１】
2004284004.tif 000034
【０１２１】
の規定
（ｉ∈Ｊについて、代替的な表現（Ａi（ｔ）＋π，π−Ｂi（ｈ），Ｃi（ｋ，ｔ）＋π）は新しい解を提供しない。）
ｄ）Ｌ：＝｛ｉ＝１，…，ｎ｜Ｂi＝−π／２＋２ｋπ，ｋ∈Ｚ｝およびｉ∈Ｌについて、
【０１２２】
【数３２】
2004284004.tif 000035
【０１２３】
の規定
（ｉ∈Ｌについて、（Ａi（ｔ）＋π，π−Ｂi（ｈ），Ｃi（ｋ，ｔ）＋π）という表現は新しい解を提供しない。）
ｅ）ｉＳｔａｒｔ∈Ｉ、たとえばｉＳｔａｒｔ＝ｍｉｎ｛ｉ∈Ｉ｝という条件でのランダム開始対（ＡiStart，ＢiStart，ＣiStart）の選択
ｉＳｔａｒｔ∈Ｊ∪Ｌは次善の方位制御を与えるであろう。なぜなら、開始対はそれ自体もはや適合されず、したがってｉＳｔａｒｔ∈Ｊ∪Ｌについて自由に選択可能なパラメータｔは固定された形で予め定められなければならないからである。
【０１２４】
ｆ）ｊ＝ｉＳｔａｒｔから離れたすべてのｊ∈｛１，…，ｎ）について、ステップｇ）およびｈ）に従った拡張オイラー角（Ａj，Ｂj，Ｃj）の決定
ここでｉ∈｛１，…，ｎ｝は近接指数であり、つまりｉ＝ｊ＋１またはｉ＝ｊ−１であり、加えてｉ＝ｉＳｔａｒｔまたは基準対（Ａi，Ｂi，Ｃi）のいずれかは既にステップｇ）およびｈ）に従って適合されている。
【０１２５】
ｇ）ｊ∈Ｉについて、ｇ*，ｈ*，ｋ*またはｌ*，ｍ*，ｏ*についての最小値を仮定して
【０１２６】
【数３３】
2004284004.tif 000036
【０１２７】
の決定、および
【０１２８】
【数３４】
2004284004.tif 000037
【０１２９】
の選択
ｈ）ｊ∈Ｊまたはｊ∈Ｌについて、ｈ，ｋ∈Ｚおよびｔ∈Ｒを条件とした
【０１３０】
【数３５】
2004284004.tif 000038
【０１３１】
の規定；
【０１３２】
【数３６】
2004284004.tif 000039
【０１３３】
を条件とした、ｈ*∈Ｚの決定；
ｔに対するｄＡj（ｔ）またはｄＣj（ｋ，ｔ）のゼロ点の計算；
ここでｔａ0,jはｄＡj（ｔ）のゼロ点であり、ｔｃ0,j（ｋ）はパラメータｋに依存するｄＣj（ｋ，ｔ）のゼロ点である。
【０１３４】
ゼロ点の最小間隔が存在するよう、つまり、
【０１３５】
【数３７】
2004284004.tif 000040
【０１３６】
となるようなｋ*∈Ｚの選択；
ｔａ0,jとｔｃ0,j（ｋ*）との間のｔ*ランダムの選択；
なぜならそこには
【０１３７】
【数３８】
2004284004.tif 000041
【０１３８】
の実行が常にあるためである。および、
【０１３９】
【数３９】
2004284004.tif 000042
【０１４０】
の選択
−三重数（Ａi，Ｂi，Ｃi）のスプラインによる内挿、および回転マトリックスＲ（Ａ，Ｂ，Ｃ）における内挿関数の使用
上述のアルゴリズムの好ましい展開によれば、パラメータｔ*はｔ*＝１／２（ｔａ0,j＋ｔｃ0,j（ｋ*））に従って選択される。これはＡ角度およびＣ角度における等量の方位変更をもたらす。
【０１４１】
拡張オイラー角の決定についての上述のアルゴリズムの利点を、図３および４に示す以下の例により説明する。
【０１４２】
Ｚ−Ｙ−Ｘオイラー角の２つの三重数がある。
【０１４３】
【数４０】
2004284004.tif 000043
【０１４４】
これらの値が互いに線形に、つまり線形内挿によって誘導されている場合、関連する座標回転について図３に示すような構成が存在する。
【０１４５】
図３は、初めの基本システムＩがいかに、各座標軸についての角度の全体的変更の線形内挿によって、目標方位Ｒへ変換されるかを示す。古典的なオイラー角についての値の範囲の制限の結果、ある状況では、図３において座標軸Ｚの動きに関して明らかであるように、個々の座標軸についてのうねる動きが存在する。図３の下方区域ではその規定範囲の境界が達しており、次により小さい値の範囲へ戻り、それが前記うねりを引起こして、図
１ａに従ったループ形成と同様にロボット用方位制御の不経済な形を表わしており、したがって回避されなければならない。
【０１４６】
代わりに（初期方位から開始して）適合されたオイラー三重数の決定が起こる場合、以下の式が得られる。
【０１４７】
【数４１】
2004284004.tif 000044
【０１４８】
図４に示すように、関連する回転マトリックスはしたがって直感的に最短の経路を通って互いへと移り、そのためロボット動作ははるかにより経済的な経路をたどり、それはマニピュレーションプロセスに対する持続時間および空間要件に関して肯定的な影響を及ぼす。図３の場合とは異なり、特徴的なうねりは回避される。
【０１４９】
この発明に従った拡張オイラー角による動作制御を、表２に、およびフローチャートによる図６に簡略な形で示す。
【０１５０】
【表２】
2004284004.tif 000045
【０１５１】
図７は、ブロック図により、この発明に従った、上述の方法に従ってマニピュレータの動作を制御するのに好適な装置の可能な一展開を示している。マニピュレータは、関連する制御手段２を有する産業用ロボット１の形で示されており、制御手段２は、この発明によれば、特にコンピューティング手段３を有し、それはコンパイラ／インタープリタ４および内挿ユニット５の形で設定されており、それを介して、動作制御のための前述のアルゴリズムが制御の観点から実行可能である。なぜなら、コンピューティング手段３はロボット１の駆動手段６上の制御手段２内で作動するためである。手動で操作可能な制御ユニ
ット８により、オペレータ７は制御手段２における、特にコンピューティング手段３におけるシーケンスを、たとえばロボット１の方位再設定のその後のプログラミングによって実行できる。
【図面の簡単な説明】
【０１５２】
【図１】図１ａは先行技術に従った、望ましくないループ形成を有する二次元でのロボット動作の経路曲線を示す図である。図１ｂはこの発明に従った、ループ形成のない二次元でのロボット動作の経路曲線を示す図である。
【図２】図２ａはオイラー角に関する説明における回転を示す図である。図２ｂはオイラー角に関する異なる説明における、図２ａに従った回転を示す図である。
【図３】標準オイラー角を用いた表現における回転動作を示す図である。
【図４】延長または拡張オイラー角を用いた図３の回転を表わす図である。
【図５】四元数アルゴリズムを用いた場合のこの発明に従った方法のフローチャートである。
【図６】オイラー角アルゴリズムを用いた場合のこの発明の方法のフローチャートである。
【図７】この発明に従った装置のブロック図である。
【符号の説明】
【０１５３】
１  産業用ロボット、２  制御手段、３  コンピューティング手段、４  コンパイラ／インタープリタ、５  内挿ユニット、６  駆動手段、７  オペレータ、８  制御ユニット。
【図１】
2004284004.tif 000110
【図２】
2004284004.tif 000111
【図３】
2004284004.tif 000112
【図４】
2004284004.tif 000113
【図５】
2004284004.tif 000114
【図６】
2004284004.tif 000115
【図７】
2004284004.tif 000116
【外国語明細書】
2004284004000001.pdf