JP2021025822A - ゲイン調整装置 - Google Patents

Abstract

【課題】出力軸の回転位置を検出する磁気センサの出力信号のゲインを迅速に調整する。【解決手段】ゲイン調整装置（７０）は、モータの回転軸の回転を減速機で減速させて回転させられる出力軸の回転位置に応じた出力信号を出力する磁気センサ（５２）と、出力信号にゲインを掛けて補正するゲイン補正部（５３）と、ゲイン補正部により補正された出力信号をデジタル値に変換して出力する変換部（８１）と、デジタル値とそのデジタル値においてデジタル値が変化する傾きとデジタル値の振幅との予め設定された所定関係と、変換部により出力されたデジタル値とそのデジタル値においてデジタル値が変化する傾きとに基づいて、変換部により出力されたデジタル値の振幅を算出する振幅算出部（８２）と、振幅算出部により算出された振幅に基づいて、ゲインを調整するゲイン調整部（８３）と、を備える。【選択図】 図３

Description

本発明は、磁気センサの出力信号のゲインを調整する装置に関する。

従来、モータのロータの回転位置に応じた出力信号を出力する磁気センサを備え、磁気センサの出力信号のゲインを調整する装置がある（特許文献１参照）。特許文献１に記載の装置では、モータのロータが回転し続ける状態で磁気センサの出力信号の最大電圧を複数回測定し、複数の最大電圧の平均値が許容範囲に収まるようにゲインを調整している。

特許第４６１８２０１号公報

ところで、特許文献１に記載の装置では、磁気センサの出力信号のゲインを調整するために、モータのロータを複数回転を超えて回転させる必要がある。さらに、モータの回転軸の回転を減速機で減速させて回転させられる出力軸（以下、単に「出力軸」という）に対して磁気センサが設けられている場合、磁気センサの出力信号のゲインを調整するためには、モータを多数回転させる必要がある。したがって、特許文献１に記載の装置を、出力軸の回転位置を検出する磁気センサに適用した場合、出力信号のゲインを調整するために長時間を要することとなる。

本発明は、こうした課題を解決するためになされたものであり、その主たる目的は、出力軸の回転位置を検出する磁気センサの出力信号のゲインを迅速に調整することにある。

上記課題を解決するための第１の手段は、ゲイン調整装置であって、
モータの回転軸の回転を減速機で減速させて回転させられる出力軸の回転位置に応じた出力信号を出力する磁気センサと、
前記出力信号にゲインを掛けて補正するゲイン補正部と、
前記ゲイン補正部により補正された前記出力信号をデジタル値に変換して出力する変換部と、
前記デジタル値とそのデジタル値において前記デジタル値が変化する傾きと前記デジタル値の振幅との予め設定された所定関係と、前記変換部により出力された前記デジタル値とそのデジタル値において前記デジタル値が変化する傾きとに基づいて、前記変換部により出力された前記デジタル値の振幅を算出する振幅算出部と、
前記振幅算出部により算出された前記振幅に基づいて、前記ゲインを調整するゲイン調整部と、
を備える。

上記構成によれば、磁気センサは、モータの回転軸の回転を減速機で減速させて回転させられる出力軸（以下、単に「出力軸」という）の回転位置に応じた出力信号を出力する。ゲイン補正部は、出力信号にゲインを掛けて補正する。変換部は、ゲイン補正部により補正された出力信号をデジタル値に変換して出力する。このため、ゲインに応じて出力信号の振幅及び傾き、ひいてはデジタル値の振幅及び傾きは変化する。

ここで、磁気センサが出力軸の回転位置に応じた出力信号を出力する上記構成では、磁気センサがモータの回転軸の回転位置に応じた出力信号を出力する構成と比較して、出力信号の振幅を検出するためにモータを多く回転させる必要がある。この点、振幅算出部は、デジタル値とそのデジタル値においてデジタル値が変化する傾きとデジタル値の振幅との予め設定された所定関係と、変換部により出力されたデジタル値とそのデジタル値においてデジタル値が変化する傾きとに基づいて、変換部により出力されたデジタル値の振幅を算出する。そして、ゲイン調整部は、振幅算出部により算出された振幅に基づいて、ゲインを調整する。

