JP3663318B2 - Method and apparatus for correcting motion error of parallel mechanism - Google Patents
Method and apparatus for correcting motion error of parallel mechanism Download PDFInfo
- Publication number
- JP3663318B2 JP3663318B2 JP14749599A JP14749599A JP3663318B2 JP 3663318 B2 JP3663318 B2 JP 3663318B2 JP 14749599 A JP14749599 A JP 14749599A JP 14749599 A JP14749599 A JP 14749599A JP 3663318 B2 JP3663318 B2 JP 3663318B2
- Authority
- JP
- Japan
- Prior art keywords
- error
- joint
- parallel
- strut
- motion
- 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.)
- Expired - Fee Related
Links
Images
Landscapes
- Length Measuring Devices With Unspecified Measuring Means (AREA)
- Manipulator (AREA)
- A Measuring Device Byusing Mechanical Method (AREA)
Description
【0001】
【発明の属する技術分野】
本発明は、閉リンク機構を並列に連結したパラレルメカニズムにおける運動の精度を向上させる運動誤差補正方法およびその装置に関する。
【0002】
【従来の技術】
近年、産業用ロボットや工作機械の分野において、閉リンク機構を並列に連結したパラレルメカニズムの研究が盛んに行われている。従来の積重ね構造からなる直交座標型工作機械やアーム型ロボット等のシリアルメカニズムと比較して、梁構造でなく剛性の高いトラス構造であり、各軸の質量が累積せず移動速度も高く、各軸の位置決め誤差が累積せず精度の平均化が可能で、精密機械の基本であるアッベの原理(三次元座標測定機における測定点を測長ユニット(スケール)の延長線上として、測定値を機構の姿勢変化の影響を受けにくくして測定誤差を少なくできる。)を満たすことができる、等の特長があり、剛性、精度、運動速度等の面で有利であるからである。
【0003】
【発明が解決しようとする課題】
このようなパラレルメカニズムにおいて、閉リンク機構によってベースとステージとを並列に連結するジョイント(対偶)の回転精度は機構の運動精度に強く影響する。つまり、メカニズムの運動精度を高めるためには各ジョイントの回転精度を向上させる必要がある。図1に示すように、アクチュエータであるストラット2には長さを測定する測長器(スケール等)が内蔵されているので、ジョイント3に回転誤差がなければ、ステージ4の位置と姿勢はストラット長さにより一意に決定される。しかし、現実にはジョイント3にはその形状誤差や外力による変形に起因する回転誤差が発生し、ステージ4の運動誤差の要因となる。そこでステージ4の運動精度を高めるためには、より高精度かつ高剛性なジョイント3を用いるか、ジョイント3の回転誤差を計測してその値を用いてステージ4の運動誤差を補正する必要がある。前者ではコスト的および技術的に実現が困難であり、後者ではジョイント3の回転誤差を求めるには、一般に、図10のように1個の球面ジョイント3当たり直交する3方向の回転誤差を計測する3個の変位センサーが必要となり、その結果、機構全体で膨大な数の変位センサーを必要とした。一般的な6自由度のパラレルメカニズムでは球面ジョイントが機構全体で12個用いられており、センサーの数は最低でも実に36個に及ぶことになった。
【0004】
そこで、本発明では、ジョイントの回転誤差におけるアクチュエータであるストラット方向のみの成分が機構の運動誤差に強く影響し、その他の成分すなわちストラットの直角方向の成分は影響を及ぼさないとの知見を得て、従来のパラレルメカニズムの課題を解決して、少ない数の変位センサーにてもジョイントの回転誤差補正が精度良く行え、機構の運動精度の向上が図れるパラレルメカニズムの運動誤差補正方法およびその装置を提供することを目的とする。
【0005】
【課題を解決するための手段】
このため本発明は、少なくとも3自由度を有する閉リンク機構を並列に連結したパラレルメカニズムにおけるジョイント(対偶)の回転誤差に起因する前記リンク機構の運動誤差の補正を行うため、各ジョイントの回転誤差を測定する際に、リンク機構を構成するアクチュエータの駆動方向の誤差を測定して前記リンク機構の運動誤差を補正することを特徴とするものである。
また本発明は、少なくとも3自由度を有する閉リンク機構を並列に連結したベースとステージとから構成されるジョイントの回転誤差を測定して前記リンク機構の運動誤差を補正するパラレルメカニズムにおいて、ジョイント部にアクチュエータの駆動方向の誤差を測定する変位センサーを配設して前記リンク機構の運動誤差を補正するように構成したことを特徴とするものである。
また本発明は、前記アクチュエータは測長手段を内蔵するストラットから構成されたことを特徴とするもので、これらを課題解決のための手段とするものである。
【0006】
【実施の形態】
以下、本発明におけるパラレルメカニズムの運動誤差補正方法およびその装置の第1実施の形態を図1〜図4に基づいて説明する。
図1(A)は本発明のパラレルメカニズムの運動誤差補正方法を実現した装置の全体斜視図、図1(B)はアクチュエータであるストラットとジョイントとの連結部の拡大断面図、図2はジョイントの回転誤差とステージ上のプローブ先端の運動誤差の関係図、図3はプローブの長さと行列式の値の関係図、図4はプローブの長さと特異値の関係図である。
本発明は、ジョイントの回転誤差におけるアクチュエータであるストラット方向のみの成分が機構の運動誤差に強く影響し、その他の成分すなわちストラットの直角方向の成分は影響を及ぼさないとの知見を得て、従来のパラレルメカニズムの課題を解決して、少ない数の変位センサーにてもジョイントの回転誤差補正を精度良く行い、機構の運動精度の向上を図るものである。
【0007】
本発明が導かれた一連の研究で、パラレルメカニズムを用いた新しい三次元座標測定器(以下パラレルCMMと言う)を提案してきた。従来の直交座標型CMMでは、アッベの原理を満たしていなかった。つまり、測定点が測長ユニット(スケール)の延長線上になく、測定値が機構の姿勢変化の影響を受け易いため測定誤差の原因になっていた。パラレルCMMでは測定点をスケールの延長線上付近に配置することが可能で、本件発明者らは先に、このような配置の場合に最も測定値のばらつきが小さくなることを実験的に突き止めた。
これは、測長機におけるアッベの原理と同様に、測定点が対偶(ジョイント)のガタや回転誤差等に起因する運動誤差を持っていても、スケール方向への成分が二次的誤差となり、測定値への影響が最小となるためだと考えられる。
以下、図2〜図4によって、本発明をなすに至ったパラレルメカニズムにおけるジョイントの回転誤差が機構の運動誤差に及ぼす影響を調べるため微小運動学を用いた誤差解析について以下に述べる。
【0008】
<解析方法>
先ず、図2に示すように、プローブチップ8が設置されたステージ4上の回転ジョイント3−4、3−5、3−6の回転誤差を、半径方向成分δrs=(δrs1 , δrs2 , δrs3 )T (T は転値を表す)、円周方向成分δθs=(δθs1 , δθs2 , δθs3 )T 、Z方向成分δhs=(δhs1 , δhs2 , δhs3 )T 、スケール(ストラット2)方向成分δls=(δls1 , δls2 , δls3 )T およびZ軸回り成分δγs=(δγs1 , δγs2 , δγs3 )T に分解し、ベース1面上の球面ジョイント3−1、3−2、3−3の回転誤差を、半径方向成分δrB =(δrB 1 , δrB 2 , δrB 3 )T 、スケール方向成分δlB =(δlB 1 , δlB 2 , δlB 3 )T および円周方向成分δθB =(δθB 1 , δθB 2 , δθB 3 )T とする。このとき、例えば微小変位δrsとプローブ8の微小変位δx =(δx ,δy ,δz )T との関係は、
δx =Jrsδrs ・・・・・・・・(1)
で表される。ここで、Jrsは3×3のヤコビ行列であり、機構の順運動学(大岩孝彰「パラレルメカニズムを用いた三次元座標測定機−基本原理と運動学」精密工学会誌、64.12(1998)1791)から計算できる。
【0009】
前記ヤコビ行列はジョイント3の回転誤差とプローブ8の運動誤差の関係を示す。したがって、この行列の特異値や行列式の値detJrsを求めることにより、ジョイント3の回転誤差が測定精度に及ぼす影響の大きさを調べることが可能になる。同様に、ジョイント3の他方向の回転誤差成分の影響も、ヤコビ行列Jθs、Jhs、Jls、Jγs、JrB 、JlB およびJθB から求められる。計算はベース1上の球面ジョイント3の半径位置をrB =550、ステージ4の半径rs=100とし、プローブ8の先端の座標位置はXYZ方向の分解能が等しくなる等方点(0,0,388.9(=0.707rB ))に固定して行った。
【0010】
<解析結果> 先ず、図3に示すように、それぞれの回転誤差成分についてのヤコビ行列のプローブ8の長さlsとの関係を求めた。並進方向の回転誤差δrs、δhs、δrB 以外の誤差δγs、δθs、δθB の影響がls=70.7(=0.707rs)のとき、すなわちストラット2の延長線上にプローブ8の先端が位置する場合に僅少となることが理解される。
これは、ジョイント3に円周方向、Z軸回りの回転誤差が生じても測定誤差とならないことを示している。並進方向の誤差についてはls=0〜100の範囲内では1以下であり、回転誤差以上に誤差が拡大しないことを示している。
【0011】
次に、ステージ4上の回転ジョイント3−4・・の回転誤差に関するヤコビ行列〔Jrs、Jhs、Jθs〕の最大特異値と最小特異値との関係を求めた結果を図4に示す。
プローブ8の長さlsに無関係に最小特異値は1となるが、ls=70.7の近傍では最大特異値は急激に減少し、最小値1となるが、ベース1上の球面ジョイント3−1・・の誤差に関するヤコビ行列〔JrB 、JθB 〕についても同様の結果となった。
また、両ジョイントの回転誤差のスケール方向成分δl、スケール方向成分δlに直角な2成分δtおよびδnについてのヤコビ行列の値detJl、detJt、detJnおよび特異値を計算した結果を図5および図6に示す。スケール方向成分δlについてのヤコビ行列の値と特異値はls=70.7のとき1となり、それに直角な方向の成分δtおよびδnについての行列式の値と特異値はほぼ0となった。ここで、添字tはステージ円およびベース円の接線方向を、添字nはストラット方向と接線方向に直角な方向を表している(図7参照。)。
以上のことから、プローブ8がスケールの延長線上にあるとき、ジョイントのスケール方向の誤差δlのみが機構の運動誤差となり、それに直角な並進方向と回転方向の誤差の影響がなくなることが推察できる。
【0012】
<結論>
パラレルCMMのジョイントの回転誤差が測定値に及ぼす影響を調べるため、微小運動学による誤差解析の結果、測定点がスケールの延長線上にある場合、スケールの方向以外の回転誤差は無視できることがわかった。
【0013】
以上の知見に基づき、図1に示すような本発明のパラレルメカニズムの運動誤差補正方法を実現した機構装置を作製した。
図1(A)は一般的な6自由度のパラレルメカニズムであり、ベース1とアクチュエータにより伸縮可能なストラット2は球面ジョイント3により連結され、各球面ジョイント3はXYZ軸回りの3つの回転自由度を有する。ストラット2の他端には同様の球面ジョイント3を介してステージ4が連結される。
このように構成された6自由度のパラレルメカニズムは、6本のストラット2を伸縮させることによりステージ4を6自由度方向(並進3方向、回転3方向)へ運動させることが可能となる。
【0014】
前記ストラット2には長さを測定する測長器(スケール等)が内蔵されており、ジョイント3に回転誤差がなければ、ステージ4の位置と姿勢はストラット2の長さにより一意に決定されるものであるが、ジョイント3の形状誤差や外力による変形に起因する三次元の各方向での回転誤差が発生するところ、本発明では、図1(B)に拡大して示すように、リンク機構を構成するアクチュエータ(ストラット2)の駆動方向のみの誤差を測定して前記リンク機構の運動誤差を補正すべく、ストラット2の端部に固定されるホルダー5にベアリングを介して軸支された球面ジョイント3とストラット2との間でストラット2の伸縮方向の誤差のみを測定する変位センサー6をストラット2の内部に埋設して設置したものである。
【0015】
このように構成したことにより、6本の各ストラット2を適宜に伸縮させてステージ4を6自由度方向に運動させる際に、各ジョイント3の形状誤差や外力による変形に起因する三次元の各方向での回転誤差が発生していても、ストラット2に対して直角な並進方向と回転方向の誤差の影響を殆ど無視できることから、ストラット2の伸縮方向の誤差のみを変位センサー6にて測定するだけで高精度にて、パラレルメカニズムにおけるリンク機構の運動誤差を補正することができる(上下のジョイントにおけるストラット方向の回転誤差成分とストラットに内蔵されている測長器の値とを加算するだけで、つまり内蔵の測長器で得られたストラットの長さに加えて、ジョイントの回転誤差の分ストラットが長く(あるいは短く)なる。)ので、センサーの数を大幅に削減することができて、装置の簡素化と低コストが実現できる他、誤差測定に基づく機構の補正制御の簡素化も図れる。
【0016】
図8は本発明のパラレルメカニズムの運動誤差補正装置の第2実施の形態を示すもので、本実施の形態のものでは、球面ジョイント3を過不足なく収容する凹部を設けた第1ホルダー5Aと第2ホルダー5Bとを締結してストラット2の端部に固定するとともに、ストラット2と第2ホルダー5Bとにわたりストラット2の伸縮方向の誤差のみを測定する変位センサー6を埋設して設置したものである。かくして、第1ホルダー5Aと第2ホルダー5Bとによりホルダーへの球面ジョイント3の設置がより簡便に行われ、本実施の形態のものも、ストラット2の伸縮方向の誤差のみを変位センサー6にて測定するだけで高精度にて、パラレルメカニズムにおけるリンク機構の運動誤差を補正することができるので、センサーの数を大幅に削減することができて、前記第1実施の形態のものと同様の効果を発揮する。
【0017】
図9は本発明のパラレルメカニズムの運動誤差補正装置の第3実施の形態を示すもので、本実施の形態は3自由度パラレルメカニズムに採用された例である。このものはステージ4側の回転ジョイント7の回転自由度は1で、ベース1側の球面ジョイント3の回転自由度は3とされる。本実施の形態のものも、ステージ4側の回転ジョイント7のみならず、ベース1側の球面ジョイント3においてもストラット2の伸縮方向の誤差のみを変位センサーにて測定するように構成するだけでよいので、本来ならステージ4側に15個、ベース1側に9個の合計24個の回転誤差測定変位センサーを設置すべきところ、3個ずつ合計6個の変位センサーの設置のみにて済むことになる。
【0018】
以上本発明の実施の形態を説明してきたが、本発明の趣旨の範囲内で、パラレルメカニズムとしてのベースおよびステージの形状、それらの大きさの比率、アクチュエータであるストラットの形状、形式、本数およびそのベースおよびステージとの位置関係、球面ジョイントの形状、形式、球面ジョイントのベースおよびステージ並びにホルダーへの設置形態、変位センサーの形式および設置形態等については適宜選定できるものである。
【0019】
【発明の効果】
以上詳細に説明したように、本発明は少なくとも3自由度を有する閉リンク機構を並列に連結したパラレルメカニズムにおけるジョイント(対偶)の回転誤差に起因する前記リンク機構の運動誤差の補正を行うため、各ジョイントの回転誤差を測定する際に、リンク機構を構成するアクチュエータの駆動方向の誤差を測定して前記リンク機構の運動誤差を補正するようにしたので、各ジョイントの形状誤差や外力による変形に起因する三次元の各方向での回転誤差が発生していても、ストラットに対して直角な並進方向と回転方向の誤差の影響を殆ど無視できることから、ストラットの伸縮方向の誤差を変位センサーにて測定するだけで高精度にて、パラレルメカニズムにおけるリンク機構の運動誤差を補正することができることになり、センサーの数を大幅に削減することができて、装置の簡素化と低コストが実現できる他、誤差測定に基づく機構の補正制御の簡素化も図れる。
【0020】
また、少なくとも3自由度を有する閉リンク機構を並列に連結したベースとステージとから構成されるジョイントの回転誤差を測定して前記リンク機構の運動誤差を補正するパラレルメカニズムにおいて、ジョイント部にアクチュエータの駆動方向の誤差を測定する変位センサーを配設して前記リンク機構の運動誤差を補正するように構成したので、比較的自由度の少ない3自由度のパラレルメカニズムから6自由度あるいはそれ以上の自由度を有するパラレルメカニズムについて、アクチュエータであるストラットに対して直角な並進方向と回転方向の誤差の測定を廃止し、ジョイント部にアクチュエータの駆動方向の誤差を測定する変位センサーを設置するだけでよいので、部品点数の削減と装置の簡素化による低コストが実現でき、誤差測定に基づく機構の補正制御の簡素化も図れることになり有用である。
さらに、前記アクチュエータは測長手段を内蔵するストラットから構成されていることにより、ジョイント部による回転誤差に基づいて機構の運動誤差を補正する際のアクチュエータの移動制御が直に測長手段に反映されて制御がより簡素化される。
かくして、本発明によれば、少ない数の変位センサーにてもジョイントの回転誤差補正が精度良く行え、機構の運動精度の向上が図れるパラレルメカニズムの運動誤差補正方法およびその装置が提供される。
【図面の簡単な説明】
【図1】図1(A)は本発明のパラレルメカニズムの運動誤差補正方法を実現した装置の全体斜視図、図1(B)はアクチュエータであるストラットとジョイントとの連結部の拡大断面図である。
【図2】ジョイントの回転誤差とステージ上のプローブ先端の運動誤差の関係図である。
【図3】本発明の基礎となった解析によるプローブの長さと行列式の値の関係図である。
【図4】本発明の基礎となった解析によるプローブの長さと特異値の関係図である。
【図5】本発明の基礎となった解析によるプローブの長さと行列式の値の詳細な関係図である。
【図6】本発明の基礎となった解析によるプローブの長さと特異値の詳細な関係図である。
【図7】本発明の基礎となった解析によるジョイントの回転誤差の関係図である。
【図8】本発明のパラレルメカニズムの運動誤差補正装置の第2実施の形態を示すストラットとジョイントとの連結部の拡大断面図である。
【図9】本発明のパラレルメカニズムの運動誤差補正装置の第3実施の形態を示す全体斜視図である。
【図10】パラレルメカニズムにおけるジョイントの3方向の誤差を示す図である。
【符号の説明】
1 ベース
2 ストラット(アクチュエータ)
3 ジョイント
4 ステージ
5 ホルダー
6 変位センサー
7 回転ジョイント
8 プローブ[0001]
BACKGROUND OF THE INVENTION
The present invention relates to a motion error correction method and apparatus for improving motion accuracy in a parallel mechanism in which closed link mechanisms are connected in parallel.
[0002]
[Prior art]
In recent years, in the field of industrial robots and machine tools, research on parallel mechanisms in which closed link mechanisms are connected in parallel has been actively conducted. Compared to the conventional serial mechanisms such as Cartesian coordinate machine tools and arm type robots with a stacked structure, it is not a beam structure but a rigid truss structure, the mass of each axis does not accumulate, the moving speed is high, each Axis positioning error does not accumulate and accuracy can be averaged, and Abbe's principle, which is the basis of precision machinery (measurement points on a three-dimensional coordinate measuring machine as an extension line of a length measurement unit (scale) This is because the measurement error can be reduced by being less susceptible to the influence of the posture change, and it is advantageous in terms of rigidity, accuracy, motion speed, and the like.
[0003]
[Problems to be solved by the invention]
In such a parallel mechanism, the rotational accuracy of the joint (pair) that connects the base and the stage in parallel by the closed link mechanism strongly affects the motion accuracy of the mechanism. That is, in order to increase the movement accuracy of the mechanism, it is necessary to improve the rotation accuracy of each joint. As shown in FIG. 1 , the strut 2 that is an actuator has a built-in length measuring device (scale, etc.) for measuring the length. Therefore, if the
[0004]
Therefore, in the present invention, the knowledge that the component of the joint rotation error only in the strut direction, which is the actuator, strongly influences the motion error of the mechanism, and the other component, that is, the component in the right direction of the strut has no influence. Solves the problems of the conventional parallel mechanism, and provides a motion error correction method and apparatus for the parallel mechanism that can accurately correct the rotation error of the joint even with a small number of displacement sensors and improve the motion accuracy of the mechanism. The purpose is to do.
[0005]
[Means for Solving the Problems]
Therefore, the present invention corrects the movement error of the link mechanism due to the rotation error of the joint (pair) in the parallel mechanism in which the closed link mechanisms having at least three degrees of freedom are connected in parallel. Is measured, an error in the driving direction of the actuator constituting the link mechanism is measured to correct the movement error of the link mechanism.
According to another aspect of the present invention, there is provided a parallel mechanism for measuring a rotation error of a joint composed of a base and a stage in which closed link mechanisms having at least three degrees of freedom are connected in parallel and correcting a movement error of the link mechanism. Further, a displacement sensor for measuring an error in the driving direction of the actuator is provided to correct a motion error of the link mechanism.
The present invention is characterized in that the actuator is composed of a strut incorporating a length measuring means, and these are means for solving the problems.
[0006]
Embodiment
A parallel mechanism motion error correction method and apparatus according to a first embodiment of the present invention will be described below with reference to FIGS.
1A is an overall perspective view of an apparatus that realizes a motion error correction method for a parallel mechanism according to the present invention, FIG. 1B is an enlarged sectional view of a connecting portion between a strut that is an actuator and a joint, and FIG. FIG. 3 is a relationship diagram between the probe length and the determinant value, and FIG. 4 is a relationship diagram between the probe length and the singular value.
The present invention has obtained the knowledge that the component of the joint rotation error only in the strut direction, which is the actuator, strongly influences the motion error of the mechanism, and the other component, that is, the component in the right angle direction of the strut does not affect, In order to solve the problem of the parallel mechanism, the rotational error of the joint is accurately corrected even with a small number of displacement sensors, and the movement accuracy of the mechanism is improved.
[0007]
In a series of studies from which the present invention was derived, a new three-dimensional coordinate measuring instrument (hereinafter referred to as a parallel CMM) using a parallel mechanism has been proposed. The conventional Cartesian CMM does not satisfy Abbe's principle. That is, the measurement point is not on the extension line of the length measurement unit (scale), and the measurement value is easily affected by the change in the posture of the mechanism, causing a measurement error. In the parallel CMM, the measurement points can be arranged near the extension line of the scale, and the present inventors have experimentally found that the variation in the measured value is the smallest in such an arrangement.
This is similar to Abbe's principle in length measuring instruments, even if the measurement point has a motion error due to backlash or rotation error of the even number (joint), the component in the scale direction becomes a secondary error, This is considered to be because the influence on the measured value is minimized.
In the following, error analysis using micro-kinematics will be described with reference to FIGS. 2 to 4 in order to investigate the effect of joint rotation error on the motion error of the mechanism in the parallel mechanism that has led to the present invention.
[0008]
<Analysis method>
First, as shown in FIG. 2, the rotational error of the rotary joints 3-4, 3-5, 3-6 on the stage 4 on which the probe tip 8 is installed is expressed as a radial component δrs = (δrs 1, δrs 2, δrs 3 ) T ( T represents a turning value), circumferential direction component δθs = (δθs 1, δθs 2, δθs 3 ) T , Z direction component δhs = (δhs 1, δhs 2, δhs 3 ) T , scale ( Strut 2) Decomposed into directional components δls = (δls 1, δls 2, δls 3 ) T and components around Z axis δγs = (δγs 1, δγs 2, δγs 3 ) T , and spherical joint 3-1 on the base 1 surface 3-2 and 3-3, the rotational direction component δrB = (δrB 1, δrB 2, δrB 3 ) T , the scale direction component δlB = (δlB 1, δlB 2, δlB 3 ) T and the circumferential direction The component δθB = (δθB 1, δθB 2, δθB 3 ) T. At this time, for example, the relationship between the minute displacement δrs and the minute displacement δ x = (δ x , δ y , δ z ) T of the probe 8 is
δ x = Jrs δrs (1)
It is represented by Here, Jrs is a 3 × 3 Jacobian matrix, and the forward kinematics of the mechanism (Takaaki Oiwa “3D coordinate measuring machine using parallel mechanism-basic principle and kinematics”, Journal of Precision Engineering, 64.12 (1998) 1791).
[0009]
The Jacobian matrix indicates the relationship between the rotation error of the
[0010]
<Analysis Result> First, as shown in FIG. 3, the relationship between the rotation error components and the length ls of the probe 8 of the Jacobian matrix was obtained. When the influence of the errors δγs, δθs, δθB other than the rotational errors δrs, δhs, δrB in the translation direction is ls = 70.7 (= 0.707rs), that is, the tip of the probe 8 is positioned on the extension line of the strut 2 It is understood that it will be very small.
This indicates that a measurement error does not occur even if a rotation error in the circumferential direction and around the Z axis occurs in the
[0011]
Next, FIG. 4 shows the result of obtaining the relationship between the maximum singular value and the minimum singular value of the Jacobian matrix [Jrs, Jhs, Jθs] regarding the rotation error of the rotary joint 3-4 on the stage 4.
The minimum singular value is 1 regardless of the length ls of the probe 8, but the maximum singular value decreases rapidly and becomes the minimum value 1 in the vicinity of ls = 70.7. Similar results were obtained for the Jacobian matrix [JrB, JθB] relating to the error of 1.
The results of calculating the Jacobian matrix values detJl, detJt, detJn and singular values for the scale direction component δl and the two components δt and δn perpendicular to the scale direction component δl of the rotation error of both joints are shown in FIGS. Show. The Jacobian matrix value and singular value for the scale direction component δl are 1 when ls = 70.7, and the determinant value and singular value for the components δt and δn in the direction perpendicular thereto are almost zero. Here, the subscript t represents the tangential direction of the stage circle and the base circle, and the subscript n represents the direction perpendicular to the strut direction and the tangential direction (see FIG. 7).
From the above, it can be inferred that when the probe 8 is on the extension line of the scale, only the error δl in the joint scale direction becomes the motion error of the mechanism, and the influence of the error in the translation direction and the rotation direction perpendicular to the mechanism is eliminated.
[0012]
<Conclusion>
In order to investigate the effect of parallel CMM joint rotation error on measurement values, error analysis by micro kinematics revealed that rotation errors other than the direction of the scale can be ignored when the measurement point is on the extension line of the scale. .
[0013]
Based on the above knowledge, a mechanism device that realizes the motion error correction method for the parallel mechanism of the present invention as shown in FIG. 1 was produced.
FIG. 1A shows a general parallel mechanism with six degrees of freedom. A base 1 and a strut 2 that can be expanded and contracted by an actuator are connected by a
The parallel mechanism of 6 degrees of freedom configured in this way can move the stage 4 in the direction of 6 degrees of freedom (
[0014]
The strut 2 includes a length measuring device (such as a scale) for measuring the length. If the joint 3 has no rotation error, the position and posture of the stage 4 are uniquely determined by the length of the strut 2. However, when a rotational error in each of the three-dimensional directions due to the shape error of the joint 3 or deformation due to an external force occurs, in the present invention, as shown in FIG. A spherical surface pivotally supported through a bearing on a
[0015]
With this configuration, when the six struts 2 are appropriately expanded and contracted to move the stage 4 in the direction of six degrees of freedom, each of the three-dimensional components caused by deformation due to the shape error of each joint 3 or external force Even if a rotation error occurs in the direction, the effects of the translational direction perpendicular to the strut 2 and the error in the rotation direction can be almost ignored. Therefore, only the error in the expansion / contraction direction of the strut 2 is measured by the
[0016]
FIG. 8 shows a second embodiment of the motion error correction device for the parallel mechanism of the present invention . In this embodiment, the first holder 5A provided with a recess for accommodating the
[0017]
FIG. 9 shows a third embodiment of a motion error correction apparatus for a parallel mechanism according to the present invention, and this embodiment is an example adopted for a three-degree-of-freedom parallel mechanism. In this case, the rotational freedom degree of the rotary joint 7 on the stage 4 side is 1, and the rotational freedom degree of the spherical joint 3 on the base 1 side is 3. In the present embodiment, not only the rotary joint 7 on the stage 4 side but also the spherical joint 3 on the base 1 side, only the error in the expansion / contraction direction of the strut 2 may be measured by the displacement sensor. Therefore, if a total of 24 rotational error measuring displacement sensors should be installed, 15 on the stage 4 side and 9 on the base 1 side, it is only necessary to install a total of 6 displacement sensors, 3 each. Become.
[0018]
Although the embodiment of the present invention has been described above, within the scope of the present invention, the shape of the base and stage as a parallel mechanism, the ratio of their sizes, the shape, type, number and number of struts that are actuators The positional relationship between the base and the stage, the shape and type of the spherical joint, the installation form of the spherical joint on the base and stage and the holder, the type and installation form of the displacement sensor can be selected as appropriate.
[0019]
【The invention's effect】
As described in detail above, the present invention corrects a motion error of the link mechanism due to a rotation error of a joint (an even number) in a parallel mechanism in which closed link mechanisms having at least three degrees of freedom are connected in parallel. When measuring the rotation error of each joint, the error in the driving direction of the actuator that constitutes the link mechanism is measured to correct the movement error of the link mechanism. Even if the resulting three-dimensional rotation error occurs, the effects of the translational direction perpendicular to the strut and the error in the rotation direction can be almost ignored. It is possible to correct the link mechanism motion error in the parallel mechanism with high accuracy just by measuring. Able to significantly reduce the number of servers, in addition to simplified and lower cost of the apparatus can be realized, thereby also simplifying the correction control mechanism based on error measurement.
[0020]
Further, in the parallel mechanism for correcting the movement error of the link mechanism by measuring the rotation error of the joint composed of the base and the stage in which the closed link mechanism having at least three degrees of freedom is connected in parallel, Since the displacement sensor for measuring the error in the driving direction is arranged to correct the movement error of the link mechanism, the degree of freedom is 6 degrees or more from the parallel mechanism of 3 degrees of freedom with relatively few degrees of freedom. For the parallel mechanism with a degree, the measurement of the error in the translational direction and the rotation direction perpendicular to the actuator strut is abolished, and it is only necessary to install a displacement sensor that measures the error in the driving direction of the actuator at the joint. Reduces the number of parts and simplifies the equipment, resulting in lower costs and error Simplified correction control based on the measurement mechanism also useful will be attained.
Further, since the actuator is composed of a strut incorporating a length measuring means, the movement control of the actuator when correcting the motion error of the mechanism based on the rotation error by the joint portion is directly reflected in the length measuring means. Control is further simplified.
Thus, according to the present invention, there is provided a motion error correction method and apparatus for a parallel mechanism that can accurately correct the rotation error of the joint even with a small number of displacement sensors and can improve the motion accuracy of the mechanism.
[Brief description of the drawings]
FIG. 1A is an overall perspective view of an apparatus that realizes a motion error correction method for a parallel mechanism according to the present invention, and FIG. 1B is an enlarged cross-sectional view of a connecting portion between a strut that is an actuator and a joint. is there.
FIG. 2 is a relationship diagram between a rotation error of a joint and a motion error of a probe tip on a stage.
FIG. 3 is a diagram showing the relationship between the length of a probe and the value of a determinant according to an analysis based on the present invention.
FIG. 4 is a diagram showing the relationship between probe length and singular value based on the analysis based on the present invention.
FIG. 5 is a detailed relationship diagram between the length of a probe and the value of a determinant according to the analysis on which the present invention is based.
FIG. 6 is a detailed relationship diagram of probe length and singular value based on analysis based on the present invention.
FIG. 7 is a relationship diagram of joint rotation error based on the analysis that is the basis of the present invention.
FIG. 8 is an enlarged cross-sectional view of a connecting portion between a strut and a joint, showing a second embodiment of the motion error correction apparatus for the parallel mechanism of the present invention.
FIG. 9 is an overall perspective view showing a third embodiment of a motion error correction apparatus for a parallel mechanism according to the present invention.
FIG. 10 is a diagram showing errors in three directions of the joint in the parallel mechanism.
[Explanation of symbols]
1 Base 2 Strut (actuator)
3 Joint 4
Claims (3)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP14749599A JP3663318B2 (en) | 1999-05-27 | 1999-05-27 | Method and apparatus for correcting motion error of parallel mechanism |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP14749599A JP3663318B2 (en) | 1999-05-27 | 1999-05-27 | Method and apparatus for correcting motion error of parallel mechanism |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2000337807A JP2000337807A (en) | 2000-12-08 |
JP3663318B2 true JP3663318B2 (en) | 2005-06-22 |
Family
ID=15431689
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP14749599A Expired - Fee Related JP3663318B2 (en) | 1999-05-27 | 1999-05-27 | Method and apparatus for correcting motion error of parallel mechanism |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3663318B2 (en) |
Families Citing this family (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2003343678A (en) * | 2002-05-24 | 2003-12-03 | Hiihaisuto Seiko Kk | Multi-degree-of-freedom positioning mechanism of parallel rough/fine driving type |
SE527248C2 (en) * | 2004-06-28 | 2006-01-31 | Hexagon Metrology Ab | Measuring probe for use in coordinate measuring machines |
US20060147195A1 (en) * | 2004-12-07 | 2006-07-06 | Lim Eul G | Mobile system with cameras, camera suspension, method for measuring camera location information, and camera mounting apparatus |
CN100354068C (en) * | 2005-02-06 | 2007-12-12 | 燕山大学 | Four freedom parallel robot mechanism with passive bound branch |
JP4713197B2 (en) * | 2005-03-31 | 2011-06-29 | アイシン・エィ・ダブリュ株式会社 | Positioning device and air micro measurement device |
JP2009264818A (en) * | 2008-04-23 | 2009-11-12 | Murata Mach Ltd | Straight type displacement measuring device |
ES2395742T3 (en) * | 2008-06-10 | 2013-02-14 | Sidel Holdings & Technology S.A. | Modular Labeling Station |
FR2997887B1 (en) * | 2012-11-14 | 2015-07-10 | Commissariat Energie Atomique | HEXAPODE SYSTEM |
GB201513850D0 (en) * | 2015-08-05 | 2015-09-16 | Renishaw Plc | Coordinate positioning machine |
CN110587659B (en) * | 2019-09-19 | 2021-04-06 | 中北大学 | Large-range high-precision robot performance testing method |
DE102020204532A1 (en) * | 2020-04-08 | 2021-10-14 | Carl Zeiss Industrielle Messtechnik Gmbh | Position measurement with a positioning device |
CN111855183B (en) * | 2020-07-29 | 2022-04-19 | 中国科学院光电技术研究所 | Multi-degree-of-freedom motion branched chain resolution testing platform and testing method |
CN115070731B (en) * | 2022-07-01 | 2022-12-09 | 哈尔滨工业大学(威海) | Geometric error calibration method and system for parallel mechanism and electronic equipment |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH10267603A (en) * | 1996-11-22 | 1998-10-09 | Eizou Nishimura | Position and attitude detector |
JPH10213403A (en) * | 1997-01-29 | 1998-08-11 | Toshiba Mach Co Ltd | Three-dimensional coordinate measuring device |
JPH1158285A (en) * | 1997-08-14 | 1999-03-02 | Sumitomo Heavy Ind Ltd | Force control system of hand mechanism |
-
1999
- 1999-05-27 JP JP14749599A patent/JP3663318B2/en not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JP2000337807A (en) | 2000-12-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP3663318B2 (en) | Method and apparatus for correcting motion error of parallel mechanism | |
US11796314B2 (en) | Measurement method for a surface-measuring measuring machine | |
JP5281898B2 (en) | Method for measuring and / or calibrating the position of an object in space | |
JP4980541B2 (en) | Method and apparatus for correcting coordinate measurement error due to vibration of coordinate measuring machine (CMM) | |
JP3001989B2 (en) | Correction method of coordinate measuring device and coordinate measuring device | |
JP6226716B2 (en) | Arm-type coordinate measuring machine and deflection correction method for arm-type coordinate measuring machine | |
US10871366B2 (en) | Supplementary metrology position coordinates determination system for use with a robot | |
CN105960571A (en) | Calibrating position of motion systems by using inertial sensors | |
JP2008522836A (en) | Method and system for providing improved accuracy in articulated robots by kinematic robot model parameter determination | |
JP4302830B2 (en) | Robot calibration method and apparatus | |
CN110497385B (en) | Device and method for precisely measuring pose of moving platform of six-degree-of-freedom parallel mechanism | |
US11002529B2 (en) | Robot system with supplementary metrology position determination system | |
JP3679472B2 (en) | Calibration method for coordinate measuring apparatus having two rotation axes | |
JP3612637B2 (en) | Manipulator | |
US5743020A (en) | Three-axis continuous probe | |
Traslosheros et al. | One camera in hand for kinematic calibration of a parallel robot | |
JPH11505919A (en) | Precision angle measuring device | |
JP2002096232A (en) | Controlling method for machine tool | |
JPH07178689A (en) | Getting-out-of position measuring method for robot arm, and getting-out-of position correcting method and system for this robot arm | |
Traslosheros et al. | A method for kinematic calibration of a parallel robot by using one camera in hand and a spherical object | |
US20230266186A1 (en) | Torque sensor element and torque sensor | |
JP3939935B2 (en) | Method and apparatus for measuring frame deformation of parallel mechanism | |
KR100499090B1 (en) | Device and Method for Kinematic Calibration of Robots | |
JP4311621B2 (en) | Mechanical motion error correction method using a 6-DOF position and orientation measurement device | |
CN114001856A (en) | Six-dimensional force sensor |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20050120 |
|
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: 20050322 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20050328 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
S111 | Request for change of ownership or part of ownership |
Free format text: JAPANESE INTERMEDIATE CODE: R313113 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090401 Year of fee payment: 4 |
|
R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090401 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100401 Year of fee payment: 5 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130401 Year of fee payment: 8 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140401 Year of fee payment: 9 |
|
LAPS | Cancellation because of no payment of annual fees |