JP2019141968A

JP2019141968A - ロボットのアーム回転軸速度検出装置

Info

Publication number: JP2019141968A
Application number: JP2018029681A
Authority: JP
Inventors: 健司長松; Kenji Nagamatsu
Original assignee: Denso Wave Inc
Current assignee: Denso Wave Inc
Priority date: 2018-02-22
Filing date: 2018-02-22
Publication date: 2019-08-29
Also published as: CN110181555A; US11018557B2; US20190260273A1

Abstract

【課題】アームの軸側に配置する回転センサの分解能が低いものであっても、回転速度の検出精度を高める。【解決手段】ロボットアームの回転軸２５側に、ホールセンサ２８（１），２８（２）を互いに９０度位相差のセンサ信号を出力するように配置する。速度用マイコン１４の速度演算部３１は、各センサ信号をそれぞれ微分すると、微分信号の２乗和を演算してアームの回転速度Ｖを求める。【選択図】図１

Description

本発明は、ロボットのアーム回転軸速度を検出する装置に関する。

ロボットアームの各軸を駆動するモータには、ロータリエンコーダのような回転センサが取り付けられている。そして、ロボットのアームは、モータの回転軸に連結された減速機構を介して駆動される。このようなロボットが動作する際に安全を確保するため、例えば図８に示すように、減速機構を経たアームの回転軸，つまり出力側にも回転センサを設けてアームの動作速度を直接検出し、動作速度が上限値を超えた際にモータの駆動を停止させることが考えられる。

出力側に配置する回転センサとして、例えば同図に示すようにホールセンサを用いることができる。アームの回転軸２５に永久磁石２７を配置し、その磁石２７の回転に伴う磁気の変化をホールセンサ２８により検出する。２つのホールセンサ２８（１），２８（２）を用いて９０度位相差のセンサ信号を得るようにすれば、アームの回転方向も検出できる。

特開２０１５−１４２９４８号公報

２相のセンサ信号から回転速度を得ることを想定すると、一方の信号がｓｉｎθ，他方の信号がｃｏｓθに対応するので、回転位置θを次式で求め、
θ＝ａｒｃｔａｎ（ｓｉｎθ／ｃｏｓθ） …（１）
回転位置θを微分すれば速度が得られる。

しかしながら、一般に、ホールセンサにより得られる回転位置情報は分解能が低い。そのため、上記の式に基づいて回転速度を求めると、誤差が非常に大きくなってしまう。例えば、図９に示すような２相のホールセンサ信号をＡ／Ｄ変換すると、図１０に示すように、量子化誤差を含んだ値となる。そして、これらの値から（１）式により角度θを求めると図１１に示すようになり、その角度θを微分して得られた速度は、図１２に示すように極めてばらつきが大きい値となってしまう。

本発明は、上記実情に鑑みてなされたものであり、その目的は、アームの軸側に配置する回転センサの分解能が低いものであっても、回転速度の検出精度を高めることができるロボットのアーム回転軸速度検出装置を提供することにある。

請求項１記載のロボットのアーム回転軸速度検出装置によれば、減速機構を介して駆動されるロボットアームの駆動機構に適用され、第１及び第２回転センサは、アームの回転軸側に配置されて、互いに９０度位相差の回転位置信号を出力する。第１及び第２微分器は、第１及び第２回転センサより出力される第１及び第２回転位置信号をそれぞれ微分する。速度演算部は、第１及び第２微分器より出力される第１及び第２微分信号の２乗和を演算してアームの回転速度を求める。

２つの回転センサより得られる回転位置信号の分解能が低く、それらによって得られる軸の回転位置が粗くても、回転位置信号を微分した信号のばらつきは、回転位置の即値が示すばらつきよりも小さくなる。したがって、分解能が低い回転センサを用いても、それらが出力する回転位置信号から回転位置を求め、速度を求める場合に比較して、より精度が高い回転速度を得ることができる。

請求項２記載のロボットのアーム回転軸速度検出装置によれば、第１及び第２回転センサを、アームの回転軸に配置される永久磁石の磁気変化を検出する磁気センサとする。このように構成すれば、安価な磁気センサを２つ用いてロボットのアーム回転軸速度を検出できる。

一実施形態であり、ロボットの各軸周りの構成と、それらに係るコントローラの制御部の構成とをモデル的に示す図コントローラについて、要部に係る部分を示す機能ブロック図ロボットシステムの構成を示す図制御用マイコンにより行われる、減速機構におけるバックラッシを解消す処理を示すフローチャート速度用マイコンにより実行される回転軸の速度を求める処理を示すフローチャートホールセンサ信号の微分値を示す図２つの微分値より合成した速度を示す図ロボットの各軸周りの構成をモデル的に示す図２相のホールセンサ信号を示す図ホールセンサ信号のＡＤ変換値を示す図ホールセンサ信号から求めた角度を示す図角度から求めた回転軸の速度を示す図

