JPS60183515A - 絶対位置の測定方法およびその装置 - Google Patents
絶対位置の測定方法およびその装置Info
- Publication number
- JPS60183515A JPS60183515A JP1637085A JP1637085A JPS60183515A JP S60183515 A JPS60183515 A JP S60183515A JP 1637085 A JP1637085 A JP 1637085A JP 1637085 A JP1637085 A JP 1637085A JP S60183515 A JPS60183515 A JP S60183515A
- Authority
- JP
- Japan
- Prior art keywords
- signal
- measurement signal
- main
- difference
- absolute position
- 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.)
- Granted
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01D—MEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
- G01D1/00—Measuring arrangements giving results other than momentary value of variable, of general application
- G01D1/16—Measuring arrangements giving results other than momentary value of variable, of general application giving a value which is a function of two or more values, e.g. product or ratio
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Length Measuring Devices With Unspecified Measuring Means (AREA)
Abstract
(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。
め要約のデータは記録されません。
Description
【発明の詳細な説明】
(産業上の利用分野)
不発明は、数値制御が行なわれる機械のための位置測定
に関する。特に2本発明は、固定された基準位置に対す
る運動可能な機械部材の絶対位置の測定に関1−ろ。
に関する。特に2本発明は、固定された基準位置に対す
る運動可能な機械部材の絶対位置の測定に関1−ろ。
(従来の技術)
機械の各部材の運動の数値的制御のためには、1つの運
動部、回内の全ての位置について一義的な位@′測定信
号を生じろことが望ましい。不文におい壬絶対位置の測
定と呼はれろこの釉の辿1定は、数値制御装置の保守点
検中の如く運柳1可能部材が数値制御を受けない期間中
位置か記録されかつこれが保持さハたかどうかの如何に
拘らず、可動部材の位置に関1−る正確な情報を提供す
るという利点を有する。
動部、回内の全ての位置について一義的な位@′測定信
号を生じろことが望ましい。不文におい壬絶対位置の測
定と呼はれろこの釉の辿1定は、数値制御装置の保守点
検中の如く運柳1可能部材が数値制御を受けない期間中
位置か記録されかつこれが保持さハたかどうかの如何に
拘らず、可動部材の位置に関1−る正確な情報を提供す
るという利点を有する。
数値的に制御される機械の可動部材に対する絶対位置の
測定は2分解能および軸線距離の対立要件によって制約
を受ける。各々が異なる解像力において作動しかつ各々
が機械の軸線距離の一部にわたって一義的な測定を行な
うよう作用する複数の測定装置を用いろ絶対位置測定シ
ステムがあらゆる機械分野において公知である。このよ
うなシステムが回転要素ケ内蔵する測定装Wを用い又構
成されろ時、最も粗い測定結果の分解能を得るため用い
られろ測定装置に対して磯(渣、の部+)l駆動部はか
なりの歯車減速比を必要とする。このようなシステムが
線形測定装僧を用いて構成される場合は2機械の全軸蛛
跪離にわたって一義的tc泪11定信号を生じるために
要fる尺度の紗は膨大trものとなる。
測定は2分解能および軸線距離の対立要件によって制約
を受ける。各々が異なる解像力において作動しかつ各々
が機械の軸線距離の一部にわたって一義的な測定を行な
うよう作用する複数の測定装置を用いろ絶対位置測定シ
ステムがあらゆる機械分野において公知である。このよ
うなシステムが回転要素ケ内蔵する測定装Wを用い又構
成されろ時、最も粗い測定結果の分解能を得るため用い
られろ測定装置に対して磯(渣、の部+)l駆動部はか
なりの歯車減速比を必要とする。このようなシステムが
線形測定装僧を用いて構成される場合は2機械の全軸蛛
跪離にわたって一義的tc泪11定信号を生じるために
要fる尺度の紗は膨大trものとなる。
(発明が解決しようとする問題点)
公知の絶対位肴泗・定システムの他の知所は。
測定装置自体またはこハフと関連する#棟内な駆動−枠
に起因する誤差の影神をダ・げ易いことである。
に起因する誤差の影神をダ・げ易いことである。
このような起源から生じる誤差は、全体的な機械の位置
決め精度に対して悪影糎を及ぼす。
決め精度に対して悪影糎を及ぼす。
従って5本発明の一目的は、運萌HDT能な機械部打力
全運動加J1囲にわたり操作可能であり、かつ各々が機
械部打力運動範囲にわたって及俵されろ一義的な曲1定
(P′号を生じろ2つ以下の測定装置しか必要としない
絶対位置の測定装置および方法の提供にある。
全運動加J1囲にわたり操作可能であり、かつ各々が機
械部打力運動範囲にわたって及俵されろ一義的な曲1定
(P′号を生じろ2つ以下の測定装置しか必要としない
絶対位置の測定装置および方法の提供にある。
本発明の別の目的は、2つの循環的な測定装置を用い、
かつ2つの測定装置により行なわれる相対位置側・定の
誤差の許容度を有する絶対位置測定装置の提供にある。
かつ2つの測定装置により行なわれる相対位置側・定の
誤差の許容度を有する絶対位置測定装置の提供にある。
不発明の更に別の目的は、各々が機械部材がその運動郵
囲にわたっ(運動する時周期的な測定信号を生じる主側
:定装置と畠11測定装置を用いて運動可ロヒな機械の
部材の全運動範囲にわたって作用し。
囲にわたっ(運動する時周期的な測定信号を生じる主側
:定装置と畠11測定装置を用いて運動可ロヒな機械の
部材の全運動範囲にわたって作用し。
周期的な副測定信号が周期的な主測定信号よりも達動鉛
、回内で一回以上多く反復されることのない絶対位置側
1定装置および方法の提供にある。
、回内で一回以上多く反復されることのない絶対位置側
1定装置および方法の提供にある。
不発明の更に他の目的は、各々が回転可能な要素を有し
かつ各々が周期的な測定信号を生じる2つの徂1定装置
を備えた運動可能な機械部材の全運動範囲にわたって作
用し9回転要素は一方の辿i定装置が泗1定される軸線
の運動範囲にわたっ℃他の測定装置よりもその測定信号
の1サイクル以上多く生じることのないように相互に駆
動される絶対位ft測定装置の提供にある。
かつ各々が周期的な測定信号を生じる2つの徂1定装置
を備えた運動可能な機械部材の全運動範囲にわたって作
用し9回転要素は一方の辿i定装置が泗1定される軸線
の運動範囲にわたっ℃他の測定装置よりもその測定信号
の1サイクル以上多く生じることのないように相互に駆
動される絶対位ft測定装置の提供にある。
本発明の他の目的および長所については2図面および関
祷する記述において明らかになろう。
祷する記述において明らかになろう。
(問題点を解決するための手段)
上記の諸口的によれば、運動可能、′f、c機械の部材
の全運勲仲囲にわたって作用する絶対位置測定装置およ
び方法が提供されろ。各々が機械の運動可能部材の変位
量に比例する測定信号を生じろ主演11定装置および副
測定装置が提供される。油11定信号は機械の部材の制
限された亥位商」回内で一義的であり、一義的な値が機
械部材の全運動範囲にわたって周期的に反復する。制止
11定林泗“の測定信号は、主演1定装置の測定信号よ
りも機械部材の運動部1囲内で1サイクル以上多くなる
ことはない。
の全運勲仲囲にわたって作用する絶対位置測定装置およ
び方法が提供されろ。各々が機械の運動可能部材の変位
量に比例する測定信号を生じろ主演11定装置および副
測定装置が提供される。油11定信号は機械の部材の制
限された亥位商」回内で一義的であり、一義的な値が機
械部材の全運動範囲にわたって周期的に反復する。制止
11定林泗“の測定信号は、主演1定装置の測定信号よ
りも機械部材の運動部1囲内で1サイクル以上多くなる
ことはない。
絶対位置は、その間の差を計算することにより。
またその結果ケ用いて主演I+定信号のサイクル数を表
わす値を計算することによって測定信号から計算されろ
。この計算された値は9機械の運動範囲内のどんな位置
についても一糀的となり2機械の運動可能部材が数値制
御を受けない期間中位置の記録および保持には依存しな
い。2つの測定装置間の1つの主測定係号サイクルより
小さな機械部側の変位量測定の相対誤差は、主および制
御1定信号から絶対位置を計算するため用いられろ手順
により排除される。
わす値を計算することによって測定信号から計算されろ
。この計算された値は9機械の運動範囲内のどんな位置
についても一糀的となり2機械の運動可能部材が数値制
御を受けない期間中位置の記録および保持には依存しな
い。2つの測定装置間の1つの主測定係号サイクルより
小さな機械部側の変位量測定の相対誤差は、主および制
御1定信号から絶対位置を計算するため用いられろ手順
により排除される。
不発明を例示するために、不発明の譲受人により製造さ
れた工業用マニピュレータに応用された望ましい実施態
様について記述する。望ましい実施態様により例示され
た本発明の構成の特定の細部を不発明を限矩するものと
解釈すべきでないことを理解すべきである、本発明の紳
、囲は2頭書の特許請求の範囲およびその全ての相等自
答によっで却、定されるものである。
れた工業用マニピュレータに応用された望ましい実施態
様について記述する。望ましい実施態様により例示され
た本発明の構成の特定の細部を不発明を限矩するものと
解釈すべきでないことを理解すべきである、本発明の紳
、囲は2頭書の特許請求の範囲およびその全ての相等自
答によっで却、定されるものである。
(実施例)
第1図のブロック図においては、主側i定装置]2およ
び副測定装置14がその各々のインターフェース回路1
6.18に対して接続された状態で示されている。工業
用マニピュレータに使用されるよう出願人により選択さ
れた測定装置は、電磁結合されたロータおよびステータ
要素を有するレゾルバの如き公知の形式のものである。
び副測定装置14がその各々のインターフェース回路1
6.18に対して接続された状態で示されている。工業
用マニピュレータに使用されるよう出願人により選択さ
れた測定装置は、電磁結合されたロータおよびステータ
要素を有するレゾルバの如き公知の形式のものである。
図示の如く。
このレゾルバの運動可能な要素即ちロータは、その巻線
に交流信号が加えられ、これからステータの巻線に出力
信号が誘導される。ロータおよびステーク要素は、ロー
タの変位角に基づく出力の周期的な振幅の変化がロータ
の一回転以内りとこにおいても一銭的即ち独特のもので
あるように、あるいはロータの一回転に対して2回以」
二反復し得るように巻組を設けることがで六る。レゾル
バの各ロータは、これに対して1つの交流信号が加六ら
れ、ステータは曲角位相内に2つの9#、信号を出力と
して生じる。即ち、ロータに対する入力信号Esin(
wt)が、ステータの出力信号Esin(wt)sin
(θ)およびE sin (wt )cos (θ)
′?生じろように2つの成分に分解される。但し。
に交流信号が加えられ、これからステータの巻線に出力
信号が誘導される。ロータおよびステーク要素は、ロー
タの変位角に基づく出力の周期的な振幅の変化がロータ
の一回転以内りとこにおいても一銭的即ち独特のもので
あるように、あるいはロータの一回転に対して2回以」
二反復し得るように巻組を設けることがで六る。レゾル
バの各ロータは、これに対して1つの交流信号が加六ら
れ、ステータは曲角位相内に2つの9#、信号を出力と
して生じる。即ち、ロータに対する入力信号Esin(
wt)が、ステータの出力信号Esin(wt)sin
(θ)およびE sin (wt )cos (θ)
′?生じろように2つの成分に分解される。但し。
E −信号の強さ
wt = 入力信号の瞬時角度
θ = ロータの変位角
変位角θは、出力信号の比率の逆三角関数から計算され
る。即ち、θはE sin (wt ) 5in(θ)
/ E sin (wt ) cos (θ)の逆正接
と等しい。
る。即ち、θはE sin (wt ) 5in(θ)
/ E sin (wt ) cos (θ)の逆正接
と等しい。
入力信号がステーク巻線に加えられ出力信号がロータ巻
線により生じる場合にはレゾルバの別の接続(図示せず
)で代替することができることが判るであろう。この形
態におい又は、ステータの直角巻勝が90°の位相差の
入力信号即ち、E sin(wt)およびE sin
(wt + 90’ )により駆動される。ロータの変
位角は、出力信号Esin(wt+θ)における対応す
る位相のずれを生じて、これは位相弁別により検知され
ロータの変位角の全サイクルの一部θを表わす迎1定信
号ケ生じる。
線により生じる場合にはレゾルバの別の接続(図示せず
)で代替することができることが判るであろう。この形
態におい又は、ステータの直角巻勝が90°の位相差の
入力信号即ち、E sin(wt)およびE sin
(wt + 90’ )により駆動される。ロータの変
位角は、出力信号Esin(wt+θ)における対応す
る位相のずれを生じて、これは位相弁別により検知され
ロータの変位角の全サイクルの一部θを表わす迎1定信
号ケ生じる。
Farrand社から入手可能なInductosyn
(商標名)装置の如き電磁結合式線形測定装置ケ用い
て同じ形状の出力信号が得られることが判るであろう。
(商標名)装置の如き電磁結合式線形測定装置ケ用い
て同じ形状の出力信号が得られることが判るであろう。
インターフェース回路16.18は、レゾルバに対して
入力信号を与え、かつサンプルされ後続のアナログ/デ
ィジクル・コンバータ20,22に対する適当’4cレ
ベルに変換されろ出力信号を受取る、アナログ/ディジ
クル・コンバーク加、22は各々測定装置の可動要素の
出力信号の瞬時値を表わす出力信号を生じる。アナログ
/ディジタル・コンバータの出力は、レゾルバ出力から
の変位角を計算するため、また測定された位置に対し選
択された分解能に従って変位量の検量を行なうため、角
度計算回路30 、32に対して入力される。この角度
計算回路30.32の出力信号はステータに対するロー
タの変位角を表わし、有効回転サイクルに対してのみ一
義的即ち独特のものとなることが判るであろう。即ち、
もしレゾルバのロータの一回転力出力信号における変位
角の2回以上の反復サイクルを生じるならば、角度計算
回路30.32の出力信号は1サイクルと関連するレゾ
ルバのロータの一回転の一部に対してのみ一義的な信号
を生じることになる。望ましい実施態様において構成さ
れる如く5両方のレゾルバ出力に対し11つのA/Dコ
ンバータおよび角度計算回路が用いられるが、変換およ
び計算関数は時間の多連化操作による。
入力信号を与え、かつサンプルされ後続のアナログ/デ
ィジクル・コンバータ20,22に対する適当’4cレ
ベルに変換されろ出力信号を受取る、アナログ/ディジ
クル・コンバーク加、22は各々測定装置の可動要素の
出力信号の瞬時値を表わす出力信号を生じる。アナログ
/ディジタル・コンバータの出力は、レゾルバ出力から
の変位角を計算するため、また測定された位置に対し選
択された分解能に従って変位量の検量を行なうため、角
度計算回路30 、32に対して入力される。この角度
計算回路30.32の出力信号はステータに対するロー
タの変位角を表わし、有効回転サイクルに対してのみ一
義的即ち独特のものとなることが判るであろう。即ち、
もしレゾルバのロータの一回転力出力信号における変位
角の2回以上の反復サイクルを生じるならば、角度計算
回路30.32の出力信号は1サイクルと関連するレゾ
ルバのロータの一回転の一部に対してのみ一義的な信号
を生じることになる。望ましい実施態様において構成さ
れる如く5両方のレゾルバ出力に対し11つのA/Dコ
ンバータおよび角度計算回路が用いられるが、変換およ
び計算関数は時間の多連化操作による。
機械の可動部材の運動部、囲にわたっ壬周期的に反復す
る一義的な測定信号を生じろことができるどんな装置で
も上記の測定装置12.14.、 インターフェース回
路16.18. アナログ/ディジタル・コンバータ頷
、22および角度計算回路30.32の組合せに対する
適当な代替物となることは当業者には明らかであろう。
る一義的な測定信号を生じろことができるどんな装置で
も上記の測定装置12.14.、 インターフェース回
路16.18. アナログ/ディジタル・コンバータ頷
、22および角度計算回路30.32の組合せに対する
適当な代替物となることは当業者には明らかであろう。
このため、測定装置は、ポテンショメータ、レオスタッ
ト、可変変成器、または機械の可動部材の運動範囲にわ
たり周期的に反仲される一義的な測定信号を生じろどん
な線形測定装置でもよい。
ト、可変変成器、または機械の可動部材の運動範囲にわ
たり周期的に反仲される一義的な測定信号を生じろどん
な線形測定装置でもよい。
測定装置]、2.14は、副辿l定装置14が主地;定
装置12によるよりも機械の可動部材の運動か、囲にわ
たってその測定信号の1つ以上多いサイクルを生じるよ
うに栴成されて(・る。機械の可動部材がその基準位置
からその運動伸開の反対(Nllの極限まで進む時、測
定信号の差は増加する。このため、測定信号の差は常に
固定された基準値に関する絶対位置の一義的な表示を生
じる。測定信号が1つの完全サイクル以上は表わさない
ため、絶対位置の一義的な表示の形成には、演(1定倍
号間の差が運動部。
装置12によるよりも機械の可動部材の運動か、囲にわ
たってその測定信号の1つ以上多いサイクルを生じるよ
うに栴成されて(・る。機械の可動部材がその基準位置
からその運動伸開の反対(Nllの極限まで進む時、測
定信号の差は増加する。このため、測定信号の差は常に
固定された基準値に関する絶対位置の一義的な表示を生
じる。測定信号が1つの完全サイクル以上は表わさない
ため、絶対位置の一義的な表示の形成には、演(1定倍
号間の差が運動部。
囲にわたる完全な1サイクルを越えないことを要求する
。しかし、泪11定された角度における差が測定装置の
ロータに与えられた回転数に比例するが。
。しかし、泪11定された角度における差が測定装置の
ロータに与えられた回転数に比例するが。
副沖I定信号から主演11定装置が測定した角度を控除
するだけでは所要の差を結果とし1得ることな保証する
ことにはならない。その代り、副測定が主測定の測定信
号のサイクルと比較し又その測定信号の次のサイクルの
一部となることケ表示する負の差を生じることができる
ことを許容1−ろとが必要となる。
するだけでは所要の差を結果とし1得ることな保証する
ことにはならない。その代り、副測定が主測定の測定信
号のサイクルと比較し又その測定信号の次のサイクルの
一部となることケ表示する負の差を生じることができる
ことを許容1−ろとが必要となる。
第1図に関して記述を続けるならば、差の計算か必要な
結果に対する補償により全ての場合に正の出力を生じさ
せる差分回路により行なわれる。
結果に対する補償により全ての場合に正の出力を生じさ
せる差分回路により行なわれる。
もしこの控除操作が負の差を生じろtcらは、完全サイ
クルに等しい値がこの差に対して加えられろ。
クルに等しい値がこの差に対して加えられろ。
差の信号は、完全サイクルの一部を表わし、固定された
基準位置からその時の位置への機械の可動部材の変位量
に対応する主測定信号のサイクル数に正比例する。
基準位置からその時の位置への機械の可動部材の変位量
に対応する主測定信号のサイクル数に正比例する。
変位角が主測定信号のサイクル数と比1+11するため
、絶対位置は測定信号における差を知って容易に計算さ
れる。絶対位置は、主測定信号の計算されたサイクル数
を用いて第1図の絶対位置の計算回路26により計算さ
れる。絶対位置は、主測定装置と同じ解を表わす値とし
て表わされる。
、絶対位置は測定信号における差を知って容易に計算さ
れる。絶対位置は、主測定信号の計算されたサイクル数
を用いて第1図の絶対位置の計算回路26により計算さ
れる。絶対位置は、主測定装置と同じ解を表わす値とし
て表わされる。
絶対位置の値は主惧、定信号のサイクル数を係数化する
だけで計算することができるが2本出願人は、主測定装
置に対する副測定装置の測定信号における誤差を除去す
るため望ましい実施態様におい壬やや様雑なアルゴリズ
ムを使用する、第2しIのフローチャートは、絶対位置
の測定のため望ましい実施態様において使用されろ手順
を示している。この手順は、P対位置の値を合成するた
め基準位置からその時の位置までの距離に対応する主測
定信号の完全サイクルの最も近似する数を計算−する。
だけで計算することができるが2本出願人は、主測定装
置に対する副測定装置の測定信号における誤差を除去す
るため望ましい実施態様におい壬やや様雑なアルゴリズ
ムを使用する、第2しIのフローチャートは、絶対位置
の測定のため望ましい実施態様において使用されろ手順
を示している。この手順は、P対位置の値を合成するた
め基準位置からその時の位置までの距離に対応する主測
定信号の完全サイクルの最も近似する数を計算−する。
第2図のフローチャートにおいては2手順はステップ4
0で始まり、ここで各々が完全な1サイクルの一部?表
わす主測定信号Xおよび副測定信号Yの値が読取られる
。測定信号XおよびYは、所要の分解能に関する値2例
えば回転角度の約245mm(1インチ)の十分のいく
つの値を表わすようにスケールを合わされる、ステップ
42においては。
0で始まり、ここで各々が完全な1サイクルの一部?表
わす主測定信号Xおよび副測定信号Yの値が読取られる
。測定信号XおよびYは、所要の分解能に関する値2例
えば回転角度の約245mm(1インチ)の十分のいく
つの値を表わすようにスケールを合わされる、ステップ
42においては。
主測定値を副測定値から控除することにより差の値が計
算される、判断ステップ44におい又は、処理ステップ
42の結果が調べられ℃負の値が生じたかどうかを判定
する。もしそうでなげねば、処理ステップ48において
手順の実行が継続することになる。しかし、もし負の値
が検出されるならば。
算される、判断ステップ44におい又は、処理ステップ
42の結果が調べられ℃負の値が生じたかどうかを判定
する。もしそうでなげねば、処理ステップ48において
手順の実行が継続することになる。しかし、もし負の値
が検出されるならば。
手順の実行は処理ステップ46へ継続し、ここで主測定
信号の一完全サイクルに等しい値が加算される。次に処
理ステップ4.6−1:たは正の場合のステップ42の
結果のいずれかが処理ステップ48により用いられて主
レゾルバの測定信号の整数のサイクル数を計算する。
信号の一完全サイクルに等しい値が加算される。次に処
理ステップ4.6−1:たは正の場合のステップ42の
結果のいずれかが処理ステップ48により用いられて主
レゾルバの測定信号の整数のサイクル数を計算する。
主測定信号のサイクル数は2児全サイクル1と部分サイ
クルの相として表わすことができる。部分サイクルのみ
が主測定信号Xによって表わされる。副測定装置のロー
タが相対比率(M+、1)/M(但し2Mは機械の可動
部材の運勧軛回内に冗了した主測定信号のサイクル数に
等しい)により主測定装置のロータに関連付けられるも
のとし。
クルの相として表わすことができる。部分サイクルのみ
が主測定信号Xによって表わされる。副測定装置のロー
タが相対比率(M+、1)/M(但し2Mは機械の可動
部材の運勧軛回内に冗了した主測定信号のサイクル数に
等しい)により主測定装置のロータに関連付けられるも
のとし。
また両方の装置のロータの各回転が各曲1定個号の1サ
イクルを生じるものとすれば、 1il11測定装置の
サイクルは(I+X+I/M+X/M)と等しい。
イクルを生じるものとすれば、 1il11測定装置の
サイクルは(I+X+I/M+X/M)と等しい。
再び、完全サイクルの一部のみが1世11定仙号Yによ
り衣わされろ。制止11定装置の池;定倍+5Yか主装
置の渭・定信号Xより大きいかあるいけとハと等しい萌
、最後の3項(X十I /M、+X/M )σ)和は副
測定信号の大きさに等しい。畠1j測定倍号Yか主測宗
信号Xよりも小さければ、最後の3項の相は副測定信号
Yの大きさよりも1だげ大きい。従って、主迎1定信号
の整数値のサイクル■は下式から既知量を用いて計算す
ることができろ。Ialち。
り衣わされろ。制止11定装置の池;定倍+5Yか主装
置の渭・定信号Xより大きいかあるいけとハと等しい萌
、最後の3項(X十I /M、+X/M )σ)和は副
測定信号の大きさに等しい。畠1j測定倍号Yか主測宗
信号Xよりも小さければ、最後の3項の相は副測定信号
Yの大きさよりも1だげ大きい。従って、主迎1定信号
の整数値のサイクル■は下式から既知量を用いて計算す
ることができろ。Ialち。
I = M(DIFF)−X
但し、DIFFは前に述べたように正の結果を生じるよ
うに調整さねた差の値(Y−X)である。
うに調整さねた差の値(Y−X)である。
処理ステップ48においては、差の信号を用いて主レゾ
ルバの整数回のサイクルを表わす整数のサイクル信号1
を生じろ。差の値DIFFは測定帥。
ルバの整数回のサイクルを表わす整数のサイクル信号1
を生じろ。差の値DIFFは測定帥。
囲にわたる副レゾルバのサイクル数Mで乗ぜられ。
主地・定信号Xの狙i定値で表わされるーサイクルの一
部が前記積の結果から減算される。その結果の差は、主
レゾルバの測定信号のサイクル内の解の数と対応1−ろ
スケール因?Sで除される。測定信号における相対誤差
は、この結果を全数の外に残Rとして見せかげることに
なる。舛埋ステップ49においては、残Rの大きさか測
定されろ。もし残Rが主測定信号のサイクルの半分より
太キいかこれと等しければ、整数値Iは処理ステップ5
0において1だげ増分されろ。もし残Rが生前・定信号
の一サイクルの半分よりも小さげれば、整数値Tに対し
て変化が生じない。処理ステップ52においては、処理
ステップ48乃至50から結果として得られる整数値■
と、主測定係号の1サイクル内に含まれる回転の数と対
応するスケール因数Sとの積か、処理ステップ40にお
いて読出されろ主測定信号Xの値に加算される。
部が前記積の結果から減算される。その結果の差は、主
レゾルバの測定信号のサイクル内の解の数と対応1−ろ
スケール因?Sで除される。測定信号における相対誤差
は、この結果を全数の外に残Rとして見せかげることに
なる。舛埋ステップ49においては、残Rの大きさか測
定されろ。もし残Rが主測定信号のサイクルの半分より
太キいかこれと等しければ、整数値Iは処理ステップ5
0において1だげ増分されろ。もし残Rが生前・定信号
の一サイクルの半分よりも小さげれば、整数値Tに対し
て変化が生じない。処理ステップ52においては、処理
ステップ48乃至50から結果として得られる整数値■
と、主測定係号の1サイクル内に含まれる回転の数と対
応するスケール因数Sとの積か、処理ステップ40にお
いて読出されろ主測定信号Xの値に加算される。
処理ステップ48.50.52の作用は2作用ステップ
40において読出されろ値の相対誤差を排除することで
ある。ステップ4.9.50 &迂回すると、1サイク
ルの半分より小さいかこれと等しい主測定信号のサイク
ルの一″gSを有効に加算またしま減算することにより
1つの整数を生じる。この整数値■は必要に応じて訂正
され、このように除去された部分サイクルは主測定装置
の実際に辿1定された値で置俣されろ。このたぬ9手順
は主レゾルバの測定信号の1ザイクルと対応する解の一
部より大火くかい主および制御・定装置の測定における
差の誤差に対しては有効でル)ろ。
40において読出されろ値の相対誤差を排除することで
ある。ステップ4.9.50 &迂回すると、1サイク
ルの半分より小さいかこれと等しい主測定信号のサイク
ルの一″gSを有効に加算またしま減算することにより
1つの整数を生じる。この整数値■は必要に応じて訂正
され、このように除去された部分サイクルは主測定装置
の実際に辿1定された値で置俣されろ。このたぬ9手順
は主レゾルバの測定信号の1ザイクルと対応する解の一
部より大火くかい主および制御・定装置の測定における
差の誤差に対しては有効でル)ろ。
工業相マニピュレータに対する制宿[部に用いられろ場
合、第2図のフローチャートの手111g(は、整数演
算の実行が可能なマイクロプロセッサに対するプログラ
ムに変換される。本実施態様においては、第1図のブロ
ック図の差の計算回路24および絶対位宵計算回路26
は、第2図のフローチャートの手順を達成するためマイ
クロプロセッサおよびそのためのプログラムを用いて構
成される。更に。
合、第2図のフローチャートの手111g(は、整数演
算の実行が可能なマイクロプロセッサに対するプログラ
ムに変換される。本実施態様においては、第1図のブロ
ック図の差の計算回路24および絶対位宵計算回路26
は、第2図のフローチャートの手順を達成するためマイ
クロプロセッサおよびそのためのプログラムを用いて構
成される。更に。
この手順において用いられる値の一陥的な格納はランダ
ム・アクセス・メモリー内の記憶場所によって行なわれ
る。
ム・アクセス・メモリー内の記憶場所によって行なわれ
る。
第3図においては、主および制御1定装置の機械的構成
と共に駆動′@、楡が示されている。主レゾルバ60お
よび副レゾルバ62は、それらの各々の減速歯車64.
66を介して共通の駆動軸に対し歯車で結合されている
。駆動歯車68は9機械の可動部材を駆動するモータに
よって直接駆動されろ軸によって駆動することができ、
あるいは機械の可動部材の運動によりラックおよびピニ
オンまたは他の適当な装置によっ壬躯動することもで゛
きろ。いずれの場合にも、もし主レゾルバ60および副
レゾルバ62が同じものであるならば、駆動両津68に
対する主レゾルバの歯車66の歯車比、およびW=…車
68に対する副レゾルバの歯型64の歯車比におけろ比
較的小さな差が、m械の可動部材の運動範囲にわたって
主迎1定信号と比較した開演11定信号のサイクル数に
おけろ所要の差を生じる。詳しくは。
と共に駆動′@、楡が示されている。主レゾルバ60お
よび副レゾルバ62は、それらの各々の減速歯車64.
66を介して共通の駆動軸に対し歯車で結合されている
。駆動歯車68は9機械の可動部材を駆動するモータに
よって直接駆動されろ軸によって駆動することができ、
あるいは機械の可動部材の運動によりラックおよびピニ
オンまたは他の適当な装置によっ壬躯動することもで゛
きろ。いずれの場合にも、もし主レゾルバ60および副
レゾルバ62が同じものであるならば、駆動両津68に
対する主レゾルバの歯車66の歯車比、およびW=…車
68に対する副レゾルバの歯型64の歯車比におけろ比
較的小さな差が、m械の可動部材の運動範囲にわたって
主迎1定信号と比較した開演11定信号のサイクル数に
おけろ所要の差を生じる。詳しくは。
機械の可動部材の運動範囲にわたって完了した主測定信
号のサイクル数をMとすると、主レゾルバのロータに対
する副レゾルバのロータの所要の相対的な歯車減速比は
(M+1)/Mとなる。前述の如く、この簡素化された
歯車列は1つの測定装置を介して所要の解を得、かつ第
2のまたは他の測定装置により機械の全軸線を網羅する
ため公知のシステムにおい又必要とされる大きな歯車減
速に勝る顕著な利点を提供するものである。以上の記述
から、単一の辿1定装置を選択された分解能および蜘1
線範囲のため専用化することによるのではなく、主およ
び副測定装置により画定された差の変位量から一義的な
徂1定倍号を得ることが容易に理解されよう。
号のサイクル数をMとすると、主レゾルバのロータに対
する副レゾルバのロータの所要の相対的な歯車減速比は
(M+1)/Mとなる。前述の如く、この簡素化された
歯車列は1つの測定装置を介して所要の解を得、かつ第
2のまたは他の測定装置により機械の全軸線を網羅する
ため公知のシステムにおい又必要とされる大きな歯車減
速に勝る顕著な利点を提供するものである。以上の記述
から、単一の辿1定装置を選択された分解能および蜘1
線範囲のため専用化することによるのではなく、主およ
び副測定装置により画定された差の変位量から一義的な
徂1定倍号を得ることが容易に理解されよう。
本文に述べたマニピュレータに用いられる時。
絶対位置計I定装置はマニピュレータの回転軸心の位置
ン油・定ヤろため用いられる、この測定装置し耐。
ン油・定ヤろため用いられる、この測定装置し耐。
運動可能な部材の運動を生じろモータから直接両車減速
″il−ろことにより駆動される。それにも拘らず、不
文に述べたレゾルバの如き回転要素な有てろ測定装置を
駆動するか、あるいは2つの尺度および2つの読出しヘ
ッドを有する勝形向1定装置を用いることにより、上記
の同じ@置および方法が直線的な連動軸を有する機械に
対する応用にも適するものである。
″il−ろことにより駆動される。それにも拘らず、不
文に述べたレゾルバの如き回転要素な有てろ測定装置を
駆動するか、あるいは2つの尺度および2つの読出しヘ
ッドを有する勝形向1定装置を用いることにより、上記
の同じ@置および方法が直線的な連動軸を有する機械に
対する応用にも適するものである。
本発明については望ましい実施態様により例示し、望ま
しい実施態様についてはかなり詳細に記述したが2本発
明の範囲をかかる細部に限定することを意図するもので
にない。反対に5頭書の特許請求の範囲内に妥当する全
ての変更、改変および相等内容を網碌することを意しl
−jるものである。
しい実施態様についてはかなり詳細に記述したが2本発
明の範囲をかかる細部に限定することを意図するもので
にない。反対に5頭書の特許請求の範囲内に妥当する全
ての変更、改変および相等内容を網碌することを意しl
−jるものである。
第1図は本発明による絶、対位置の副官のための装置を
示すブロック図、第2図は2つの周期的な測定信号から
絶対位置を決定するため用いられる方法を示すフローチ
ャート、および第3図は回転要素および関連″tろ駆動
機##を備えた2つの測定装置を示す概略図である。 12・・・主測定装置、14・・・副辿l定装置、16
・・・インターフェース回路、18・・・インターフェ
ース回路、 20. 22・・・アナログ/ディジタル
φコンバータ、24・・・差の計算回路、26・・・絶
対位置の計算回路、30.32・・・角度の計算回路、
60・・・主レゾルバ、62・・・副レゾルバ、64.
66・・・減速歯車、68・・・駆動歯車。
示すブロック図、第2図は2つの周期的な測定信号から
絶対位置を決定するため用いられる方法を示すフローチ
ャート、および第3図は回転要素および関連″tろ駆動
機##を備えた2つの測定装置を示す概略図である。 12・・・主測定装置、14・・・副辿l定装置、16
・・・インターフェース回路、18・・・インターフェ
ース回路、 20. 22・・・アナログ/ディジタル
φコンバータ、24・・・差の計算回路、26・・・絶
対位置の計算回路、30.32・・・角度の計算回路、
60・・・主レゾルバ、62・・・副レゾルバ、64.
66・・・減速歯車、68・・・駆動歯車。
Claims (1)
- 1.2つより多くない測定装置の測定値を用いてiJ、
動可能、な機械の部材の運動範囲内の全1の位置に対す
る一義的な値を有する絶対位置の信号を生じる方法にお
いて。 (a)第1の測定装置の運動可能要素に対して与えられ
た変位量を表わす主測定信号を生じ、該主測定信号は機
械の部材の運動郵、囲にわたって周期的に反復するよう
になし。 (1〕)第2の測定装置の運動可能要素に対して与えら
れた変位量を表わす副測定信号を生じ、該、aIJ I
j!ll定信号は前記機械の部材の運動範囲にわたっ℃
周期的に反復し、副測定信号のサイクル数は前記機械の
部材の運動範囲にわたっ℃主測定信号のサイクル数より
1つ以上多くならないようになし。 (cl 前記主測定信号と副測定信号に応答して。 測定信号により表わされる変位量の差を表わす差信号を
生じ。 (d) 前記差信号に応答して、運動可能、な前記機械
の部材の位置と対応する一義的な値を表わす絶対位置信
号を生じることからなることを特徴とする方法。 2、特許請求の範囲第1項記載の方法において。 差信号を生じる前記工程が、更に (al 副測定信号から主測定信号を減算し。 (b) 前記減算結果を調べて負の差値であるが否かを
検出し。 (c) 負の結果の検出に応答し壬、前記主測定信号の
完全な1サイクル!に等しい1つの値を前記結果に加算
する工程を含むことを特徴とする方法。 3、特許請求の範囲第1項記載の方法において。 前記絶対位置信号を生じる前記工程か更に(a) 前記
運動可能な機械の部材のその時の位置と対応する主測定
信号の整数のサイクル数を表わす整数のサイクル信号を
生じ。 (b) 前記主測定信号に対し前記整数のサイクル信号
を加算し。 (c) 前記加算結果をスケール調整して前記絶対位置
信号を生じる工程ケ含むことを特徴とする方法。 4、固定された基準位置に対する運動可能な機械部材の
絶対位置を測定する装置におい壬。 (a) 前記機械の部材の運動により主装置の運動可能
要素に対し与えられた変位量を表わす主測定信号を生じ
ろ主測定装置を設け、前記主測定信号は前記機械部材の
運動範囲にわたっ℃周期的に反復するようになし。 (bl 前記機械部材の運動により副装置の運動可能要
素に対して与えられた変位量な表わす副測定信号を生じ
る副測定装置を設け、前記副測定信号は前記機械部材の
運動範囲にわたって周期的に反復し、前記副測定信号の
サイクル数は前記機械部材の運動範囲にわたって前記主
測定信号のサイクル数より1つ以上多いことはないよう
になし。 (c’l 前記主測定信号と副測定信号に応答し℃。 前記測定信号により表わされた変位量におげろ差を表わ
す差信号を生じる装置と。 (di 前記差信号に応答して、前記機械部材の絶対位
置を規定する一義的な値を表わす絶対位置信号を生じる
装置を設けることを特徴とする装置。 5、%許精求の範囲第4項記載の装置において。 (a) 回転可能な要素を有する角度測定装置と。 fb) 前記の運動可能な機械部材と結合されて前記の
回転可能な要素に対して回転運動を与える駆動装置とを
更に設けることを特徴とする装置。 6、@許請求の範囲第5項記載f)装置において。 (a)回転可能な要素を有する角度測定装置と。 (b)前記運動可能な機械部材と結合されて前記回転可
能要素に対して回転運動ケ与える部側装置を更に設ける
ことを特徴とする装置。 7、tp!j許請求の範囲第4項記載の装置において。 Ia) 前記副測定信号から前記主測定信号を減算する
装置と。 (b)負の差値な検出する装置と。 (C)負の差値の検出に応答して前記の差値に対し主測
定信号の1サイクルの相等値を加算する装置とを設ける
ことを特徴とする装置。 8、特許請求の範囲第4項記載の装置において。 前記主測定装置と副測定装置の運動可能要素の測定され
た変位量をスケール調整する装置を更に設けることを特
徴こする装置。 9、特許請求の範囲第8項記載の装置におい又。 前記絶対位置信号を生じろ前記装置が更に差信号をスケ
ール調整する装置を含むことを特徴とする装置。 10、固定された基準位置に対する運動可能な機械部材
の絶対位置を測定する装置において。 (a’1 回転運動するその要素に対して与えられる変
位角に比例する主測定信号を生じる主角度測定装置と。 (bl 副測定装置の回転要素に対して与−えられる変
位角に比例する副測定信号を生じろ軸角度測定装置と。 (cl 前記の)2i!動可能な機械部材の運動に従っ
て前記主および副測定装置の回転要素を駆動する装置と
を設け、該駆動装置は、前記機械部材の運動範囲、従っ
て主測定信号のサイクル数にわたつて前記副測定信号の
1サイクル以上のサイクルを生じることのないよう作用
し。 (d) 前記主測定信号および副測定信号に応答して、
前記両測定装置の回転要素の変位角の差を表わす差信号
を生じる装置と。 (e)前記差信号に応答して、前記運動可能な機械部材
の絶対位置を規定する一義的な値を表わす絶対位置信号
を生じる装置とを設けろことを特徴とする装置。 11、%許請求の範囲第10項記載の装置において。 (al その時の位置に対応する主測定信号の整数のサ
イクル数を表わす整数のサイクル信号を生じる装置と。 (b)前記整数のサイクル信号および主測定信号を加算
して前記絶対位置信号を生じる装置とを設けることを特
徴とする装置。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
US57726284A | 1984-02-06 | 1984-02-06 | |
US577262 | 1984-02-06 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPS60183515A true JPS60183515A (ja) | 1985-09-19 |
JPH0629723B2 JPH0629723B2 (ja) | 1994-04-20 |
Family
ID=24307961
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP60016370A Expired - Lifetime JPH0629723B2 (ja) | 1984-02-06 | 1985-01-30 | 絶対位置の測定方法およびその装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPH0629723B2 (ja) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS63286705A (ja) * | 1987-05-20 | 1988-11-24 | Mitsubishi Heavy Ind Ltd | ロボットの位置検出方法 |
JP2006258730A (ja) * | 2005-03-18 | 2006-09-28 | Komatsu Ltd | 油圧作業機械における油圧シリンダのストローク位置計測装置 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS5499528A (en) * | 1978-01-24 | 1979-08-06 | Komatsu Mfg Co Ltd | Position detector using absolute encoder |
JPS57171207A (en) * | 1981-04-15 | 1982-10-21 | Mitsubishi Heavy Ind Ltd | Position detector |
-
1985
- 1985-01-30 JP JP60016370A patent/JPH0629723B2/ja not_active Expired - Lifetime
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS5499528A (en) * | 1978-01-24 | 1979-08-06 | Komatsu Mfg Co Ltd | Position detector using absolute encoder |
JPS57171207A (en) * | 1981-04-15 | 1982-10-21 | Mitsubishi Heavy Ind Ltd | Position detector |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS63286705A (ja) * | 1987-05-20 | 1988-11-24 | Mitsubishi Heavy Ind Ltd | ロボットの位置検出方法 |
JP2006258730A (ja) * | 2005-03-18 | 2006-09-28 | Komatsu Ltd | 油圧作業機械における油圧シリンダのストローク位置計測装置 |
Also Published As
Publication number | Publication date |
---|---|
JPH0629723B2 (ja) | 1994-04-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US5612906A (en) | System for the measurement of the absolute position of the movable cyclic division mark carrier of an incremental position indicator | |
JP3143310B2 (ja) | 位置検出装置、補正機能付位置検出装置、位置検出方法、および、位置検出装置の補正方法 | |
KR101502259B1 (ko) | 다회전 앱솔루트 회전각을 검출하는 장치 및 그 회전각을 검출하는 방법 | |
EP2789967B1 (en) | Multi-turn absolute rotation angle detection device and method for detecting absolute rotation angle | |
JPH0373808B2 (ja) | ||
US4272818A (en) | Position feedback control system for a numerically controlled machine tool | |
JPH0255837B2 (ja) | ||
JPH0465985B2 (ja) | ||
KR101192505B1 (ko) | 위상 검출 장치 및 위치 검출 장치 | |
US6571194B2 (en) | Position detection data generating method and apparatus based on phase shift principle | |
US4095158A (en) | Position-controlling system | |
JP3365063B2 (ja) | 回転角度検出方法 | |
JPS60183515A (ja) | 絶対位置の測定方法およびその装置 | |
JPS61137011A (ja) | エンコ−ダ出力の精度向上方法 | |
JPH04524B2 (ja) | ||
KR900005879B1 (ko) | 펄스 분배형 위치 검출 장치 | |
JP6589107B2 (ja) | 変調波レゾルバ装置 | |
JPH0521166B2 (ja) | ||
JPS6110715A (ja) | 絶対位置検出方式 | |
WO1986000430A1 (en) | Apparatus for detecting absolute position of servo control system | |
JPS61110005A (ja) | 位置検出方法および装置 | |
JPS59225316A (ja) | 回転形絶対値検出器を用いた絶対位置検出方法 | |
RU2094945C1 (ru) | Быстродействующий многофункциональный преобразователь угла в код для устройств электромеханотроники | |
JP4123362B2 (ja) | フルクローズド制御装置の絶対位置検出方法 | |
US20040233080A1 (en) | Encoder output divider and R/D converter |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
EXPY | Cancellation because of completion of term |