上記のように、ゲインに応じて出力信号の振幅及び傾き、ひいてはデジタル値の振幅及び傾きは変化する。あるデジタル値とそのデジタル値においてデジタル値が変化する傾きとが分かれば、それらに対応するデジタル値の振幅は一義的に決まる。このため、デジタル値とそのデジタル値においてデジタル値が変化する傾きとデジタル値の振幅との所定関係を、予め設定しておくことができる。そして、出力軸の回転位置をわずかに変化させれば、デジタル値が変化する傾きを算出することができ、出力軸ひいてはモータを多数回転させる必要がない。したがって、振幅算出部はデジタル値の振幅を迅速に算出することができ、算出された振幅に基づいてゲインを迅速に調整することができる。

第２の手段は、ゲイン調整装置であって、
モータの回転軸の回転を減速機で減速させて回転させられる出力軸の回転位置に応じた出力信号を出力する磁気センサと、
前記出力信号にゲインを掛けて補正するゲイン補正部と、
前記ゲイン補正部により補正された前記出力信号をデジタル値に変換して出力する変換部と、
前記回転位置とその回転位置において前記デジタル値が変化する傾きと前記デジタル値の振幅との予め設定された所定関係と、前記変換部により出力された前記デジタル値と前記ゲインを変化させた時に前記変換部により出力された前記デジタル値とに基づき算出した前記回転位置と、その回転位置において前記デジタル値が変化する傾きとに基づいて、前記変換部により出力された前記デジタル値の振幅を算出する振幅算出部と、
前記振幅算出部により算出された前記振幅に基づいて、前記ゲインを調整するゲイン調整部と、
を備える。

上記構成によれば、振幅算出部は、回転位置とその回転位置においてデジタル値が変化する傾きとデジタル値の振幅との予め設定された所定関係と、変換部により出力されたデジタル値とゲインを変化させた時に変換部により出力されたデジタル値とに基づき算出した回転位置と、その回転位置においてデジタル値が変化する傾きとに基づいて、変換部により出力されたデジタル値の振幅を算出する。ゲインを変化させた時に変換部により出力されたデジタル値の変化量は、出力軸の回転位置に応じて変化する。このため、変換部により出力されたデジタル値とゲインを変化させた時に変換部により出力されたデジタル値とに基づいて、出力軸の回転位置を算出することができる。

また、ある回転位置とその回転位置においてデジタル値が変化する傾きとが分かれば、それらに対応するデジタル値の振幅は一義的に決まる。このため、回転位置とその回転位置においてデジタル値が変化する傾きとデジタル値の振幅との所定関係を、予め設定しておくことができる。そして、出力軸の回転位置をわずかに変化させれば、デジタル値が変化する傾きを算出することができ、出力軸ひいてはモータを多数回転させる必要がない。したがって、振幅算出部はデジタル値の振幅を迅速に算出することができ、算出された振幅に基づいてゲインを迅速に調整することができる。

具体的には、第３の手段のように、前記振幅算出部は、前記変換部により出力された前記デジタル値から前記ゲインを変化させた時に前記変換部により出力された前記デジタル値への変化量と、前記出力軸を所定量回転させてから前記変換部により出力されたデジタル値から前記ゲインを変化させた時に前記変換部により出力された前記デジタル値への変化量との比に基づいて、前記回転位置を算出する、といった構成を採用することができる。

変換部により出力されたデジタル値が上限値又は下限値である場合は、デジタル値が変化する傾きを適切に算出することができないおそれがある。

この点、第４の手段では、前記振幅算出部は、前記変換部により出力された前記デジタル値が上限値又は下限値であった場合に、前記出力軸を所定量回転させてから前記デジタル値の振幅を算出する。こうした構成によれば、デジタル値が上限値又は下限値となっている出力軸の回転位置を避けて、デジタル値が変化する傾きを適切に算出することができる。

また、第５の手段のように、前記振幅算出部は、前記変換部により出力されたデジタル値と前記出力軸を所定量回転させた時に前記変換部により出力されたデジタル値とに基づいて、前記傾きを算出する、といった構成を採用することができる。

第６の手段では、前記出力信号にオフセット値を加算して補正するオフセット補正部と、前記変換部により出力された前記デジタル値と前記出力軸を所定量回転させた時に前記変換部により出力された前記デジタル値とに基づき算出した近似曲線と、前記ゲインを変化させてから前記変換部により出力された前記デジタル値と前記出力軸を所定量回転させた時に前記変換部により出力された前記デジタル値とに基き算出した近似曲線との交点に基づいて、前記オフセット値を調整するオフセット調整部と、を備える。

磁気センサの出力信号が中央値（基準値）に対して正側又は負側にオフセットする場合がある。この場合、デジタル値の振幅を算出する精度が低下するおそれがある。