以下、一実施形態について図１から図８を参照して説明する。図３に示すように、ロボットシステム１は、垂直多関節型のロボット２、ロボット２を制御するコントローラ３を備えている。このロボットシステム１は、一般的な産業用に用いられている。ロボット２は、いわゆる６軸の垂直多関節型ロボットとして周知の構成を備えており、ベース５上に、Ｚ方向の軸心を持つ第１軸（Ｊ１）を介してショルダ６が水平方向に回転可能に連結されている。ショルダ６には、Ｙ方向の軸心を持つ第２軸（Ｊ２）を介して上方に延びる下アーム７の下端部が垂直方向に回転可能に連結されている。下アーム７の先端部には、Ｙ方向の軸心を持つ第３軸（Ｊ３）を介して第一上アーム８が垂直方向に回転可能に連結されている。

第一上アーム８の先端部には、Ｘ方向の軸心を持つ第４軸（Ｊ４）を介して第二上アーム９が捻り回転可能に連結されている。第二上アーム９の先端部には、Ｙ方向の軸心を持つ第５軸（Ｊ５）を介して手首１０が垂直方向に回転可能に連結されている。手首１０には、Ｘ方向の軸心を持つ第６軸（Ｊ６）を介してフランジ１１が捻り回転可能に連結されている。

ベース５、ショルダ６、下アーム７、第一上アーム８、第二上アーム９、手首１０およびフランジ１１は、ロボット２のアームとして機能し、アームの先端となるフランジ１１には、ワークを保持するための図示しないツールが取り付けられる。ロボット２に設けられている各軸（Ｊ１〜Ｊ６）には、それぞれに対応して駆動源となる図示しないモータが設けられている。

コントローラ３は、ロボット２の制御装置であり、図示しないＣＰＵ、ＲＯＭおよびＲＡＭ等で構成されたコンピュータからなる制御手段においてコンピュータプログラムを実行することで、ロボット２を制御する。具体的には、コントローラ３は、インバータ回路等から構成された駆動部を備えており、各モータに対応して設けられているエンコーダで検知したモータの回転位置に基づいて例えばフィードバック制御によりそれぞれのモータを駆動する。

コントローラ３は、ＣＰＵ、ＲＯＭ、ＲＡＭ、上記駆動部に相当するモータドライバ等を備えている。ＲＯＭは、ロボット２のシステムプログラムや動作プログラム等を記憶している。ＲＡＭは、これらのプログラムを実行する際にパラメータの値等を記憶する。位置検出回路には、コントローラ３には、ロボット２の各関節に設けられた図示しない各エンコーダの検出信号がそれぞれ入力される。

図２は、コントローラ３について、本実施形態の要部に係る部分を示す機能ブロック図である。コントローラ３は、メインＣＰＵ１２と、各軸Ｊ１〜Ｊ６のそれぞれに対応して設けられる制御用マイコン１３及び速度用マイコン１４とを備えている。コントローラ３には、例えばティーチングペンダントのようなユーザ操作部１５が接続されており、ユーザは、ユーザ操作部１５によりロボット２を制御するための各種パラメータを設定する。メインＣＰＵ１２は、各軸の制御用マイコン１３，速度用マイコン１４に対し、それぞれ角度指令，監視速度を与える。監視速度は、各軸の回転速度を監視するための上限値である。

図１は、ロボット２の各軸の軸周りの構成と、それらに係るコントローラ３の制御部の構成とをモデル的に示している。尚、軸周りの構成は、基本的に図８に示すイメージと同じであり、図８にも同じ符号を付している。モータ２１には、モータ側エンコーダ２２が取り付けられている。エンコーダ２２は、モータ２１の回転角度を制御用マイコン１３に入力する。モータ２１の回転軸２３は、複数段のギアからなるモジュールである減速機構２４の入力側に連結されている。減速機構２４の出力側は、対応するロボットアームの回転軸２５に連結されている。

回転軸２５には、アームの動きを制するための機械式ブレーキ２６が配置されている。また、回転軸２５には永久磁石２７が取り付けられており、回転軸２５が回転することに伴う永久磁石２７の磁界の変化は、２つのホールセンサ２８（１），２８（２）により検出される。ホールセンサ２８（１），２８（２）は、位相が９０度異なる回転位置信号，センサ信号を出力する。

ホールセンサ２８（１），２８（２）より出力されるセンサ信号は、それぞれアンプ２９（１），２９（２）により増幅されて、速度用マイコン１４が備えるＡ／Ｄ変換器３０（１），３０（２）に入力される。Ａ／Ｄ変換器３０（１），３０（２）によりＡ／Ｄ変換されたデータは、角度・速度演算部３１に入力される。

