JP3429414B2 - ロボットの無限回転制御方法 - Google Patents
ロボットの無限回転制御方法Info
- Publication number
- JP3429414B2 JP3429414B2 JP19940296A JP19940296A JP3429414B2 JP 3429414 B2 JP3429414 B2 JP 3429414B2 JP 19940296 A JP19940296 A JP 19940296A JP 19940296 A JP19940296 A JP 19940296A JP 3429414 B2 JP3429414 B2 JP 3429414B2
- Authority
- JP
- Japan
- Prior art keywords
- rotation
- encoder
- spin
- enc
- infinite
- 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
Landscapes
- Manipulator (AREA)
Description
【０００１】
【発明の属する技術分野】本発明は、ロボットの回転軸
を無限に回転する無限回転制御方法および装置に関す
る。
を無限に回転する無限回転制御方法および装置に関す
る。
【０００２】
【従来の技術】ロボットの無限回転制御方法として、た
とえば特開平６−７９６７４号公報に開示されたものが
存在する。この無限回転制御方法を適用した装置は、回
転制御される回転軸と、回転軸を駆動するための駆動手
段と、駆動手段の回転数を検出するエンコーダと、回転
軸と駆動手段の間に介在された減速装置と、を備えてい
る。そして、減速装置による回転数の比、すなわち駆動
手段の回転数Ｎと回転軸の回転数Ｍとの回転比Ｒ（Ｒ＝
Ｎ／Ｍ）が２のＰ乗（Ｐ：整数）なるように設定されて
いる。この装置において、無限回転のときには、無限回
転制御手段が前記駆動手段を作動制御し、回転軸が所定
回転数に達したときに駆動手段の作動を停止する。
とえば特開平６−７９６７４号公報に開示されたものが
存在する。この無限回転制御方法を適用した装置は、回
転制御される回転軸と、回転軸を駆動するための駆動手
段と、駆動手段の回転数を検出するエンコーダと、回転
軸と駆動手段の間に介在された減速装置と、を備えてい
る。そして、減速装置による回転数の比、すなわち駆動
手段の回転数Ｎと回転軸の回転数Ｍとの回転比Ｒ（Ｒ＝
Ｎ／Ｍ）が２のＰ乗（Ｐ：整数）なるように設定されて
いる。この装置において、無限回転のときには、無限回
転制御手段が前記駆動手段を作動制御し、回転軸が所定
回転数に達したときに駆動手段の作動を停止する。
【０００３】
【発明が解決しようとする課題】しかしながら、この従
来の回転制御方法では、減速手段による回転比Ｒが２の
Ｐ乗となっているので、回転軸の回転比を設定する際上
記条件を満さなけらばならず、それ故に、無限回転式ロ
ボットを設計する際に上記条件が設計上の制約条件とな
る問題がある。
来の回転制御方法では、減速手段による回転比Ｒが２の
Ｐ乗となっているので、回転軸の回転比を設定する際上
記条件を満さなけらばならず、それ故に、無限回転式ロ
ボットを設計する際に上記条件が設計上の制約条件とな
る問題がある。
【０００４】本発明の目的は、減速手段による回転比を
自由に設定することができるロボットの無限回転制御方
法および装置を提供することである。
自由に設定することができるロボットの無限回転制御方
法および装置を提供することである。
【０００５】本発明の他の目的は、減速手段による回転
比を任意に設定した場合において、ロボットが故障等に
より回転停止したときでもその角度位置を正確に検出す
ることができる無限回転制御方法および装置を提供する
ことである。
比を任意に設定した場合において、ロボットが故障等に
より回転停止したときでもその角度位置を正確に検出す
ることができる無限回転制御方法および装置を提供する
ことである。
【０００６】
【課題を解決するための手段】本発明は、回転自在に支
持された回転軸（６）と、該回転軸を回転駆動するため
の駆動手段（２４）と、該駆動手段の出力軸（５０）と
前記回転軸（６）との間に介在され、前記駆動手段の出
力軸がＮ回転したとき前記回転軸をＭ回転させるように
回転比Ｒ（＝Ｎ／Ｍ）が設定された減速手段（４８）
と、前記回転軸（６）の回転を制御する主制御手段と、
前記回転軸（６）の無限回転を制御し、スピンエンコー
ダを有する無限回転制御手段と、を備えたロボットにお
ける無限回転制御方法であって、駆動手段（２４）の出
力軸（５０）の回転数をエンコーダ（２０）によって検
出し、無限回転制御手段は、エンコーダ（２０）によっ
て検出した回転量Ａを、前記スピンエンコーダのスピン
エンコーダ値ＥＮＣに加算してゆき、前記出力軸（５
０）が１回転することによるエンコーダ（２０）の回転
量をＢとするとき、ＥＮＣ÷（Ｂ×Ｎ／Ｍ）を演算し、
スピンエンコーダ値ＥＮＣが、（Ｂ×Ｎ）以下であると
き、前記演算して求めたＥＮＣ÷（Ｂ×Ｎ／Ｍ）の商
を、回転軸（６）のスピン回転数ＲＯＴとし、前記演算
して求めたＥＮＣ÷（Ｂ×Ｎ／Ｍ）の余りを、回転軸
（６）の回転角度位置とし、スピンエンコーダ値ＥＮＣ
が、（Ｂ×Ｎ）を超えたとき、スピンエンコーダ値ＥＮ
Ｃとして、 ＥＮＣ−（Ｂ×Ｎ） を演算することを特徴とするロボットの無限回転制御方
法である。また本発明は、回転自在に支持された回転軸
（６）と、該回転軸を回転駆動するための駆動手段（２
４）と、該駆動手段の出力軸（５０）と前記回転軸
（６）との間に介在され、前記駆動手段の出力軸がＮ回
転したとき前記回転軸をＭ回転させるように回転比Ｒ
（＝Ｎ／Ｍ）が設定された減速手段（４８）と、前記回
転軸（６）の回転を制御する主制御手段と、前記回転軸
（６）の無限回転を制御し、スピンエンコーダを有する
無限回転制御手段と、駆動手段（２４）の出力軸（５
０）の回転数を検出するエンコーダ（２０）と、を備
え、無限回転制御手段は、エンコーダ（２０）によって
検出した回転量Ａを、前記スピンエンコーダのスピンエ
ンコーダ値ＥＮＣに加算してゆき、前記出力軸（５０）
が１回転することによるエンコーダ（２０）の回転量を
Ｂとするとき、ＥＮＣ÷（Ｂ×Ｎ／Ｍ）を演算し、スピ
ンエンコーダ値ＥＮＣが、（Ｂ×Ｎ）以下であるとき、
前記演算して求めたＥＮＣ÷（Ｂ×Ｎ／Ｍ）の商を、回
転軸（６）のスピン回転数ＲＯＴとし、前記演算して求
めたＥＮＣ÷（Ｂ×Ｎ／Ｍ）の余りを、回転軸（６）の
回転角度位置とし、スピンエンコーダ値ＥＮＣが、（Ｂ
×Ｎ）を超えたとき、スピンエンコーダ値ＥＮＣとし
て、 ＥＮＣ−（Ｂ×Ｎ） を演算することを特徴とするロボットの無限回転制御装
置である。本発明に従えば、駆動手段２４の出力軸５０
の回転数Ｎと回転軸６の回転数Ｍの回転比ＲがＮ／Ｍ
（ただしＮ＞Ｍ）に設定され、したがって出力軸５０が
Ｎ回転すれば、無限回転制御手段の計数値、すなわち回
転軸６の回転数がＭ増加する。無限回転制御手段１２に
含まれるスピンエンコーダは、出力軸５０が１回転する
ことによるエンコーダ２０の回転量をＢ（たとえば後述
のように「８１９２」）とするとき、（Ｂ×Ｎ）以下の
計数が可能であり、このスピンエンコーダの出力ＥＮＣ
は、エンコーダ２０によって検出した出力軸５０の回転
量Ａを、加算してゆく。このスピンエンコーダの出力で
あるスピンエンコーダ値ＥＮＣが、（Ｂ×Ｎ）以下であ
るとき、後述の図６のステップＳ１４に示されるよう
に、ＥＮＣ÷（Ｂ×Ｎ／Ｍ）を演算し、前記演算して求
めたＥＮＣ÷（Ｂ×Ｎ／Ｍ）の商を、回転軸６のスピン
回転数ＲＯＴとし、その商の余りを、回転軸６の１回転
中の回転角度位置とする。スピンエンコーダ値ＥＮＣが
（Ｂ×Ｎ）を超えたとき、（Ｂ×Ｎ）を減算し、スピン
エンコーダ値ＥＮＣがオーバフローすることを防ぐ。し
たがって減速手段の回転比Ｒ（Ｒ＝Ｎ／Ｍ）の値がどの
ような値であっても、回転軸６の回転数および１回転中
の回転角度位置の検出を行うことができる。
持された回転軸（６）と、該回転軸を回転駆動するため
の駆動手段（２４）と、該駆動手段の出力軸（５０）と
前記回転軸（６）との間に介在され、前記駆動手段の出
力軸がＮ回転したとき前記回転軸をＭ回転させるように
回転比Ｒ（＝Ｎ／Ｍ）が設定された減速手段（４８）
と、前記回転軸（６）の回転を制御する主制御手段と、
前記回転軸（６）の無限回転を制御し、スピンエンコー
ダを有する無限回転制御手段と、を備えたロボットにお
ける無限回転制御方法であって、駆動手段（２４）の出
力軸（５０）の回転数をエンコーダ（２０）によって検
出し、無限回転制御手段は、エンコーダ（２０）によっ
て検出した回転量Ａを、前記スピンエンコーダのスピン
エンコーダ値ＥＮＣに加算してゆき、前記出力軸（５
０）が１回転することによるエンコーダ（２０）の回転
量をＢとするとき、ＥＮＣ÷（Ｂ×Ｎ／Ｍ）を演算し、
スピンエンコーダ値ＥＮＣが、（Ｂ×Ｎ）以下であると
き、前記演算して求めたＥＮＣ÷（Ｂ×Ｎ／Ｍ）の商
を、回転軸（６）のスピン回転数ＲＯＴとし、前記演算
して求めたＥＮＣ÷（Ｂ×Ｎ／Ｍ）の余りを、回転軸
（６）の回転角度位置とし、スピンエンコーダ値ＥＮＣ
が、（Ｂ×Ｎ）を超えたとき、スピンエンコーダ値ＥＮ
Ｃとして、 ＥＮＣ−（Ｂ×Ｎ） を演算することを特徴とするロボットの無限回転制御方
法である。また本発明は、回転自在に支持された回転軸
（６）と、該回転軸を回転駆動するための駆動手段（２
４）と、該駆動手段の出力軸（５０）と前記回転軸
（６）との間に介在され、前記駆動手段の出力軸がＮ回
転したとき前記回転軸をＭ回転させるように回転比Ｒ
（＝Ｎ／Ｍ）が設定された減速手段（４８）と、前記回
転軸（６）の回転を制御する主制御手段と、前記回転軸
（６）の無限回転を制御し、スピンエンコーダを有する
無限回転制御手段と、駆動手段（２４）の出力軸（５
０）の回転数を検出するエンコーダ（２０）と、を備
え、無限回転制御手段は、エンコーダ（２０）によって
検出した回転量Ａを、前記スピンエンコーダのスピンエ
ンコーダ値ＥＮＣに加算してゆき、前記出力軸（５０）
が１回転することによるエンコーダ（２０）の回転量を
Ｂとするとき、ＥＮＣ÷（Ｂ×Ｎ／Ｍ）を演算し、スピ
ンエンコーダ値ＥＮＣが、（Ｂ×Ｎ）以下であるとき、
前記演算して求めたＥＮＣ÷（Ｂ×Ｎ／Ｍ）の商を、回
転軸（６）のスピン回転数ＲＯＴとし、前記演算して求
めたＥＮＣ÷（Ｂ×Ｎ／Ｍ）の余りを、回転軸（６）の
回転角度位置とし、スピンエンコーダ値ＥＮＣが、（Ｂ
×Ｎ）を超えたとき、スピンエンコーダ値ＥＮＣとし
て、 ＥＮＣ−（Ｂ×Ｎ） を演算することを特徴とするロボットの無限回転制御装
置である。本発明に従えば、駆動手段２４の出力軸５０
の回転数Ｎと回転軸６の回転数Ｍの回転比ＲがＮ／Ｍ
（ただしＮ＞Ｍ）に設定され、したがって出力軸５０が
Ｎ回転すれば、無限回転制御手段の計数値、すなわち回
転軸６の回転数がＭ増加する。無限回転制御手段１２に
含まれるスピンエンコーダは、出力軸５０が１回転する
ことによるエンコーダ２０の回転量をＢ（たとえば後述
のように「８１９２」）とするとき、（Ｂ×Ｎ）以下の
計数が可能であり、このスピンエンコーダの出力ＥＮＣ
は、エンコーダ２０によって検出した出力軸５０の回転
量Ａを、加算してゆく。このスピンエンコーダの出力で
あるスピンエンコーダ値ＥＮＣが、（Ｂ×Ｎ）以下であ
るとき、後述の図６のステップＳ１４に示されるよう
に、ＥＮＣ÷（Ｂ×Ｎ／Ｍ）を演算し、前記演算して求
めたＥＮＣ÷（Ｂ×Ｎ／Ｍ）の商を、回転軸６のスピン
回転数ＲＯＴとし、その商の余りを、回転軸６の１回転
中の回転角度位置とする。スピンエンコーダ値ＥＮＣが
（Ｂ×Ｎ）を超えたとき、（Ｂ×Ｎ）を減算し、スピン
エンコーダ値ＥＮＣがオーバフローすることを防ぐ。し
たがって減速手段の回転比Ｒ（Ｒ＝Ｎ／Ｍ）の値がどの
ような値であっても、回転軸６の回転数および１回転中
の回転角度位置の検出を行うことができる。
【０００７】
【０００８】また本発明は、回転軸は、ロボットの先端
軸または外部軸としてサーボ制御されることを特徴とす
る。本発明に従えば、ロボットの先端軸または外部軸を
回転軸として適用することができる。
軸または外部軸としてサーボ制御されることを特徴とす
る。本発明に従えば、ロボットの先端軸または外部軸を
回転軸として適用することができる。
【０００９】
【発明の実施の形態】図１は本発明の一実施形態の無限
回転制御方法を適用したロボットの制御系を簡略的に示
すブロック図であり、図２は図１の制御系の電気的構成
を簡略的に示すブロック図であり、図３は図１のロボッ
トの簡略図である。
回転制御方法を適用したロボットの制御系を簡略的に示
すブロック図であり、図２は図１の制御系の電気的構成
を簡略的に示すブロック図であり、図３は図１のロボッ
トの簡略図である。
【００１０】図１〜図３において、図示のロボットは、
ロボット本体２を備えている。ロボット本体２は、第１
〜第５軸４としてサーボ制御される第１〜第５軸部材５
（旋回自在な５つの軸部材からなり、これらを総称して
第１〜第５軸部材と呼ぶ）と、第５軸部材の先端部に回
転自在に装着された先端軸６を有し、この先端軸６が第
６軸７としてサーボ制御される。実施の形態では、この
先端軸６が、後述する如く、主制御手段１０によって通
常に回転されるとともに、無限回転制御手段１２によっ
て無限回転される。
ロボット本体２を備えている。ロボット本体２は、第１
〜第５軸４としてサーボ制御される第１〜第５軸部材５
（旋回自在な５つの軸部材からなり、これらを総称して
第１〜第５軸部材と呼ぶ）と、第５軸部材の先端部に回
転自在に装着された先端軸６を有し、この先端軸６が第
６軸７としてサーボ制御される。実施の形態では、この
先端軸６が、後述する如く、主制御手段１０によって通
常に回転されるとともに、無限回転制御手段１２によっ
て無限回転される。
【００１１】第１〜第５軸部材４および回転軸としての
先端軸６は、ロボットの制御手段８によって作動制御さ
れる。制御手段８は主制御手段１０および無限回転制御
手段１２を有し、また第１〜第５軸４をサーボ制御する
第１サーボ制御手段１４（第１〜第５軸４の各軸に対応
してサーボ制御手段１４が設けられている）および第６
軸７をサーボ制御する第２サーボ制御手段１６を含んで
いる。また、第１〜第５軸４に関連して、その回転量を
検出するための第１エンコーダ１８（第１〜第５軸４の
各軸に対応してエンコーダ１８が設けられている）が設
けられているとともに、第６軸７に関連して、その回転
量を検出するための第２エンコーダ２０が設けられてい
る。第１〜第５軸４は、第１〜第５軸部材５をそれぞれ
回転駆動するための、たとえば電動モータでよい第１駆
動手段２２（第１〜第５軸４の各軸に対応して駆動手段
２２が設けられている）を含み、第１のエンコーダ１８
は第１の駆動手段２２の回転数を検出する。また、第６
軸７は、先端軸６を回転駆動するための第２の駆動手段
２４を有し、第２のエンコーダ２０は、第２の駆動手段
２４の回転数を検出する。
先端軸６は、ロボットの制御手段８によって作動制御さ
れる。制御手段８は主制御手段１０および無限回転制御
手段１２を有し、また第１〜第５軸４をサーボ制御する
第１サーボ制御手段１４（第１〜第５軸４の各軸に対応
してサーボ制御手段１４が設けられている）および第６
軸７をサーボ制御する第２サーボ制御手段１６を含んで
いる。また、第１〜第５軸４に関連して、その回転量を
検出するための第１エンコーダ１８（第１〜第５軸４の
各軸に対応してエンコーダ１８が設けられている）が設
けられているとともに、第６軸７に関連して、その回転
量を検出するための第２エンコーダ２０が設けられてい
る。第１〜第５軸４は、第１〜第５軸部材５をそれぞれ
回転駆動するための、たとえば電動モータでよい第１駆
動手段２２（第１〜第５軸４の各軸に対応して駆動手段
２２が設けられている）を含み、第１のエンコーダ１８
は第１の駆動手段２２の回転数を検出する。また、第６
軸７は、先端軸６を回転駆動するための第２の駆動手段
２４を有し、第２のエンコーダ２０は、第２の駆動手段
２４の回転数を検出する。
【００１２】実施形態では、主制御手段１０は、第１〜
第５軸４の回転量を制御するためのものであり、主制御
手段１０からの信号に基づいて第１サーボ制御手段１４
が、従来と同様に、第１駆動手段２２を作動制御し、こ
れによって第１〜第５軸部材２２が旋回または回転し、
その旋回または回転量は、第１エンコーダ１８により第
１サーボ制御手段１４にフィードバックされる。この主
制御手段１０は、第１〜第５軸４と同様に、第６軸７の
回転量を制御する。すなわち、主制御手段１０からの信
号に基づいて第２サーボ制御手段１６が第２駆動手段２
４を作動制御し、これによって先端軸６が回転し、その
回転量は、第２エンコーダ２０により第２サーボ制御手
段１６にフィードバックされる。なお、ワーク２６は、
先端軸６に着脱自在に保持される。
第５軸４の回転量を制御するためのものであり、主制御
手段１０からの信号に基づいて第１サーボ制御手段１４
が、従来と同様に、第１駆動手段２２を作動制御し、こ
れによって第１〜第５軸部材２２が旋回または回転し、
その旋回または回転量は、第１エンコーダ１８により第
１サーボ制御手段１４にフィードバックされる。この主
制御手段１０は、第１〜第５軸４と同様に、第６軸７の
回転量を制御する。すなわち、主制御手段１０からの信
号に基づいて第２サーボ制御手段１６が第２駆動手段２
４を作動制御し、これによって先端軸６が回転し、その
回転量は、第２エンコーダ２０により第２サーボ制御手
段１６にフィードバックされる。なお、ワーク２６は、
先端軸６に着脱自在に保持される。
【００１３】無限回転制御手段１２は、第６軸７を無限
回転するためのものであり、この無限回転制御手段１２
からの信号に基づいて第２サーボ制御手段１４が第２駆
動手段２４を作動制御して先端軸６を無限回転し、その
回転数等は第２エンコーダ２０により第２サーボ制御手
段１６にフィードバックされる。
回転するためのものであり、この無限回転制御手段１２
からの信号に基づいて第２サーボ制御手段１４が第２駆
動手段２４を作動制御して先端軸６を無限回転し、その
回転数等は第２エンコーダ２０により第２サーボ制御手
段１６にフィードバックされる。
【００１４】この実施形態では、第６軸７（先端軸６）
は、主制御手段１０による通常の回転と、無限回転制御
手段１２による無限回転の２つの回転動作を行うように
構成されている。なお、主制御手段１０と無限回転制御
手段１２とは相互に信号および情報の交換を行うように
構成されており、無限回転のとき主制御手段１０と無限
回転制御手段１２との間で信号、情報交換が行われる。
は、主制御手段１０による通常の回転と、無限回転制御
手段１２による無限回転の２つの回転動作を行うように
構成されている。なお、主制御手段１０と無限回転制御
手段１２とは相互に信号および情報の交換を行うように
構成されており、無限回転のとき主制御手段１０と無限
回転制御手段１２との間で信号、情報交換が行われる。
【００１５】制御手段８に関連して、入力手段２８が設
けられている。入力手段２８は、主制御手段１９による
通常回転および無限回転制御手段１２による無限回転の
制御を入力するためのものであり、入力手段２８によっ
て入力された信号は主制御手段１０および無限回転制御
手段１２に送給される。
けられている。入力手段２８は、主制御手段１９による
通常回転および無限回転制御手段１２による無限回転の
制御を入力するためのものであり、入力手段２８によっ
て入力された信号は主制御手段１０および無限回転制御
手段１２に送給される。
【００１６】ここで、無限回転用制御手段１２は、ソフ
ト的に主制御手段１０と別個に構成されているものであ
り、図２に示すように、ロボットの制御手段８のＲＯＭ
４０の中に無限回転用プログラムを格納することにより
構成されるものである。ＣＰＵ４４と第１サーボ制御手
段１４および第２サーボ制御手段１６との信号のやり取
りは、入出力インターフェース４６を介して行われる。
ト的に主制御手段１０と別個に構成されているものであ
り、図２に示すように、ロボットの制御手段８のＲＯＭ
４０の中に無限回転用プログラムを格納することにより
構成されるものである。ＣＰＵ４４と第１サーボ制御手
段１４および第２サーボ制御手段１６との信号のやり取
りは、入出力インターフェース４６を介して行われる。
【００１７】第６軸７の回転を検出する第２エンコーダ
２０の値は、主制御手段１０による通常回転時の回転量
と無限回転制御手段１２による無限回転時の回転量とが
含まれている。したがって、この実施形態においては、
第２エンコーダ２０の値は、第２サーボ制御部１６によ
って主制御手段１０による回転量と無限回転制御手段１
２による回転量とに分離され、分離された回転量がそれ
ぞれ主制御手段１０および無限回転制御手段１２にフィ
ードバックされる。第２エンコーダ２０の値（実効エン
コーダ値）Ｒのうち、第２サーボ制御手段１６にて分離
されて主制御手段１０に送給されて記憶されるのを仮想
エンコーダ値Ｉであり、同様に分離されて無限回転制御
手段１２に送給されて記憶されるのをスピンエンコーダ
値Ｓである。
２０の値は、主制御手段１０による通常回転時の回転量
と無限回転制御手段１２による無限回転時の回転量とが
含まれている。したがって、この実施形態においては、
第２エンコーダ２０の値は、第２サーボ制御部１６によ
って主制御手段１０による回転量と無限回転制御手段１
２による回転量とに分離され、分離された回転量がそれ
ぞれ主制御手段１０および無限回転制御手段１２にフィ
ードバックされる。第２エンコーダ２０の値（実効エン
コーダ値）Ｒのうち、第２サーボ制御手段１６にて分離
されて主制御手段１０に送給されて記憶されるのを仮想
エンコーダ値Ｉであり、同様に分離されて無限回転制御
手段１２に送給されて記憶されるのをスピンエンコーダ
値Ｓである。
【００１８】第６軸７に関連して、図４に示すとおり構
成されている。すなわち、第２駆動手段２４と先端軸６
との間には、減速手段４８が介在されている。減速手段
４８は、たとえば電動モータでよい駆動手段２４の出力
軸５０に装着された第１歯車５１と、先端軸６に固定さ
れた第２歯車５２を備えている。第２エンコーダ２０は
出力軸５０に装着され、出力軸５０と一体に回転する。
第１歯車５１の歯数はｍ個（たとえば２０個）に設定さ
れ、第２歯車５２の歯数はｎ個（たとえば６０個）に設
定され、このように設定したときには、第２駆動手段２
４の回転数と先端軸６の回転数の回転比Ｒは、ｎ／ｍ
（たとえばＲ＝６０／２０＝３／１＝Ｎ／Ｍ；Ｎ＝３、
Ｍ＝１）になり、第２駆動手段２４がＮ（たとえば３）
回転したとき先端軸６はＭ（たとえば１）回転する。な
お、実施形態では、減速手段４８を２個の歯車から構成
しているが、３個以上の歯車から構成することができ、
これら歯車の歯数を変更することによって第２駆動手段
２４の回転数と先端軸６の回転数との回転比Ｒを任意に
設定することができ、設計上の制約条件を少なくするこ
とができる。
成されている。すなわち、第２駆動手段２４と先端軸６
との間には、減速手段４８が介在されている。減速手段
４８は、たとえば電動モータでよい駆動手段２４の出力
軸５０に装着された第１歯車５１と、先端軸６に固定さ
れた第２歯車５２を備えている。第２エンコーダ２０は
出力軸５０に装着され、出力軸５０と一体に回転する。
第１歯車５１の歯数はｍ個（たとえば２０個）に設定さ
れ、第２歯車５２の歯数はｎ個（たとえば６０個）に設
定され、このように設定したときには、第２駆動手段２
４の回転数と先端軸６の回転数の回転比Ｒは、ｎ／ｍ
（たとえばＲ＝６０／２０＝３／１＝Ｎ／Ｍ；Ｎ＝３、
Ｍ＝１）になり、第２駆動手段２４がＮ（たとえば３）
回転したとき先端軸６はＭ（たとえば１）回転する。な
お、実施形態では、減速手段４８を２個の歯車から構成
しているが、３個以上の歯車から構成することができ、
これら歯車の歯数を変更することによって第２駆動手段
２４の回転数と先端軸６の回転数との回転比Ｒを任意に
設定することができ、設計上の制約条件を少なくするこ
とができる。
【００１９】この実施形態では、第２駆動手段２４の出
力軸５０の回転数を検出する手段としてエンコーダが用
いられ、たとえばこのエンコーダ２０のビット数が２１
ビットでもって構成され、２１ビットのうち下位１３ビ
ットが第２エンコーダ２０の回転円盤（図示せず）の１
回転中の回転角度位置検出に利用され、２１ビットのう
ち上位８ビットが第２エンコーダ２０の回転円盤の回転
数検出に利用される。したがって、第２エンコーダ２０
のエンコーダ値は、回転円盤が１回転すると、「０」か
ら「８１９２」に変化し、通常、回転軸６の動作範囲は
ある角度からある角度までと規定されているので、第２
エンコーダ２０の値は「０」〜「８１９２×２５６」の
間の一定範囲の値しかとらない。
力軸５０の回転数を検出する手段としてエンコーダが用
いられ、たとえばこのエンコーダ２０のビット数が２１
ビットでもって構成され、２１ビットのうち下位１３ビ
ットが第２エンコーダ２０の回転円盤（図示せず）の１
回転中の回転角度位置検出に利用され、２１ビットのう
ち上位８ビットが第２エンコーダ２０の回転円盤の回転
数検出に利用される。したがって、第２エンコーダ２０
のエンコーダ値は、回転円盤が１回転すると、「０」か
ら「８１９２」に変化し、通常、回転軸６の動作範囲は
ある角度からある角度までと規定されているので、第２
エンコーダ２０の値は「０」〜「８１９２×２５６」の
間の一定範囲の値しかとらない。
【００２０】主制御手段１０による制御においては、第
２エンコーダ２０のエンコーダ値の増分は主制御手段１
０に記憶された仮想エンコーダ値に加算される。一方、
無限回転制御手段１２による制御においては、第２エン
コーダ２０のエンコーダ値の増分はスピンエンコーダ値
として無限回転制御手段１２に送給されてこれに記憶さ
れる。このとき、仮想エンコーダ値は変化せず、主制御
手段１０に記憶保持される。
２エンコーダ２０のエンコーダ値の増分は主制御手段１
０に記憶された仮想エンコーダ値に加算される。一方、
無限回転制御手段１２による制御においては、第２エン
コーダ２０のエンコーダ値の増分はスピンエンコーダ値
として無限回転制御手段１２に送給されてこれに記憶さ
れる。このとき、仮想エンコーダ値は変化せず、主制御
手段１０に記憶保持される。
【００２１】この無限回転のときのスピンエンコーダ値
は、次のとおりとなる。無限回転時において、無限回転
制御手段１２からの無限回転信号によって第２駆動手段
２４の出力軸５０がＮ回転すると、スピンエンコーダ値
は、「０」から「８１９２×Ｎ」となり、このスピンエ
ンコーダ値に基づいて無限回転制御手段１２の計数値が
Ｍ増加する。そして、この計数値がＭ増加すると、スピ
ンエンコーダ値は「０」に戻り、スピンエンコーダ値は
「０」から再びカウントされ、その後出力軸５０がＮ回
転する（スピンエンコーダ値が「８１９２×Ｎ」増加す
る）ずつ無限回転制御手段１２の計数値がＭ増加し、計
数値がＭ増加する毎にスピンエンコーダ値が「０」に戻
る。無限回転制御手段１２の計数値がＭ増加するまで、
換言すると、先端軸６がたとえばＳ（ＳはＭの整数倍）
回転から（Ｓ＋Ｍ）回転するまでは、スピンエンコーダ
値を値（８１９２×Ｎ／Ｍ）で除算した商が先端軸６の
回転数となり、この除算の余りが先端軸６の回転量（回
転角度位置）を示す。したがって、無限回転時におい
て、駆動手段２４が故障等によって突然停止しても、無
限回転制御手段１２に送給されたスピンエンコーダ値に
より先端軸６の回転角度位置を正確に検出することがで
きる。
は、次のとおりとなる。無限回転時において、無限回転
制御手段１２からの無限回転信号によって第２駆動手段
２４の出力軸５０がＮ回転すると、スピンエンコーダ値
は、「０」から「８１９２×Ｎ」となり、このスピンエ
ンコーダ値に基づいて無限回転制御手段１２の計数値が
Ｍ増加する。そして、この計数値がＭ増加すると、スピ
ンエンコーダ値は「０」に戻り、スピンエンコーダ値は
「０」から再びカウントされ、その後出力軸５０がＮ回
転する（スピンエンコーダ値が「８１９２×Ｎ」増加す
る）ずつ無限回転制御手段１２の計数値がＭ増加し、計
数値がＭ増加する毎にスピンエンコーダ値が「０」に戻
る。無限回転制御手段１２の計数値がＭ増加するまで、
換言すると、先端軸６がたとえばＳ（ＳはＭの整数倍）
回転から（Ｓ＋Ｍ）回転するまでは、スピンエンコーダ
値を値（８１９２×Ｎ／Ｍ）で除算した商が先端軸６の
回転数となり、この除算の余りが先端軸６の回転量（回
転角度位置）を示す。したがって、無限回転時におい
て、駆動手段２４が故障等によって突然停止しても、無
限回転制御手段１２に送給されたスピンエンコーダ値に
より先端軸６の回転角度位置を正確に検出することがで
きる。
【００２２】次に、主として制御手段８による制御のフ
ローチャートを示す図５を参照して説明すると、まず、
ステップＳ１において電源が投入されてロボットが起動
される。次いで、ステップＳ２にて、ロボットの先端軸
６の指定値が入力される。この指定値は、無限回転開始
前に先端軸６を所定位置に移動させるために行われ、第
１〜第５軸４を旋回または回転させるための指定値が入
力手段２８を介して入力される。そして、ステップＳ３
にて、主制御手段１０および第１サーボ制御手段１４に
よって第１駆動手段２２が作動され、第１〜第５軸４が
旋回または回転され、先端軸６が指定位置に移動され
る。
ローチャートを示す図５を参照して説明すると、まず、
ステップＳ１において電源が投入されてロボットが起動
される。次いで、ステップＳ２にて、ロボットの先端軸
６の指定値が入力される。この指定値は、無限回転開始
前に先端軸６を所定位置に移動させるために行われ、第
１〜第５軸４を旋回または回転させるための指定値が入
力手段２８を介して入力される。そして、ステップＳ３
にて、主制御手段１０および第１サーボ制御手段１４に
よって第１駆動手段２２が作動され、第１〜第５軸４が
旋回または回転され、先端軸６が指定位置に移動され
る。
【００２３】先端軸６が所定位置に移動されると、ステ
ップＳ４に移り、無限回転のスピン回転数が入力され
る。この回転数の入力は、入力手段２８によって所望回
転数（たとえば３０回転）が入力される。その後、ステ
ップＳ５に移り先端軸６のスピン（無限）回転が開始さ
れる。先端軸６のスピン回転は、無限回転制御手段１２
からの無限回転信号によって行われ、無限回転制御手段
１２からの無限回転信号に基づいて第２サーボ制御手段
１６によって第２駆動手段２４が駆動され、かかる第２
駆動手段２４の回転によって行われる。先端軸６の回転
開始後は、その回転数の計測が第２エンコーダ２０から
のエンコーダ値に基づいて行われる。そして、先端軸６
が入力回転数（たとえば３０回転）まで回転すると、ス
テップＳ６からステップＳ７を経てステップＳ８に進
み、第２駆動手段２４が減速され、先端軸６の回転が停
止される。かくして、先端軸６は無限回転制御手段１２
の作用によって所定数（たとえば３０回転）回転され
る。
ップＳ４に移り、無限回転のスピン回転数が入力され
る。この回転数の入力は、入力手段２８によって所望回
転数（たとえば３０回転）が入力される。その後、ステ
ップＳ５に移り先端軸６のスピン（無限）回転が開始さ
れる。先端軸６のスピン回転は、無限回転制御手段１２
からの無限回転信号によって行われ、無限回転制御手段
１２からの無限回転信号に基づいて第２サーボ制御手段
１６によって第２駆動手段２４が駆動され、かかる第２
駆動手段２４の回転によって行われる。先端軸６の回転
開始後は、その回転数の計測が第２エンコーダ２０から
のエンコーダ値に基づいて行われる。そして、先端軸６
が入力回転数（たとえば３０回転）まで回転すると、ス
テップＳ６からステップＳ７を経てステップＳ８に進
み、第２駆動手段２４が減速され、先端軸６の回転が停
止される。かくして、先端軸６は無限回転制御手段１２
の作用によって所定数（たとえば３０回転）回転され
る。
【００２４】次いで、図６を参照して、第２エンコーダ
２０からのエンコーダ値による先端軸６の回転数および
回転量（回転角度位置）の制御について説明する。ま
ず、ステップＳ１１において、ロボットの先端軸６の回
転数の初期値Ｖが設定される。この初期値Ｖは、無限回
転される際の先端軸６の回転数であり、主制御手段１０
により所定回転角度位置に位置付けられた後の基準位置
からの無限回転開始となるので零（ゼロ）に設定される
（Ｖ＝０）。次に、ステップＳ１２において、先端軸６
の回転量（ＥＮＣ）が初期化される。この回転量（ＥＮ
Ｃ）は、無限回転される際の先端軸６のスピン回転量
（スピンエンコーダ値）であり、主制御手段１０により
所定回転角度位置に位置付けられた後の基準位置からの
無限回転開始となるので零に設定される（ＥＮＣ＝
０）。
２０からのエンコーダ値による先端軸６の回転数および
回転量（回転角度位置）の制御について説明する。ま
ず、ステップＳ１１において、ロボットの先端軸６の回
転数の初期値Ｖが設定される。この初期値Ｖは、無限回
転される際の先端軸６の回転数であり、主制御手段１０
により所定回転角度位置に位置付けられた後の基準位置
からの無限回転開始となるので零（ゼロ）に設定される
（Ｖ＝０）。次に、ステップＳ１２において、先端軸６
の回転量（ＥＮＣ）が初期化される。この回転量（ＥＮ
Ｃ）は、無限回転される際の先端軸６のスピン回転量
（スピンエンコーダ値）であり、主制御手段１０により
所定回転角度位置に位置付けられた後の基準位置からの
無限回転開始となるので零に設定される（ＥＮＣ＝
０）。
【００２５】その後、ステップＳ１３に進み、先端軸６
の回転による第２エンコーダ２０のエンコーダ値がカウ
ントされると、そのカウント量は先端軸６の回転量Ａと
してスピンエンコーダ値に加算される（ＥＮＣ＝ＥＮＣ
＋回転量Ａ）。
の回転による第２エンコーダ２０のエンコーダ値がカウ
ントされると、そのカウント量は先端軸６の回転量Ａと
してスピンエンコーダ値に加算される（ＥＮＣ＝ＥＮＣ
＋回転量Ａ）。
【００２６】次いで、ステップＳ１４に進み、先端軸６
のスピン回転数ＲＯＴと回転角度位置との算出が行われ
る。先端軸６の回転数（ＲＯＴ）は、その回転数の初期
値Ｖに無限回転による値（スピンエンコーダ値ＥＮＣか
ら算出される値）を加算した値に基づいて、求められ
る。この場合、無限回転開始時からの回転数となるの
で、スピン回転数の初期値Ｖは零（ゼロ）である。先端
軸６のスピン回転数（ＲＯＴ）は、先端軸６の回転量
（ＥＮＣ）を値（８１９２×Ｎ／Ｍ）で除算する演算を
行い、その演算して求めたＥＮＣ÷（８１９２×Ｎ／
Ｍ）の商がスピン回転数ＲＯＴとなり、その演算して求
めたＥＮＣ÷（８１９２×Ｎ／Ｍ）の余りがスピン回転
量（回転角度位置）となる。したがって、減速手段４８
によって任意に回転比Ｒ（Ｒ＝Ｎ／Ｍ）を設定したとし
ても、無限回転時の先端軸６の回転数および回転量を正
確に求めることができる。
のスピン回転数ＲＯＴと回転角度位置との算出が行われ
る。先端軸６の回転数（ＲＯＴ）は、その回転数の初期
値Ｖに無限回転による値（スピンエンコーダ値ＥＮＣか
ら算出される値）を加算した値に基づいて、求められ
る。この場合、無限回転開始時からの回転数となるの
で、スピン回転数の初期値Ｖは零（ゼロ）である。先端
軸６のスピン回転数（ＲＯＴ）は、先端軸６の回転量
（ＥＮＣ）を値（８１９２×Ｎ／Ｍ）で除算する演算を
行い、その演算して求めたＥＮＣ÷（８１９２×Ｎ／
Ｍ）の商がスピン回転数ＲＯＴとなり、その演算して求
めたＥＮＣ÷（８１９２×Ｎ／Ｍ）の余りがスピン回転
量（回転角度位置）となる。したがって、減速手段４８
によって任意に回転比Ｒ（Ｒ＝Ｎ／Ｍ）を設定したとし
ても、無限回転時の先端軸６の回転数および回転量を正
確に求めることができる。
【００２７】ステップＳ１５においては、先端軸６の回
転量がＭより大きい、すなわちスピンエンコーダ値が値
（８１９２×Ｎ）より大きいか否かが判断される。スピ
ンエンコーダ値が値（８１９２×Ｎ）より小さいときに
は（すなわちＥＮＣ≦（８１９２×Ｎ）であるときに
は）、ステップＳ１３に戻り、先端軸６の回転量のカウ
ントが行われる。第２エンコーダ２０からの出力によっ
てスピンエンコーダ値が値（８１９２×Ｎ）を超えると
ステップＳ１６に進み、スピン回転数Ｖの加算が行われ
る。本実施の形態では、スピンエンコーダ値が（８１９
２×Ｎ）になると、先端軸６がＭ回転したことになる。
したがって、この時点でスピン回転数の値がＭ加算され
ることになる。無限回転制御手段１２には、スピン回転
数（Ｖ）として（Ｖ＋Ｍ）回転が記憶される。次いで、
ステップＳ１７に移り、先端軸６の回転量のカウント値
の減算が行われる。ステップＳ１６において、スピン回
転数がＭ増加したので、このＭ回転に対応するエンコー
ダ値（８１９２×Ｎ）がスピン回転量、すなわちスピン
エンコーダ値から減算され、先端軸６の回転量（ＥＮ
Ｃ）は、〔ＥＮＣ−（８１９２×Ｎ）〕となる。そし
て、先端軸６がＭ回転する毎にスピンエンコーダ値ＥＮ
Ｃから値（８１９２×Ｎ）を減算することによって、ス
ピンエンコーダ値が増加し続けることはなく、それ故
に、このスピンエンコーダ値ＥＮＣを継続してカウント
することができる。
転量がＭより大きい、すなわちスピンエンコーダ値が値
（８１９２×Ｎ）より大きいか否かが判断される。スピ
ンエンコーダ値が値（８１９２×Ｎ）より小さいときに
は（すなわちＥＮＣ≦（８１９２×Ｎ）であるときに
は）、ステップＳ１３に戻り、先端軸６の回転量のカウ
ントが行われる。第２エンコーダ２０からの出力によっ
てスピンエンコーダ値が値（８１９２×Ｎ）を超えると
ステップＳ１６に進み、スピン回転数Ｖの加算が行われ
る。本実施の形態では、スピンエンコーダ値が（８１９
２×Ｎ）になると、先端軸６がＭ回転したことになる。
したがって、この時点でスピン回転数の値がＭ加算され
ることになる。無限回転制御手段１２には、スピン回転
数（Ｖ）として（Ｖ＋Ｍ）回転が記憶される。次いで、
ステップＳ１７に移り、先端軸６の回転量のカウント値
の減算が行われる。ステップＳ１６において、スピン回
転数がＭ増加したので、このＭ回転に対応するエンコー
ダ値（８１９２×Ｎ）がスピン回転量、すなわちスピン
エンコーダ値から減算され、先端軸６の回転量（ＥＮ
Ｃ）は、〔ＥＮＣ−（８１９２×Ｎ）〕となる。そし
て、先端軸６がＭ回転する毎にスピンエンコーダ値ＥＮ
Ｃから値（８１９２×Ｎ）を減算することによって、ス
ピンエンコーダ値が増加し続けることはなく、それ故
に、このスピンエンコーダ値ＥＮＣを継続してカウント
することができる。
【００２８】ステップＳ１７の後はステップＳ１３に戻
り、継続して先端軸６の回転量のカウントが行われる。
そして、ステップＳ１３〜Ｓ１７が無限回転が終了する
まで繰り返し継続される。
り、継続して先端軸６の回転量のカウントが行われる。
そして、ステップＳ１３〜Ｓ１７が無限回転が終了する
まで繰り返し継続される。
【００２９】なお、先端軸６が上述とは反対方向に回転
するときには、第２エンコーダ２０のエンコーダ値は減
算されるようになるが、その制御は、上述したと同様に
行われる。
するときには、第２エンコーダ２０のエンコーダ値は減
算されるようになるが、その制御は、上述したと同様に
行われる。
【００３０】上記実施の形態では、ロボットの第６軸が
無限回転制御される構成であるが、これに限定されず、
他の形式のロボットの先端軸またはロボットの外部軸で
あっても同様の制御を適用することができる。
無限回転制御される構成であるが、これに限定されず、
他の形式のロボットの先端軸またはロボットの外部軸で
あっても同様の制御を適用することができる。
【００３１】
【発明の効果】本発明によれば、駆動手段の出力軸５０
の回転数Ｎと回転軸６の回転数Ｍの回転比ＲがＮ／Ｍに
設定され、出力軸５０がＮ回転すれば、無限回転制御手
段の計数値をＭ増加させることになる。回転比Ｒ（Ｒ＝
Ｎ／Ｍ）の値を任意に設定することによって回転軸６の
上記回転数の加減算を、回転軸６の回転量ＥＮＣが増加
し続けることなしに、容易に行うことができる。また、
無限回転制御手段の計数値がＭ増加するまでは、駆動手
段のエンコーダ２０によって検出した出力軸５０の回転
量Ａに基づいて回転軸６の回転数、すなわちスピン回転
数ＲＯＴおよび１回転中の回転角度位置を算出するの
で、駆動手段が故障等により停止しても、スピンエンコ
ーダのスピンエンコーダ値ＥＮＣに基づいて、回転軸６
の回転数および１回転中の回転角度位置を検出すること
ができる。
の回転数Ｎと回転軸６の回転数Ｍの回転比ＲがＮ／Ｍに
設定され、出力軸５０がＮ回転すれば、無限回転制御手
段の計数値をＭ増加させることになる。回転比Ｒ（Ｒ＝
Ｎ／Ｍ）の値を任意に設定することによって回転軸６の
上記回転数の加減算を、回転軸６の回転量ＥＮＣが増加
し続けることなしに、容易に行うことができる。また、
無限回転制御手段の計数値がＭ増加するまでは、駆動手
段のエンコーダ２０によって検出した出力軸５０の回転
量Ａに基づいて回転軸６の回転数、すなわちスピン回転
数ＲＯＴおよび１回転中の回転角度位置を算出するの
で、駆動手段が故障等により停止しても、スピンエンコ
ーダのスピンエンコーダ値ＥＮＣに基づいて、回転軸６
の回転数および１回転中の回転角度位置を検出すること
ができる。
【００３２】
【００３３】また本発明によれば、ロボットの先端軸ま
たは外部軸を無限回転の回転軸として適用することがで
きる。
たは外部軸を無限回転の回転軸として適用することがで
きる。
【図１】本発明の一実施形態の無限回転制御方法を適用
したロボットの制御系を簡略的に示すブロック図であ
る。
したロボットの制御系を簡略的に示すブロック図であ
る。
【図２】図１の制御系の電気的構成を簡略的に示すブロ
ック図でありる。
ック図でありる。
【図３】図１のロボットの簡略図である。
【図４】図３のロボットの減速手段およびその近傍を簡
略的に示す正面図である。
略的に示す正面図である。
【図５】図１のロボットの制御系による無限回転制御を
示すフローチャートである。
示すフローチャートである。
【図６】図５の制御系における第２エンコーダのスピン
エンコーダ値による回転数および回転量の検出様式を示
すフローチャートである。
エンコーダ値による回転数および回転量の検出様式を示
すフローチャートである。
２ ロボット本体
４ 第１〜第５軸
７ 第６軸
８ 制御手段
１０ 主制御手段
１２ 無限回転制御手段
１４ 第１サーボ制御手段
１６ 第２サーボ制御手段
１８ 第１エンコーダ
２０ 第２エンコーダ
２２ 第１駆動手段
２４ 第２駆動手段
２８ 入力手段
４８ 減速手段
フロントページの続き
(56)参考文献 特開 平６−79674（ＪＰ，Ａ)
(58)調査した分野(Int.Cl.7，ＤＢ名)
B25J 3/00 - 3/04
B25J 9/10 - 9/22
B25J 13/00 - 13/08
B25J 19/02 - 19/06
G05B 19/18 - 19/46
Claims (4)
- 【請求項１】 回転自在に支持された回転軸（６）と、 該回転軸を回転駆動するための駆動手段（２４）と、 該駆動手段の出力軸（５０）と前記回転軸（６）との間
に介在され、前記駆動手段の出力軸がＮ回転したとき前
記回転軸をＭ回転させるように回転比Ｒ（＝Ｎ／Ｍ）が
設定された減速手段（４８）と、 前記回転軸（６）の回転を制御する主制御手段と、 前記回転軸（６）の無限回転を制御し、スピンエンコー
ダを有する無限回転制御手段と、を備えたロボットにお
ける無限回転制御方法であって、 駆動手段（２４）の出力軸（５０）の回転数をエンコー
ダ（２０）によって検出し、 無限回転制御手段は、 エンコーダ（２０）によって検出した回転量Ａを、前記
スピンエンコーダのスピンエンコーダ値ＥＮＣに加算し
てゆき、 前記出力軸（５０）が１回転することによるエンコーダ
（２０）の回転量をＢとするとき、 ＥＮＣ÷（Ｂ×Ｎ／Ｍ）を演算し、 スピンエンコーダ値ＥＮＣが、（Ｂ×Ｎ）以下であると
き、 前記演算して求めたＥＮＣ÷（Ｂ×Ｎ／Ｍ）の商を、回
転軸（６）のスピン回転数ＲＯＴとし、 前記演算して求めたＥＮＣ÷（Ｂ×Ｎ／Ｍ）の余りを、
回転軸（６）の回転角度位置とし、 スピンエンコーダ値ＥＮＣが、（Ｂ×Ｎ）を超えたと
き、 スピンエンコーダ値ＥＮＣとして、 ＥＮＣ−（Ｂ×Ｎ） を演算することを特徴とするロボットの無限回転制御方
法。 - 【請求項２】 前記回転軸は、ロボットの先端軸または
外部軸としてサーボ制御されることを特徴とする請求項
１記載のロボットの無限回転制御方法。 - 【請求項３】 回転自在に支持された回転軸（６）と、 該回転軸を回転駆動するための駆動手段（２４）と、 該駆動手段の出力軸（５０）と前記回転軸（６）との間
に介在され、前記駆動手段の出力軸がＮ回転したとき前
記回転軸をＭ回転させるように回転比Ｒ（＝Ｎ／Ｍ）が
設定された減速手段（４８）と、 前記回転軸（６）の回転を制御する主制御手段と、 前記回転軸（６）の無限回転を制御し、スピンエンコー
ダを有する無限回転制御手段と、 駆動手段（２４）の出力軸（５０）の回転数を検出する
エンコーダ（２０）と、を備え、 無限回転制御手段は、 エンコーダ（２０）によって検出した回転量Ａを、前記
スピンエンコーダのスピンエンコーダ値ＥＮＣに加算し
てゆき、 前記出力軸（５０）が１回転することによるエンコーダ
（２０）の回転量をＢとするとき、 ＥＮＣ÷（Ｂ×Ｎ／Ｍ）を演算し、 スピンエンコーダ値ＥＮＣが、（Ｂ×Ｎ）以下であると
き、 前記演算して求めたＥＮＣ÷（Ｂ×Ｎ／Ｍ）の商を、回
転軸（６）のスピン回転数ＲＯＴとし、 前記演算して求めたＥＮＣ÷（Ｂ×Ｎ／Ｍ）の余りを、
回転軸（６）の回転角度位置とし、 スピンエンコーダ値ＥＮＣが、（Ｂ×Ｎ）を超えたと
き、 スピンエンコーダ値ＥＮＣとして、 ＥＮＣ−（Ｂ×Ｎ） を演算することを特徴とするロボットの無限回転制御装
置。 - 【請求項４】 前記回転軸は、ロボットの先端軸または
外部軸としてサーボ制御されることを特徴とする請求項
３記載のロボットの無限回転制御装置。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP19940296A JP3429414B2 (ja) | 1996-07-29 | 1996-07-29 | ロボットの無限回転制御方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP19940296A JP3429414B2 (ja) | 1996-07-29 | 1996-07-29 | ロボットの無限回転制御方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPH1044076A JPH1044076A (ja) | 1998-02-17 |
| JP3429414B2 true JP3429414B2 (ja) | 2003-07-22 |
Family
ID=16407202
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP19940296A Expired - Fee Related JP3429414B2 (ja) | 1996-07-29 | 1996-07-29 | ロボットの無限回転制御方法 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP3429414B2 (ja) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| DE102015016916A1 (de) | 2015-01-08 | 2016-07-14 | Fanuc Corporation | Robotersteuervorrichtung zum Aktualisieren des Drehwinkels durch eine Vielzahl von Drehwinkelgebern |
Families Citing this family (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US6212968B1 (en) * | 1998-07-29 | 2001-04-10 | Janome Sewing Machine Co., Ltd, | SCARA robot |
| US6847862B2 (en) * | 2001-01-23 | 2005-01-25 | Mitsubishi Denki Kabushiki Kaisha | Conveyor system |
| DE102004007558B4 (de) * | 2004-02-17 | 2012-06-21 | Josef Moser | Bewegungseinrichtung mit sinusförmigen Bewegungsablauf |
-
1996
- 1996-07-29 JP JP19940296A patent/JP3429414B2/ja not_active Expired - Fee Related
Cited By (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| DE102015016916A1 (de) | 2015-01-08 | 2016-07-14 | Fanuc Corporation | Robotersteuervorrichtung zum Aktualisieren des Drehwinkels durch eine Vielzahl von Drehwinkelgebern |
| CN105773604A (zh) * | 2015-01-08 | 2016-07-20 | 发那科株式会社 | 机器人控制装置 |
| US9636823B2 (en) | 2015-01-08 | 2017-05-02 | Fanuc Corporation | Robot control device for updating rotation angle by plurality of rotation angle detectors |
| CN105773604B (zh) * | 2015-01-08 | 2017-08-29 | 发那科株式会社 | 机器人控制装置 |
| DE102015016916B4 (de) | 2015-01-08 | 2018-10-25 | Fanuc Corporation | Robotersteuervorrichtung zum Aktualisieren des Drehwinkels durch eine Vielzahl von Drehwinkelgebern |
Also Published As
| Publication number | Publication date |
|---|---|
| JPH1044076A (ja) | 1998-02-17 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP3429414B2 (ja) | ロボットの無限回転制御方法 | |
| WO2001043914A1 (fr) | Controleur de marche d'une machine-outil | |
| WO1990014192A1 (en) | Control device for tapping | |
| JPH0884492A (ja) | サーボモータの同期運転方法及びその装置 | |
| JPH0996545A (ja) | 出力回転軸のアブソリュート位置検出装置 | |
| JP2001198765A (ja) | 送り駆動装置の位置制御方法および位置制御装置 | |
| JP4409115B2 (ja) | 位置制御装置および位置制御方法 | |
| JP4121875B2 (ja) | アブソリュート位置検出装置 | |
| JP2613530B2 (ja) | 先端軸が無限回転可能なロボットおよびロボットの先端軸の無限回転方法 | |
| JPS6089201A (ja) | 数値制御装置 | |
| JP2819411B2 (ja) | 定位置停止制御装置 | |
| JP3167315B2 (ja) | Ｎｃ工作装置の絶対位置検出装置 | |
| JPH09272086A (ja) | 多関節ロボット | |
| JP3438195B2 (ja) | モータの制御装置 | |
| JPS6381015A (ja) | 電動式射出機の制御方法 | |
| JP2915373B2 (ja) | 無限回転軸を有するロボットの制御方法 | |
| KR100222022B1 (ko) | 백래쉬로 인한 오차보상방법 | |
| JPH03212705A (ja) | 数値制御装置 | |
| JPH05104466A (ja) | 多関節ロボツトの原点復帰制御装置 | |
| JP2970166B2 (ja) | ステッパモータ駆動装置 | |
| JP2001038578A (ja) | 力覚提示式工作機械 | |
| JPS6257003A (ja) | ロボツトにおけるバツクラツシユ補正方式 | |
| JPH04326104A (ja) | ロボットの制御装置 | |
| JP2001012564A (ja) | 主軸変速装置 | |
| JP3490347B2 (ja) | 変速機シフト操作装置 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090516 Year of fee payment: 6 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100516 Year of fee payment: 7 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110516 Year of fee payment: 8 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110516 Year of fee payment: 8 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120516 Year of fee payment: 9 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120516 Year of fee payment: 9 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130516 Year of fee payment: 10 |
|
| LAPS | Cancellation because of no payment of annual fees |