この点、上記構成によれば、オフセット補正部は、磁気センサの出力信号にオフセット値を加算して補正する。オフセット調整部は、変換部により出力されたデジタル値と出力軸を所定量回転させた時に変換部により出力されたデジタル値とに基づき近似曲線を算出し、ゲインを変化させてから変換部により出力されたデジタル値と出力軸を所定量回転させた時に変換部により出力されたデジタル値とに基き近似曲線を算出する。これらの近似曲線は、ゲインの違いにより互いに振幅が異なる近似曲線であり、出力信号がオフセットしていない場合に、中央値において交わる性質がある。このため、オフセット調整部は、これらの近似曲線の交点に基づいて、オフセット値を適切に調整することができる。

ロボット及びロボットコントローラを示す斜視図。 ロボットのアームの関節を示す模式図。 ゲイン調整装置のブロック図。 理想のｓｉｎ波及び理想のｃｏｓ波を示すグラフ。 飽和状態のｓｉｎ波及び飽和状態のｃｏｓ波を示すグラフ。 理想のｓｉｎ波及び飽和状態のｓｉｎ波を示すグラフ。 理想のｓｉｎ波及び飽和状態のｓｉｎ波を示すグラフ。 理想のｓｉｎ波及び飽和状態のｓｉｎ波がオフセットした態様を示すグラフ。 ゲイン調整装置の変更例のブロック図。

（第１実施形態）
以下、第１実施形態について、図面を参照しつつ説明する。本実施形態は、多関節ロボットの回転軸を接続する関節において、回転軸の回転位置を検出する磁気センサの出力信号のゲインを調整するゲイン調整装置に具現化している。

図１に示すように、ロボット１０の動作状態は、ロボットコントローラ８０により制御される。ロボット１０は、例えば６軸の垂直多関節ロボットであり、アームとしての第１軸１１及び第２軸１２等を備えている。

図２は、図１の円Ａで囲む部分を拡大した模式図である。ロボット１０のアームは、第１軸１１、第２軸１２、モータ２０、減速機３０、入力軸エンコーダ４０、磁気センサユニット５０等を備えている。

第１軸１１には、モータ２０及び減速機３０が固定されている。モータ２０の駆動軸（回転軸）は、減速機３０へ回転を入力する入力軸２１になっている。モータ２０の駆動状態は、ロボットコントローラ８０により制御される。モータ２０には、入力軸２１の回転位置を検出する入力軸エンコーダ４０が取り付けられている。なお、減速機３０はモータ２０に固定されていてもよい。

入力軸エンコーダ４０は、円板状のディスク４１、検出素子４２等を備えている。ディスク４１は、入力軸２１に同心状に取り付けられている。検出素子４２は、入力軸エンコーダ４０の筐体に取り付けられている。検出素子４２は、ディスク４１の検出面における外周縁部の所定位置に対向して配置されている。検出素子４２は、ディスク４１の回転位置に対応するオン・オフ信号を検出する。検出素子４２により検出されたオン・オフ信号（すなわち回転位置）は、ロボットコントローラ８０へ入力される。入力軸エンコーダ４０として、透過型光学式エンコーダや、反射型光学式エンコーダ、磁気式エンコーダ等を採用することができる。

減速機３０は、入力軸２１の回転を所定の減速比で減速して、出力軸２２に伝達する。出力軸２２は、第２軸１２の基端部に固定されている。出力軸２２が回転することにより、第２軸１２が出力軸２２を中心として回転する。減速機３０として、波動歯車式の減速機や、遊星歯車式の減速機等を採用することができる。第２軸１２には、出力軸２２（第２軸１２）の回転位置を検出する磁気センサユニット５０が取り付けられている。

ロボットコントローラ８０は、ＣＰＵ、ＲＯＭ、ＲＡＭ、入出力ポート、駆動回路等を含むマイクロコンピュータである。本実施形態では、図３に示すように、ロボットコントローラ８０は、ＡＤ変換部８１、振幅算出部８２、及びゲイン調整部８３を備えている。ロボットコントローラ８０は、入力軸エンコーダ４０や、磁気センサユニット５０等の各種センサによる検出値を入力し、モータ２０等の各種アクチュエータの駆動状態を制御する。ロボットコントローラ８０は、入力軸エンコーダ４０の検出素子４２により検出されたオン・オフ信号に基づいて、ディスク４１すなわち入力軸２１の回転位置を算出する。そして、ロボットコントローラ８０は、入力軸２１の回転位置及び減速機３０の減速比に基づいて、第２軸１２（出力軸２２、検出軸３１）の回転位置を算出する。また、ロボットコントローラ８０は、磁気センサユニット５０の磁気センサ５２により検出された波形信号に基づいて、磁石５１すなわち第２軸１２の回転位置を算出する。