演算部３１は、入力される２相センサ信号のデータに基づいて、回転軸２５の回転角度及び回転速度を演算する。演算された回転角度，アーム角度は、制御用マイコン１３に入力される。また、演算された回転速度は、演算部３１において、メインＣＰＵ１２より与えられる監視速度と比較される。そして、アームの回転速度が監視速度を超えると、速度マイコン１４は、制御用マイコン１３に停止指令を出力する。

制御用マイコン１３は、制御対象のアーム角度が、メインＣＰＵ１２より与えられる角度指令に一致するようにモータ２１を制御する。モータ２１の制御信号は、アンプ３２及びモータドライバを介してモータ２１に与えられる。また、制御用マイコン１３は、ブレーキ２６のＯＮ／ＯＦＦも制御する。速度用マイコン１４より停止指令が入力されると、制御用マイコン１３は、ブレーキ２６をＯＮにすると共に、モータ２１の駆動制御を停止する。また、制御用マイコン１３は、アーム角度を参照することで、特許文献１と同様にモータ２１が何回転しているかを検出する多回転数検出処理を行う。

次に、本実施形態の作用について図４から図７を参照して説明する。図４は、制御用マイコン１３により行われる、減速機構２４におけるバックラッシを解消するための処理である。先ず、ブレーキ２６により回転軸２５をロックする（Ｓ１）。それから、モータドライバを構成する例えばＦＥＴなどのスイッチング素子を全てオフして、モータ２１をフリー状態にする（Ｓ２）。続いて、各アーム軸が重力の作用で動かない姿勢か否かを判断する（Ｓ３）。

ここで、ロボット２が、アームの回転軸２５に重力が作用する姿勢を取っていれば（ＮＯ）、バックラッシはステップＳ２の時点で解消される。したがってこの場合は、モータドライバのローサイドＦＥＴのみをＯＮにすることでモータ２１をショートブレーキ状態にして（Ｓ８）処理を終了する。

一方、ロボット２のアームが、例えば重力方向に沿って一直線となるような姿勢を取っている場合（Ｓ３；ＹＥＳ）、バックラッシは解消されない。そこで、ブレーキロック状態を維持するようにトルク制限値を設定してから（Ｓ４）、モータ２１をサーボロック状態にする（Ｓ５）。それから、モータ２１を時計回り方向，又は反時計回り方向に、極低速の一定速制御で回転させる（Ｓ６）。この処理を、モータ２１の出力トルクが制限値に達するまで継続し（Ｓ７；ＮＯ）、トルクが制限値に達すると（ＹＥＳ）ステップＳ８に移行する。
尚、出力トルクは、例えばモータ２１に通電される電流を検出して推定したり、ベクトル制御を行う際にはｑ軸電流の値をトルクと見なせば良い。この処理により、バックラッシの解消を図る。その後、アームの駆動制御を開始する際に、ブレーキ２６によるロック状態を解消する。

図５は、速度用マイコン１４により実行される回転軸２５の回転速度を求める処理を示す。尚、ステップＳ１１〜Ｓ１５の処理は、ホールセンサ２８（１），２８（２）について並行的に実行される。速度演算部３１は、ＡＤ変換器３０が出力する変換値が変化したか否かを判断する（Ｓ１１）。変換値が変化していなければ（ＮＯ）、変化時間をカウントするためのカウンタをインクリメントして（Ｓ１５）ステップＳ１１に戻る。

ＡＤ変換値が変化すると（Ｓ１１；ＹＥＳ）、その変換値の前回値と今回値との差分を算出し（Ｓ１２）、前記カウンタのカウント値から変換値が変化するまでの時間を求める（Ｓ１３）。そして、前記差分値を前記変化時間で除すことで、微分値を算出する（Ｓ１４）。速度演算部３１は、第１及び第２微分器の機能も備えている。

以上のようにして、ホールセンサ２８（１），２８（２）が出力するセンサ信号の微分値を求めると、これらを合成して回転軸２５の速度を求める（Ｓ１６）。すなわち、各微分値を微分値（１），（２）とすると、
（合成速度）＝√｛微分値（１）²＋微分値（２）²｝
より求める。

速度マイコン１４は、上式で求めた速度を監視速度と比較して、監視速度を超えると前述したように制御用マイコン１３に停止指令を出力する。すると、制御用マイコン１３はブレーキ２６をＯＮにすると共に、モータ２１の駆動制御を停止する。尚、このように速度を監視する際には、合成速度Ｖそのものではなく、その２乗値Ｖ²について監視しても良い。