磁気センサユニット５０は、円板状の磁石５１、磁気センサ５２、ゲイン補正部５３（図３参照）、増幅器５４等を備えている。

磁石５１は、第２軸１２に取り付けられた検出軸３１に同心状に取り付けられており、検出軸３１と一体で回転する。検出軸３１の中心線と出力軸２２の中心線とは、中心線Ｃ１で一致している。磁石５１は、円環状に形成された内周側の磁石と、円環状に形成された外周側の磁石とを含む周知の構成である。

磁気センサ５２は、磁気抵抗素子、バイアス磁石等を含む周知の構成である。磁気センサ５２は、磁気センサユニット５０の筐体あるいは第１軸１１に取り付けられている。磁気センサ５２は、磁石５１の検出面における所定位置に対向して配置されている。磁気センサ５２は、磁石５１の回転方向に９０°の位相差で配置された２つの磁気センサを含んでいる（図２では一方の磁気センサのみ表示）。磁気センサ５２の一方の磁気センサは磁石５１の１回転に伴って１周期のｓｉｎ波の電圧信号（出力信号）を出力し、他方の磁気センサは磁石５１の１回転に伴って１周期のｃｏｓ波の電圧信号（出力信号）を出力する。すなわち、磁気センサ５２は、出力軸２２の回転位置に応じた出力信号を出力する。磁気センサ５２の出力信号は、ゲイン補正部５３へ入力される。

ゲイン補正部５３は、磁気センサ５２から入力した出力信号にゲインを掛けて補正する。ゲイン補正部５３は、補正した出力信号を増幅器５４へ出力する。増幅器５４は、ゲイン補正部５３から入力した補正後の出力信号を増幅して、ＡＤ変換部８１へ出力する。

ＡＤ変換部８１（変換部）は、増幅器５４から入力した増幅後の出力信号をＡＤ値（デジタル値）に変換する。例えば、ＡＤ値は１２ｂｉｔで構成されており、ＡＤ値の下限値は０であり、上限値は４０９５である。ＡＤ変換部８１は、ＡＤ値を振幅算出部８２へ出力する。振幅算出部８２は、ＡＤ値（デジタル値に変換されたｓｉｎ波又はｃｏｓ波）の振幅を算出する。振幅算出部８２がＡＤ値の振幅を算出する処理の詳細については後述する。振幅算出部８２は、算出した振幅をゲイン調整部８３へ出力する。ゲイン調整部８３は、振幅算出部８２から入力した振幅に基づいて、ゲイン補正部５３で用いるゲインを調整する。なお、磁気センサ５２、ゲイン補正部５３、増幅器５４、ＡＤ変換部８１、振幅算出部８２、及びゲイン調整部８３により、ゲイン調整装置７０が構成されている。

図４は、ＡＤ値の推移を表す理想のｓｉｎ波及び理想のｃｏｓ波を示すグラフである。同図は、第２軸１２の角度（回転位置）に対する理想のｓｉｎ波及び理想のｃｏｓ波のＡＤ値を示している。なお、第２軸１２は、実際には３６０°未満の角度範囲で回転する。理想のｓｉｎ波及び理想のｃｏｓ波の振幅は３１５０であり、ＡＤ値の中央値は２０４８である。このため、ゲイン調整部８３は、ｓｉｎ波及びｃｏｓ波の振幅が３１５０（目標振幅）となるようにゲインを調整する。なお、ここでは、ｓｉｎ波及びｃｏｓ波の最小値から最大値までの幅を振幅としているが、中央値から最大値までを振幅としてもよい。

図５は、ＡＤ値の推移を表す飽和状態のｓｉｎ波及び飽和状態のｃｏｓ波を示すグラフである。ここでは、磁石５１や磁気センサ５２の組付誤差等により、ｓｉｎ波及びｃｏｓ波の振幅が５０００に相当する状態になっている。ただし、ＡＤ値は０〜４０９５までの値となるため、４０９５を超える場合にＡＤ値は４０９５となり、０未満の場合にＡＤ値は０となる。この場合、ＡＤ値が０〜４０９５に収まるように、望ましくはｓｉｎ波及びｃｏｓ波の振幅が３１５０となるように、ゲイン調整部８３はゲインを調整する必要がある。

しかし、ｓｉｎ波（ｃｏｓ波）の振幅を確認するためには、出力軸２２を１８０°以上回転させる必要がある。しかも、出力軸２２は、入力軸２１の回転を減速機３０により所定の減速比で減速して回転させられている。このため、モータ２０により入力軸２１を多数回転させる必要があり、振幅の確認に長時間を要することとなる。