すなわち、この処理は、ホールセンサ２８（１），２８（２）により出力される２相のセンサ信号Ｈ１，Ｈ２がそれぞれ、例えばｓｉｎ（ωｔ），ｃｏｓ（ωｔ）であるとする。これらを微分すれば、それぞれ速度Ｖ１，Ｖ２が得られる。
Ｖ１＝ｄＨ１／ｄｔ＝Ｖ１＝ω×ｃｏｓ（ωｔ）
Ｖ２＝ｄＨ２／ｄｔ＝Ｖ２＝−ω×ｓｉｎ（ωｔ）
そして、ステップＳ１６で求める速度Ｖは、
Ｖ＝√｛Ｖ１²＋Ｖ２²｝
である。

ホールセンサ２８（１），２８（２）により出力される各信号の微分値は、図６に示すようになり、これらの微分値を合成して求めた速度Ｖは、図７に示すようになる。これは、図１２に示したように、センサ信号から角度θを求め、角度θを微分して求めた速度とばらつきの最大，最小間の振れ幅を比較すると、約３０倍程度に精度が改善されている。

以上のように本実施形態によれば、ロボットアームの回転軸２５側に、ホールセンサ２８（１），２８（２）を互いに９０度位相差のセンサ信号を出力するように配置する。速度用マイコン１４の速度演算部３１は、各センサ信号をそれぞれ微分すると、微分信号の２乗和を演算してアームの回転速度Ｖを求める。これにより、分解能が低いく安価なホールセンサ２８を用いても、それらが出力するセンサ信号から角度を求めて速度を求める場合に比較して、より精度が高い回転速度Ｖを得ることができる。

また、制御用マイコン１３は、ブレーキ２６により回転軸２５を拘束すると、モータ２１の駆動トルクについて、ブレーキ２６による拘束力を下回るトルク制限値を設定する。そして、モータ２１の駆動トルクがトルク制限値に達するまでモータ２１を回転させて、バックラッシを解消する。

すなわち、回転軸２５を拘束した状態でモータ２１を回転させれば、バックラッシが存在している分だけモータ２１は回転することになり、その分の隙間が無くなった時点で回転は停止し、モータ２１の駆動トルクが上昇する。したがって、駆動トルクがトルク制限値に達した時点で、バックラッシ分の隙間が消滅したことを判定でき、バックラッシを解消してモータ２１の制御精度を向上させることができる。

この時、制御用マイコン１３は、ブレーキ２６により回転軸２５を拘束すると、モータドライバによるモータ２１の駆動を停止させた状態にして、ロボットアームの姿勢が回転軸に重力が作用する姿勢か否かを判断する。そして、回転軸に重力が作用する姿勢でなければバックラッシ解消処理を行う。

一般に、ロボットアームは、回転軸に重力が作用する姿勢で停止していることが多い。その場合、アーム側の回転軸を拘束した状態でモータ２１の駆動を停止させれば、モータ２１は回転フリーの状態となり、回転軸２５は重力が作用する方向に回転して止まる。これにより、バックラッシは解消される。そして、回転軸２５に重力が作用しない特殊な姿勢である時だけバックラッシ解消処理を行うので、処理を短時間に終了できるようになる。

また、制御用マイコン１３は、ホールセンサ２８より得られるセンサ信号を参照することで、モータ２１の回転軸２２が回転した回数を求める多回転検出処理を行う。このような処理を行うに当たり、事前にバックラッシを解消することで、回転回数の検出を高精度に行うことができる。

本発明は上記した、又は図面に記載した実施形態にのみ限定されるものではなく、以下のような変形又は拡張が可能である。
ステップＳ２及びＳ３の処理を省略しても良い。
回転センサは、磁気センサに限ることはない。
垂直６軸型以外のロボットに適用しても良い。

図面中、１はロボットシステム、２はロボット、３はコントローラ、１３は制御用マイコン、１４は速度用マイコン、２１はモータ、２４は減速機構、２５は回転軸、２７は永久磁石、２８はホールセンサ、３１は角度・速度演算部を示す。

Claims

モータと、このモータの回転軸に連結される減速機構と、この減速機構を介して駆動されるロボットアームの回転軸とで構成されるロボットアームの駆動機構に適用され、
前記アームの回転軸側に配置され、９０度位相差の回転位置信号を出力する第１及び第２回転センサと、
前記第１及び第２回転センサより出力される第１及び第２回転位置信号をそれぞれ微分する第１及び第２微分器と、
これら第１及び第２微分器より出力される第１及び第２微分信号の２乗和を演算して、前記アームの回転速度を求める速度演算部とを備えるロボットのアーム回転軸速度検出装置。
前記アームの回転軸には永久磁石が配置されており、
前記第１及び第２回転センサは、前記永久磁石の磁気変化を検出する磁気センサである請求項１記載のロボットのアーム回転軸速度検出装置。