そこで、本実施形態では、以下の処理により振幅算出部８２がｓｉｎ波の振幅を算出する。ここでは、ｓｉｎ波の振幅を算出する例を示すが、ｃｏｓ波の振幅を算出する場合も同様である。

図６は、理想のｓｉｎ波及び飽和状態のｓｉｎ波を示すグラフである。同図に示すように、例えばＡＤ値＝２０７０において、理想のｓｉｎ波（点Ｐ１）と飽和状態のｓｉｎ波（点Ｐ２）とでは、曲線の傾きが異なっている。ｓｉｎ波の中央値は必ず２０４８になるとすると、ＡＤ値＝２０７０（あるＡＤ値）において、理想のｓｉｎ波（点Ｐ１）と同じ傾きを持つｓｉｎ波は、理想のｓｉｎ波以外には存在しない。すなわち、あるＡＤ値とそのＡＤ値におけるｓｉｎ波の傾き（ＡＤ値が変化する傾き）とが分かれば、それらに対応するｓｉｎ波の振幅は一義的に決まる。このため、振幅算出部８２は、ＡＤ値とそのＡＤ値におけるｓｉｎ波の傾きとｓｉｎ波の振幅との所定関係を、予めマップ又は計算式として設定しておく。

そして、振幅算出部８２は、ＡＤ変換部８１から第１のＡＤ値を入力した後、モータ２０を制御して出力軸２２を所定量（例えば２〜３°）回転させる。そして、振幅算出部８２は、ＡＤ変換部８１から第２のＡＤ値を入力する。振幅算出部８２は、第２のＡＤ値と第１のＡＤ値との差を上記所定量で割ることにより、第１のＡＤ値（第２のＡＤ値）におけるｓｉｎ波の傾きを算出する。振幅算出部８２は、第１のＡＤ値と第１のＡＤ値におけるｓｉｎ波の傾きを上記所定関係に適用して、ｓｉｎ波の振幅を算出する。すなわち、振幅算出部８２は、ＡＤ値とそのＡＤ値においてＡＤ値が変化する傾きとＡＤ値の振幅との予め設定された所定関係と、ＡＤ変換部８１により出力されたＡＤ値とそのＡＤ値においてＡＤ値が変化する傾きとに基づいて、ＡＤ変換部８１により出力されたＡＤ値の振幅を算出する。

また、ＡＤ変換部８１により出力されたＡＤ値が上限値（４０９５）又は下限値（０）である場合は、ｓｉｎ波の傾きを適切に算出することができないおそれがある。そこで、振幅算出部８２は、ＡＤ変換部８１により出力されたＡＤ値が上限値又は下限値であるか否か判定する。そして、振幅算出部８２は、ＡＤ変換部８１により出力されたＡＤ値が上限値又は下限値であると判定した場合に、出力軸２２を所定量（例えば３０°）回転させる。その後、振幅算出部８２は、ｓｉｎ波の振幅を算出する上記処理を実行する。

そして、ゲイン調整部８３は、ｓｉｎ波の振幅が３１５０（目標振幅）となるように、ゲインを調整する。具体的には、ゲイン調整部８３は、ゲインの変化率と振幅の変化率との関係を予め把握している。そして、ゲイン調整部８３は、この関係と現在のゲインと現在の振幅とに基づいて、調整後の振幅が目標振幅となるようにゲインを調整する。

以上詳述した本実施形態は、以下の利点を有する。

・振幅算出部８２は、ＡＤ値とそのＡＤ値においてＡＤ値が変化する傾き（ｓｉｎ波又はｃｏｓ波の傾き）とＡＤ値の振幅との予め設定された所定関係と、ＡＤ変換部８１により出力されたＡＤ値とそのＡＤ値においてＡＤ値が変化する傾きとに基づいて、ＡＤ変換部８１により出力されたＡＤ値の振幅を算出する。ゲインに応じて磁気センサ５２の出力信号の振幅及び傾き、ひいてはＡＤ値の振幅及び傾きは変化する。あるＡＤ値とそのＡＤ値においてＡＤ値が変化する傾きとが分かれば、それらに対応するＡＤ値の振幅は一義的に決まる。このため、ＡＤ値とそのＡＤ値においてＡＤ値が変化する傾きとＡＤ値の振幅との所定関係を、予め設定しておくことができる。そして、出力軸２２の回転位置をわずかに変化させれば、ＡＤ値が変化する傾きを算出することができ、出力軸２２ひいてはモータ２０を多数回転させる必要がない。したがって、振幅算出部８２はＡＤ値の振幅を迅速に算出することができ、算出された振幅に基づいてゲインを迅速に調整することができる。

・振幅算出部８２は、ＡＤ変換部８１により出力されたＡＤ値が上限値又は下限値であった場合に、出力軸２２を所定量回転させてからＡＤ値の振幅を算出する。こうした構成によれば、ＡＤ値が上限値又は下限値となっている出力軸２２の回転位置を避けて、ＡＤ値が変化する傾きを適切に算出することができる。

・振幅算出部８２は、ＡＤ変換部８１により出力されたＡＤ値と出力軸２２を所定量回転させた時にＡＤ変換部８１により出力されたＡＤ値とに基づいて、ＡＤ値が変化する傾きを算出することができる。

（第２実施形態）
以下、第２実施形態について、第１実施形態との相違点を中心に説明する。本実施形態では、出力軸２２の回転位置とその回転位置におけるｓｉｎ波（ｃｏｓ波）の傾きとに基づいて、ｓｉｎ波の振幅を算出する。ここでは、ｓｉｎ波の振幅を算出する例を示すが、ｃｏｓ波の振幅を算出する場合も同様である。

図７は、理想のｓｉｎ波及び飽和状態のｓｉｎ波を示すグラフである。同図に示すように、例えば出力軸２２の角度＝１°において、理想のｓｉｎ波（点Ｐ３）と飽和状態のｓｉｎ波（点Ｐ４）とでは、曲線の傾きが異なっている。ｓｉｎ波の中央値は必ず２０４８になるとすると、角度＝１°（ある角度）において、理想のｓｉｎ波（点Ｐ３）と同じ傾きを持つｓｉｎ波は、理想のｓｉｎ波以外には存在しない。すなわち、ある角度とその角度におけるｓｉｎ波（ＡＤ値）の傾きとが分かれば、それらに対応するｓｉｎ波の振幅は一義的に決まる。このため、振幅算出部８２は、出力軸２２の角度（回転位置）とその角度におけるｓｉｎ波の傾きとｓｉｎ波の振幅との所定関係を、予めマップ又は計算式として設定しておく。

そして、振幅算出部８２は、ＡＤ変換部８１から第１のＡＤ値を入力した後、ゲイン調整部８３によりゲインを所定値変化させる。そして、振幅算出部８２は、ＡＤ変換部８１から第２のＡＤ値を入力する。さらに、振幅算出部８２は、モータ２０を制御して出力軸２２を所定量（例えば２〜３°）回転させる。そして、振幅算出部８２は、ＡＤ変換部８１から第３のＡＤ値を入力する。振幅算出部８２は、ＡＤ変換部８１から第３のＡＤ値を入力した後、ゲイン調整部８３によりゲインを所定値変化させる。そして、振幅算出部８２は、ＡＤ変換部８１から第４のＡＤ値を入力する。

振幅算出部８２は、第１のＡＤ値から第２のＡＤ値への変化量と、第３のＡＤ値から第４のＡＤ値への変化量との比に基づいて、出力軸２２の角度を算出する。この変化量の比は出力軸２２の角度によって異なるため、変化量の比と角度との予め設定された関係に基づいて、変化量の比から出力軸２２の角度を算出することができる。すなわち、振幅算出部８２は、ＡＤ変換部８１により出力されたＡＤ値とゲインを変化させた時にＡＤ変換部８１により出力されたＡＤ値とに基づいて、出力軸２２の角度（回転位置）を算出する。なお、振幅算出部８２は、第１の実施形態と同様に第１のＡＤ値におけるｓｉｎ波の傾きを算出する。

そして、振幅算出部８２は、出力軸２２の角度とその角度におけるｓｉｎ波の傾きを上記所定関係に適用して、ｓｉｎ波の振幅を算出する。すなわち、振幅算出部８２は、出力軸２２の角度とその角度においてＡＤ値が変化する傾きとＡＤ値の振幅との予め設定された所定関係と、算出した出力軸２２の角度とその角度においてＡＤ値が変化する傾きとに基づいて、ＡＤ変換部８１により出力されたＡＤ値の振幅を算出する。

また、第１実施形態と同様に、振幅算出部８２は、ＡＤ変換部８１により出力されたＡＤ値が上限値又は下限値であるか否か判定する。そして、振幅算出部８２は、ＡＤ変換部８１により出力されたＡＤ値が上限値又は下限値であると判定した場合に、出力軸２２を所定量（例えば３０°）回転させる。その後、振幅算出部８２は、ｓｉｎ波の振幅を算出する上記処理を実行する。そして、ゲイン調整部８３は、ｓｉｎ波の振幅が３１５０（目標振幅）となるように、ゲインを調整する。

以上詳述した本実施形態は、以下の利点を有する。ここでは、第１実施形態と異なる利点のみを述べる。

・振幅算出部８２は、出力軸２２の回転位置（角度）とその回転位置においてＡＤ値が変化する傾きとＡＤ値の振幅との予め設定された所定関係と、ＡＤ変換部８１により出力されたＡＤ値とゲインを変化させた時にＡＤ変換部８１により出力されたＡＤ値とに基づき算出した回転位置と、その回転位置においてＡＤ値が変化する傾きとに基づいて、ＡＤ変換部８１により出力されたＡＤ値の振幅を算出する。ゲインを変化させた時にＡＤ変換部８１により出力されたＡＤ値の変化量は、出力軸２２の回転位置に応じて変化する。このため、ＡＤ変換部８１により出力されたＡＤ値とゲインを変化させた時にＡＤ変換部８１により出力されたＡＤ値とに基づいて、出力軸２２の回転位置を算出することができる。

・出力軸２２の回転位置とその回転位置においてＡＤ値が変化する傾きとが分かれば、それらに対応するＡＤ値の振幅は一義的に決まる。このため、出力軸２２の回転位置とその回転位置においてＡＤ値が変化する傾きとＡＤ値の振幅との所定関係を、予め設定しておくことができる。そして、出力軸２２の回転位置をわずかに変化させれば、ＡＤ値が変化する傾きを算出することができ、出力軸２２ひいてはモータ２０を多数回転させる必要がない。したがって、振幅算出部８２はＡＤ値の振幅を迅速に算出することができ、算出された振幅に基づいてゲインを迅速に調整することができる。

・振幅算出部８２は、ＡＤ変換部８１により出力されたＡＤ値からゲインを変化させた時にＡＤ変換部８１により出力されたＡＤ値への変化量と、出力軸２２を所定量回転させてからＡＤ変換部８１により出力されたＡＤ値からゲインを変化させた時にＡＤ変換部８１により出力されたＡＤ値への変化量との比に基づいて、出力軸２２の回転位置を算出することができる。

なお、第１，第２実施形態を、以下のように変更して実施することもできる。第１，第２実施形態と同一の部分については、同一の符号を付すことにより説明を省略する。
・ＡＤ値は１２ｂｉｔに限らず、８ｂｉｔや１６ｂｉｔ等、他のｂｉｔ数で構成されていてもよい。その場合、ＡＤ値の下限値、中央値、上限値を、第１，第２実施形態に準じて適宜設定すればよい。

・図８に示すように、ｓｉｎ波（磁気センサ５２の出力信号）が中央値２０４８（基準値）に対して正側又は負側にオフセットする場合がある。この場合、ｓｉｎ波（ＡＤ値）の振幅を算出する精度が低下するおそれがある。

そこで、図９に示すように、ゲイン調整装置７０は、さらにオフセット補正部５５及びオフセット調整部８４を備えていてもよい。磁気センサ５２は、出力軸２２の回転位置に応じた出力信号を出力する。磁気センサ５２の出力信号は、オフセット補正部５５へ入力される。オフセット補正部５５は、磁気センサ５２から入力した出力信号にオフセット値を加算して補正する。オフセット補正部５５は、補正した出力信号をゲイン補正部５３へ出力する。

また、ＡＤ変換部８１は、ＡＤ値をオフセット調整部８４へ出力する。オフセット調整部８４は、ＡＤ変換部８１から入力したＡＤ値に基づいて、オフセット補正部５５で用いるオフセット値を調整する。詳しくは、オフセット調整部８４は、ＡＤ変換部８１により出力されたＡＤ値と出力軸２２を所定量回転させた時にＡＤ変換部８１により出力されたＡＤ値とに基づき算出したｓｉｎ波（近似曲線）と、ゲインを変化させてからＡＤ変換部８１により出力されたＡＤ値と出力軸２２を所定量回転させた時にＡＤ変換部８１により出力されたＡＤ値とに基き算出したｓｉｎ波との交点に基づいて、オフセット値を調整する。

上記構成によれば、オフセット補正部５５は、磁気センサ５２の出力信号にオフセット値を加算して補正する。オフセット調整部８４は、ＡＤ変換部８１により出力されたＡＤ値と出力軸２２を所定量回転させた時にＡＤ変換部８１により出力されたＡＤ値とに基づきｓｉｎ波を算出し、ゲインを変化させてからＡＤ変換部８１により出力されたＡＤ値と出力軸２２を所定量回転させた時にＡＤ変換部８１により出力されたＡＤ値とに基きｓｉｎ波を算出する。これらのｓｉｎ波は、ゲインの違いにより互いに振幅が異なるｓｉｎ波であり、出力信号がオフセットしていない場合に、中央値２０４８において交わる性質がある。このため、オフセット調整部８４は、これらの近似曲線の交点のＡＤ値と中央値２０４８との差に基づいて、オフセット値を適切に調整することができる。なお、ｃｏｓ波のＡＤ値についても、同様にオフセット値を適切に調整することができる。

・第１軸１１と第２軸１２とを接続する関節以外の関節に、上記の各実施形態を適用することもできる。また、ロボット１０は、垂直多関節ロボットに限らず、水平多関節ロボット等であってもよい。

２０…モータ、２１…入力軸（回転軸）、２２…出力軸、３０…減速機、３１…検出軸、５０…磁気センサユニット、５２…磁気センサ、５３…ゲイン補正部、５５…オフセット補正部、７０…ゲイン調整装置、８１…ＡＤ変換部（変換部）、８２…振幅算出部、８３…ゲイン調整部、８４…オフセット調整部。

Claims (6)

1. モータの回転軸の回転を減速機で減速させて回転させられる出力軸の回転位置に応じた出力信号を出力する磁気センサと、
   前記出力信号にゲインを掛けて補正するゲイン補正部と、
   前記ゲイン補正部により補正された前記出力信号をデジタル値に変換して出力する変換部と、
   前記デジタル値とそのデジタル値において前記デジタル値が変化する傾きと前記デジタル値の振幅との予め設定された所定関係と、前記変換部により出力された前記デジタル値とそのデジタル値において前記デジタル値が変化する傾きとに基づいて、前記変換部により出力された前記デジタル値の振幅を算出する振幅算出部と、
   前記振幅算出部により算出された前記振幅に基づいて、前記ゲインを調整するゲイン調整部と、
   を備えるゲイン調整装置。
2. モータの回転軸の回転を減速機で減速させて回転させられる出力軸の回転位置に応じた出力信号を出力する磁気センサと、
   前記出力信号にゲインを掛けて補正するゲイン補正部と、
   前記ゲイン補正部により補正された前記出力信号をデジタル値に変換して出力する変換部と、
   前記回転位置とその回転位置において前記デジタル値が変化する傾きと前記デジタル値の振幅との予め設定された所定関係と、前記変換部により出力された前記デジタル値と前記ゲインを変化させた時に前記変換部により出力された前記デジタル値とに基づき算出した前記回転位置と、その回転位置において前記デジタル値が変化する傾きとに基づいて、前記変換部により出力された前記デジタル値の振幅を算出する振幅算出部と、
   前記振幅算出部により算出された前記振幅に基づいて、前記ゲインを調整するゲイン調整部と、
   を備えるゲイン調整装置。
3. 前記振幅算出部は、前記変換部により出力された前記デジタル値から前記ゲインを変化させた時に前記変換部により出力された前記デジタル値への変化量と、前記出力軸を所定量回転させてから前記変換部により出力された前記デジタル値から前記ゲインを変化させた時に前記変換部により出力された前記デジタル値への変化量との比に基づいて、前記回転位置を算出する、請求項２に記載のゲイン調整装置。
4. 前記振幅算出部は、前記変換部により出力された前記デジタル値が上限値又は下限値であった場合に、前記出力軸を所定量回転させてから前記デジタル値の振幅を算出する、請求項１〜３のいずれか１項に記載のゲイン調整装置。
5. 前記振幅算出部は、前記変換部により出力された前記デジタル値と前記出力軸を所定量回転させた時に前記変換部により出力された前記デジタル値とに基づいて、前記傾きを算出する、請求項１〜４のいずれか１項に記載のゲイン調整装置。
6. 前記出力信号にオフセット値を加算して補正するオフセット補正部と、
   前記変換部により出力された前記デジタル値と前記出力軸を所定量回転させた時に前記変換部により出力された前記デジタル値とに基づき算出した近似曲線と、前記ゲインを変化させてから前記変換部により出力された前記デジタル値と前記出力軸を所定量回転させた時に前記変換部により出力された前記デジタル値とに基き算出した近似曲線との交点に基づいて、前記オフセット値を調整するオフセット調整部と、
   を備える、請求項１〜５のいずれか１項に記載のゲイン調整装置。

Images