JP7353755B2 - Robot system, method for controlling the robot system, method for manufacturing articles using the robot system, detection device, method for controlling the detection device, drive device, method for controlling the drive device, control program, and recording medium - Google Patents
Robot system, method for controlling the robot system, method for manufacturing articles using the robot system, detection device, method for controlling the detection device, drive device, method for controlling the drive device, control program, and recording medium Download PDFInfo
- Publication number
- JP7353755B2 JP7353755B2 JP2018235918A JP2018235918A JP7353755B2 JP 7353755 B2 JP7353755 B2 JP 7353755B2 JP 2018235918 A JP2018235918 A JP 2018235918A JP 2018235918 A JP2018235918 A JP 2018235918A JP 7353755 B2 JP7353755 B2 JP 7353755B2
- Authority
- JP
- Japan
- Prior art keywords
- information regarding
- value
- force
- link
- detection means
- 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.)
- Active
Links
Images
Description
本発明は、検出装置が設けられたロボット装置に関する。 The present invention relates to a robot device equipped with a detection device.
近年、ロボットアームの各関節部にトルクセンサ等の力の情報を検出する検出装置を搭載し、検出装置で検出した値をロボットアームの動作へフィードバックする力制御を用い、製品の製造等の作業が行われている。 In recent years, each joint of a robot arm is equipped with a detection device that detects force information, such as a torque sensor, and force control is used to feed back the values detected by the detection device to the robot arm's movements, making it possible to perform tasks such as manufacturing products. is being carried out.
力制御を用いることで、ロボットアームを含めたロボット装置によって組立対象へ印加される力を制御する事が可能となり、従来の位置制御では組み立てる事が困難な製品の製造が可能となっている。 By using force control, it is possible to control the force applied to the assembly target by robot devices including robot arms, making it possible to manufacture products that are difficult to assemble using conventional position control.
トルクセンサ等の力の情報を検出する検出装置の構造は外力が加わることで変形する弾性体と、その弾性体の変位を測定する変位測定センサ（ひずみゲージ、光学式変位計、磁気式変位計）で主に構成されている。 The structure of detection devices such as torque sensors that detect force information includes an elastic body that deforms when external force is applied, and a displacement measurement sensor (strain gauge, optical displacement meter, magnetic displacement meter) that measures the displacement of the elastic body. ) is mainly composed of.
しかしながら上記のような弾性体は、変形による変位の測定を精度よく行う為に、変形する方向が所望の方向となるように、弾性体の各方向の剛性に変化を付けて設計されている。そのため、例えば、ロボット装置のフレームなどよりも、ある方向には剛性が小さく、ある方向には強度が弱い場合が多々ある。 However, in order to accurately measure the displacement due to deformation, the elastic body as described above is designed to vary the rigidity in each direction so that the direction of deformation is a desired direction. Therefore, for example, it often has less rigidity in a certain direction and weaker strength in a certain direction than the frame of a robot device.
ゆえに、ロボット装置の動作により、弾性体に繰り返し力がかかることで、弾性体の剛性の低下や亀裂・破損、変位測定センサの配置ズレなどの問題が生じる場合がある。 Therefore, due to the repetitive force applied to the elastic body by the operation of the robot device, problems such as a decrease in the rigidity of the elastic body, cracks and damage, and misalignment of the displacement measurement sensor may occur.
弾性体に亀裂・破損などが生じ剛性が低下したり、変位測定センサの配置ズレが生じると、正しく外力を測定することができなくなり、力制御を用いた組立を失敗してしまう場合がある。これにより、製品の不良が生じてしまうため、検出装置の弾性体の不具合を事前に予測する事が求められている。 If the elastic body is cracked or damaged, resulting in a decrease in rigidity, or if the displacement measurement sensor is misplaced, external force cannot be measured correctly, and assembly using force control may fail. This may lead to product defects, so it is required to predict in advance defects in the elastic body of the detection device.
特許文献１では、事前に所定の工具をロボットが把持したときの力センサからの検出値を記憶しておき、所定の時間が経過した後、検査のタイミングで力センサからの検出値を比較し、その偏差が規定値よりも大きくなったら警報信号を出している。 In Patent Document 1, a detection value from a force sensor when a robot grips a predetermined tool is stored in advance, and after a predetermined time has elapsed, the detection values from the force sensor are compared at the timing of an inspection. When the deviation becomes larger than a specified value, an alarm signal is issued.
これにより、上記のような理由により検出装置に問題が発生しそうな場合でも、ユーザに事前に問題の発生の危険を通知することができ、組立失敗による不良品が生じる前に検出装置の交換を行わせることができる。 As a result, even if a problem is likely to occur with the detection device due to the reasons mentioned above, the user can be notified of the risk of the problem occurring in advance, and the detection device can be replaced before defective products occur due to assembly failure. You can make it happen.
しかしながら、特許文献１の方法では力センサに問題が生じたことは判定できるが、力センサのどの部分で問題が生じたのか分からない。そのため、問題が発生した力センサのメンテナンスを効果的に行うことが困難となる。 However, although the method disclosed in Patent Document 1 can determine that a problem has occurred in the force sensor, it cannot be determined in which part of the force sensor the problem has occurred. Therefore, it becomes difficult to effectively maintain a force sensor in which a problem has occurred.
以上の課題を鑑み、本発明では、力を検出する検出装置を備えたロボット装置において、力を検出する検出装置のどの部分で問題が発生したのか特定することができるロボット装置を提供することを目的とする。 In view of the above problems, it is an object of the present invention to provide a robot device that is equipped with a detection device that detects force and can identify in which part of the detection device that detects force a problem has occurred. purpose.
上記課題を解決するために本発明においては、第１リンクと、前記第１リンクに対して相対的に変位する第２リンクと、を備えたロボット本体と、前記ロボット本体を制御する制御装置と、を備えたロボットシステムであって、前記第１リンクに対して相対的に変位した前記第２リンクの位置の値に関する情報を出力する第１位置検出手段と、前記第１リンクと前記第２リンクとの間の力の値に関する情報を出力する力検出手段と、を備え、前記制御装置は、前記第１位置検出手段に基づき取得された前記位置の値に関する情報と、前記位置の値に関する情報に対応する第１閾値と、前記力検出手段に基づき取得された前記力の値に関する情報と、前記力の値に関する情報に対応する第２閾値とに基づき、前記力検出手段が有する少なくとも２つの部品の少なくとも１つの状態を取得する、ことを特徴とするロボットシステムを採用した。 In order to solve the above problems, the present invention includes a robot body including a first link and a second link that is relatively displaced with respect to the first link, and a control device that controls the robot body. A robot system comprising: a first position detection means for outputting information regarding a position value of the second link displaced relative to the first link; force detection means for outputting information regarding the value of the force between the control device and the link; Based on a first threshold value corresponding to the information, information regarding the force value acquired based on the force detection means, and a second threshold value corresponding to the information regarding the force value , at least A robot system is adopted that is characterized by acquiring the state of at least one of two parts.
本発明によれば、２つの検出装置を用いて、各検出装置の問題発生の判定を行っている。よって、問題発生の状況を場合分けすることができ、特に力を検出する検出装置に関してはどの部分で問題が発生しているのか特定することができる。 According to the present invention, two detection devices are used to determine whether a problem has occurred in each detection device. Therefore, it is possible to classify the situation in which the problem occurs, and in particular, it is possible to specify in which part the problem is occurring in the detection device that detects force.
以下、添付図面に示す実施例を参照して本発明を実施するための形態につき説明する。なお、以下に示す実施例はあくまでも一例であり、例えば細部の構成については本発明の趣旨を逸脱しない範囲において当業者が適宜変更することができる。また、本実施形態で取り上げる数値は、参考数値であって、本発明を限定するものではない。 DESCRIPTION OF THE PREFERRED EMBODIMENTS Hereinafter, embodiments for carrying out the present invention will be described with reference to embodiments shown in the accompanying drawings. Note that the embodiments shown below are merely examples, and those skilled in the art can appropriately change, for example, the detailed configuration without departing from the spirit of the present invention. Moreover, the numerical values taken up in this embodiment are reference numerical values, and do not limit the present invention.
（第１の実施形態）
図１は、本実施形態におけるロボット装置１００を、ＸＹＺ座標系の任意の方向から見た平面図である。なお以下の図面において、図中の矢印Ｘ、Ｙ、Ｚはロボット装置１００全体の座標系を示す。一般に、ロボット装置を用いたロボットシステムでは、ＸＹＺ３次元座標系は、設置環境全体のグローバル座標系の他に、制御の都合などによって、ロボットハンド、指部などに関して適宜ローカル座標系を用いる場合がある。本実施形態ではロボット装置１００全体の座標系をＸＹＺ、ローカル座標系をｘｙｚで表すものとする。
(First embodiment)
FIG. 1 is a plan view of a
図１に示すように、ロボット装置１００は、多関節のロボットアーム本体２００、ロボットハンド本体３００、ロボット装置１００全体の動作を制御する制御装置４００を備えている。
As shown in FIG. 1, the
また、制御装置４００に教示データを送信する教示装置としての外部入力装置５００を備えている。外部入力装置５００の一例としてティーチングペンダントが挙げられ、作業者がロボットアーム本体２００やロボットハンド本体３００の位置を指定するのに用いる。
Further, an
本実施形態では、エンドエフェクタとしてロボットアーム本体２００の先端部に設けられるものが、ロボットハンドである場合について説明するが、これに限定するものではなく、ツール等であってもよい。
In this embodiment, a case will be described in which the end effector provided at the tip of the
ロボットアーム本体２００の基端となるリンク２０１は、基台２１０に設けられている。
A
ロボットハンド本体３００は、部品やツール等の対象物を把持するものである。本実施形態のロボットハンド本体３００は不図示の駆動機構およびモータにより２本の指部を開閉し、ワークＷの把持ないし開放を行う。ワークＷをロボットアーム本体２００に対して相対的に変位させないように把持できれば良い。
The robot hand
ロボットハンド本体３００はリンク２０６に接続され、リンク２０６が回転することで、ロボットハンド本体３００も回転させることができる。
The
ロボットアーム本体２００は、複数の関節、例えば６つ関節（６軸）を有している。ロボットアーム本体２００は、各関節Ｊ１～Ｊ６を各回転軸まわりの矢印方向にそれぞれ回転駆動させる複数（６つ）のサーボモータ２１１～２１６を有している。
The robot arm
ロボットアーム本体２００は、複数のリンク２０１～２０６が各関節Ｊ１～Ｊ６で回転可能に連結されている。ここで、ロボットアーム本体２００の基端側から先端側に向かって、リンク２０１～２０６が順に直列に連結されている。
The robot arm
同図より、ロボットアーム本体２００の基台２１０とリンク２０１はＺ軸方向の回転軸Ａ１の周りで回転する関節Ｊ１で接続されている。関節Ｊ１は、例えば初期姿勢から約±１８０度の可動範囲を有するものとする。
As shown in the figure, the
ロボットアーム本体２００のリンク２０１とリンク２０２は関節Ｊ２で接続されている。関節Ｊ２の回転軸Ａ２は、図示の状態ではＸ軸方向に一致している。この関節Ｊ２は、例えば初期姿勢から約±８０度の可動範囲を有するものとする。
ロボットアーム本体２００のリンク２０２とリンク２０３は関節Ｊ３で接続されている。この関節Ｊ３の回転軸Ａ３は、図示の状態ではＸ軸方向に一致している。関節Ｊ３は、例えば初期姿勢から約±７０度の可動範囲を有するものとする。
ロボットアーム本体２００のリンク２０３とリンク２０４とは、関節Ｊ４で接続されている。この関節Ｊ４の回転軸Ａ４は、図示の状態ではＹ軸方向に一致している。関節Ｊ４は、例えば初期姿勢から約±１８０度の可動範囲を有するものとする。
ロボットアーム本体２００のリンク２０４とリンク２０５は関節Ｊ５で接続されている。関節Ｊ５の回転軸はＹ軸方向に一致している。この関節Ｊ５は、初期姿勢から約±１２０度の可動範囲を有するものとする。
ロボットアーム本体２００のリンク２０５とリンク２０６は関節Ｊ６で接続されている。関節Ｊ６の回転軸Ａ６はＸ軸方向に一致している。この関節Ｊ６は、初期姿勢から約±２４０度の可動範囲を有するものとする。
以上によりロボットアーム本体２００は、可動範囲の中であれば、任意の３次元位置で任意の３方向の姿勢に、ロボットアーム本体２００のエンドエフェクタ（ロボットハンド本体３００）を向けることができる。
As described above, the
ここで、ロボットアーム本体２００の手先とは、本実施形態では、ロボットハンド本体３００のことである。ロボットハンド本体３００が物体を把持している場合は、ロボットハンド本体３００と把持している物体（例えば部品やツール等）とを含めてロボットアーム本体２００の手先という。
Here, the tip of the
つまり、ロボットハンド本体３００が物体を把持している状態であるか物体を把持していない状態であるかにかかわらず、エンドエフェクタであるロボットハンド本体３００を手先という。
In other words, the
各関節Ｊ１～Ｊ６は、それぞれモータ２１１～２１６と、各モータ２１１～２１６にそれぞれ接続されたセンサ部２２１～２２６とを有している。各センサ部２２１～２２６は、各リンク間の相対的な位置を検出する位置検出手段と、各関節Ｊ１～Ｊ６で生じる力を検出する力検出手段とを有している。
Each joint J 1 to J 6 has a
本実施形態では、位置検出手段として出力軸エンコーダ５５１～５５６、力検出手段としてトルクセンサ５６１～５６６を用いている。詳しい構成については後述する。 In this embodiment, output shaft encoders 551 to 556 are used as position detection means, and torque sensors 561 to 566 are used as force detection means. The detailed configuration will be described later.
また、各関節Ｊ１～Ｊ６は、減速機２３１～２３６（図３）を有し、直接、又は不図示のベルトやベアリング等の伝達部材を介して各関節で駆動されるリンク２０１～２０６に接続されている。
Further, each joint J 1 to J 6 has a reducer 231 to 236 (FIG. 3), and
基台２１０の内部には、各モータ２１１～２１６の駆動を制御する駆動制御部としてのサーボ制御部２３０（図２）が配置されている。
Inside the
サーボ制御部２３０は、入力された各関節Ｊ１～Ｊ６に対応する各トルク指令値に基づき、各関節Ｊ１～Ｊ６のトルクがトルク指令値に追従するよう、各モータ２１１～２１６に電流を出力し、各モータ２１１～２１６の駆動を制御する。
Based on the input torque command values corresponding to the joints J 1 to J 6 , the
なお、本実施形態では、サーボ制御部２３０が１つの制御装置で構成されているものとして説明しているが、各モータ２１１～２１６にそれぞれ対応した複数の制御装置の集合体で構成されていてもよい。
In this embodiment, the
また、本実施形態では、サーボ制御部２３０は、基台２１０の内部に配置されているが、ロボットアーム制御装置４００の内部に配置されていてもよい。
Further, in this embodiment, the
以上の構成により、ロボットアーム本体２００によりロボットハンド本体３００を任意の位置に動作させ、所望の作業を行わせることができる。所望の作業とは例えば、ワークＷを把持し、所定のワークに組み付け、物品の製造を行う等の作業である。
With the above configuration, the
なおロボットハンド本体３００は、例えば空気圧駆動のエアハンドなどのエンドエフェクタ等であっても良い。
Note that the robot hand
またロボットハンド本体３００は、リンク２０６に対してビス止めなどの半固定的な手段によって装着されるか、あるいは、ラッチ止めなどの着脱手段によって装着可能であるものとする。
Further, the robot hand
特に、ロボットハンド本体３００が着脱可能である場合は、ロボットアーム本体２００を制御して、ロボットアーム本体２００自身の動作によって供給位置に配置された複数種類のロボットハンド本体３００を着脱ないし交換する方式も考えられる。
In particular, when the
図２は、本実施形態におけるロボット装置１００の構成を示すブロック図である。制御装置４００は、コンピュータで構成されており、制御部（処理部）としてのＣＰＵ（Ｃｅｎｔｒａｌ Ｐｒｏｃｅｓｓｉｎｇ Ｕｎｉｔ）４０１を備えている。
FIG. 2 is a block diagram showing the configuration of the
また制御装置４００は、記憶部として、ＲＯＭ（Ｒｅａｄ Ｏｎｌｙ Ｍｅｍｏｒｙ）４０２、ＲＡＭ（Ｒａｎｄｏｍ Ａｃｃｅｓｓ Ｍｅｍｏｒｙ）４０３、ＨＤＤ（Ｈａｒｄ Ｄｉｓｋ Ｄｒｉｖｅ）４０４を備えている。また、制御装置４００は、記録ディスクドライブ４０５、各種のインタフェース４０６～４０９を備えている。
The
ＣＰＵ４０１には、ＲＯＭ４０２、ＲＡＭ４０３、ＨＤＤ４０４、記録ディスクドライブ４０５、各種のインタフェース４０６～４０９が、バス４１０を介して接続されている。
A
ＲＯＭ４０２には、ＣＰＵ４０１に、演算処理を実行させるためのプログラム４３０が格納されている。ＣＰＵ４０１は、ＲＯＭ４０２に記録（格納）されたプログラム４３０に基づいてロボット制御方法の各工程を実行する。
The
ＲＡＭ４０３は、ＣＰＵ４０１の演算処理結果等、各種データを一時的に記憶する記憶装置である。
The
ＨＤＤ４０４は、ＣＰＵ４０１の演算処理結果や外部から取得した各種データ等を記憶する記憶装置である。
The
記録ディスクドライブ４０５は、記録ディスク４３５に記録された各種データやプログラム等を読み出すことができる。
The
外部入力装置５００はインタフェース４０６に接続されている。ＣＰＵ４０１はインタフェース４０６及びバス４１０を介して外部入力装置５００からの教示データの入力を受ける。
サーボ制御部２３０は、インタフェース４０９に接続されている。ＣＰＵ４０１は、サーボ制御部２３０、インタフェース４０９及びバス４１０を介して各センサ部２２１～２２６から検出結果を取得する。また、ＣＰＵ４０１は、各関節のトルク指令値のデータを所定時間間隔でバス４１０及びインタフェース４０９を介してサーボ制御部２３０に出力する。
同様にロボットハンド用のモータ３１１の駆動を制御するサーボ制御部３５１も、インタフェース４１１に接続され、バス４１０を介してＣＰＵ４０１と通信可能に設けられている。ＣＰＵ４０１は、サーボ制御部３５１、バス４１０及びインタフェース４１１を介してセンサ部３２１から検出結果を取得する。また、ＣＰＵ４０１は、各指部の指令値のデータを所定時間間隔でバス４１０及びインタフェース４１１を介してサーボ制御部３５１に出力する。
Similarly, a
インタフェース４０７には、モニタ４２１が接続されており、モニタ４２１には、ＣＰＵ４０１の制御の下、各種画像が表示される。インタフェース４０８は、書き換え可能な不揮発性メモリや外付けＨＤＤ等の記憶部である外部記憶装置４２２が接続可能に構成されている。
A
なお本実施形態では、コンピュータ読み取り可能な記録媒体がＨＤＤ４０４であり、ＨＤＤ４０４にプログラム４３０が格納される場合について説明するが、これに限定するものではない。プログラム４３０は、コンピュータ読み取り可能な記録媒体であれば、いかなる記録媒体に記録されていてもよい。
Note that in this embodiment, a case will be described in which the computer-readable recording medium is the
例えば、プログラム４３０を供給するための記録媒体としては、ＲＯＭ４０２、記録ディスク４３５、外部記憶装置４２２等を用いてもよい。具体例を挙げて説明すると、記録媒体として、フレキシブルディスク、ハードディスク、光ディスク、光磁気ディスク、ＣＤ－ＲＯＭ、ＣＤ－Ｒ、磁気テープ、不揮発性メモリ、ＲＯＭ等を用いることができる。
For example, as a recording medium for supplying the
図３は、本実施形態におけるロボットアーム本体２００の関節Ｊ２における構造の概略図と、制御ブロック図である。
FIG. 3 is a schematic diagram of the structure of the joint J2 of the robot arm
図３より、リンク２０１にはモータ２１２が取り付けられており、モータ２１２にはモータの回転量を計測するための入力軸エンコーダ２７２が取り付けられている。
As shown in FIG. 3, a
モータ２１２の回転軸には、減速機２３２が接続されており、モータ２１２の高速な回転を入力として、モータ２１２の回転を減速し、トルクが増大した回転を出力する。
A
さらに減速機２３２の出力側には、力検出手段としてトルクセンサ５６２が接続されており、トルクセンサ５６２にはリンク２０２が接続されている。
Further, a
ここで、トルクセンサ５６２について図４を用いて詳細に説明する図４（ａ）は所定の方向からトルクセンサ５６３を見た際の詳細図である。図４（ｂ）はトルクセンサ５６２を図４（ａ）の一点鎖線ＡＡを－Ｘ方向に切断した際の断面図を詳細に表した図である。なお、図４は各トルクセンサ５６１～５６６を代表して示しており、図４と同様の構造を各トルクセンサ５４１～５４６も有している。
Here, the
図４（ａ）より、トルクセンサ５６２は円筒形のフレーム５０１と、光学式エンコーダ５０２により構成されている。光学式エンコーダ５０２は回転軸Ａ２を中心としたフレーム５０１の円周上に対向配置されている。
As shown in FIG. 4A, the
フレーム５０１は、第１の固定部材５０４、第２の固定部材５０５、およびこれら両者を相対移動可能に連結するフレーム５０１の円周上に配置された連結部材５０６により構成されている。
The
第１の固定部材５０４、第２の固定部材５０５、連結部材５０６は本実施形態では同じ材質で一体に作られている。また第１の固定部材５０４には検出ヘッド支持部５１０を取り付ける取付部５１２が設けられている。
In this embodiment, the first fixing
第１の固定部材５０４と第２の固定部材５０５は、図示のような中空の円筒形状に構成される。これら第１の固定部材５０４、第２の固定部材５０５は、相対変位する測定対象、例えば図３の減速機２３２およびリンク２０２にそれぞれ締結するためのフランジ部位として機能する。
The
連結部材５０６は、ドーナツ形状の第１の固定部材５０４と、第２の固定部材５０５の間連結するリブ形状の部材として構成されている。この複数の連結部材５０６は回転軸Ａ２を中心として、第１の固定部材５０４と第２の固定部材５０５の間に円陣配置されている。
The connecting
また第１の固定部材５０４と第２の固定部材５０５には、減速機２３２とリンク２０２にそれぞれ締結するための締結部位５０７が複数個配置されている。
Further, a plurality of
本実施形態ではビス止めを行うビス孔が締結部位５０７として、第１の固定部材５０４および第２の固定部材５０５にそれぞれ１２個配置されている。
In this embodiment, 12 screw holes for screwing are arranged as
また、本実施形態では、第１の固定部材５０４に減速機２３２が接続され、第２の固定部材５０５にリンク２０２が接続されているものとする。なお、各接続に関しては逆でも良い。
Further, in this embodiment, it is assumed that the
フレーム５０１の各部位は、目的のトルク検出範囲およびその必要分解能などに応じた弾性係数を有する所定の材質、例えば樹脂や、金属（鋼材、ステンレスなど）の材質から構成される。
Each part of the
さらにフレーム５０１は３Ｄプリンタによって製造されてもよい。具体的には、フレーム５０１の設計データ（例えばＣＡＤデータ）から、３Ｄプリンタ用のスライスデータを作成し、そのデータを従来の３Ｄプリンタに入力することにより製造することができる。
Furthermore,
光学式エンコーダ５０２は光学式の位置センサとしての機能を有する。光学式エンコーダ５０２は、スケール５０８と、スケール５０８から位置情報を検出する検出ヘッド５０９を備える。また検出ヘッド５０９は検出ヘッド支持部５１０に取り付けられており、検出ヘッド５０９とスケール５０８が対向する空間をシール部材５１１により封止している。
図４（ｂ）より、検出ヘッド支持部５１０は第１の固定部材５０４に設けられており、スケール５０８は第２の固定部材５０５に設けられている。検出ヘッド５０９については、検出ヘッド支持部５１０に固定されている。
As shown in FIG. 4B, the detection
スケール５０８は、反射型のスケールであり、格子配列の光学パターン５４１を有する。光学パターン５４１は、例えばＡｌ、Ｃｒで形成されている。
The
検出ヘッド５０９は、反射型の検出ヘッドであり、発光素子５７１及び受光素子５７２を有する。
The
この検出ヘッド５０９の発光素子５７１からの光を光学パターン５４１に照射し、また、この照射空間にゴミが混入しないよう、発光素子５７１、受光素子５７２、光学パターン５４１が、シール部材５１１により封止されている。また発光素子５７１および受光素子５７２に電力を供給するための配線５１４が設けられている。
Light from the
検出ヘッド５０９は、発光素子５７１から光をスケール５０８に対して照射し、スケール５０８の光学パターン５４１から反射した光を受光素子５７２が受光する。
In the
なお、検出ヘッド５０９は第１の固定部材５０４に、スケール５０８は第２の固定部材５０５に設けられているが逆でも構わない。
Note that although the
第１の固定部材５０４と第２の固定部材５０５との相対移動量が検出できるならば、第１の固定部材５０４と第２の固定部材５０５のどちらか一方に検出ヘッド５０９、他方にスケール５０８が設けられていればよい。
If the amount of relative movement between the first fixing
ここで、回転軸Ａ２まわりのトルクが作用し、第１の固定部材５０４と第２の固定部材５５０５とが相対回転すると、検出ヘッド５０９とスケール５０８の相対位置が変化する。そしてスケール５０８に照射されている光の照射位置が光学パターン５４１上を移動する。
Here, when torque around the rotation axis A2 acts and the first fixing
このとき、スケール５０８に照射されている光がスケール５０８上に設けられた光学パターン５４１を通過すると、検出ヘッド５０９の受光素子５７２で検出される光の光量が変化する。
At this time, when the light irradiating the
この光量の変化から、第１の固定部材５０４と第２の固定部材５０５との相対移動量を検出する。検出ヘッド５０９が検出した相対移動量とトルクセンサ５６２に作用したトルクに変換する感度係数となるフレーム５０１の剛性値を用いることでトルクを算出する。
From this change in the amount of light, the amount of relative movement between the first fixing
また、光学式エンコーダ５０２は回転軸Ａ２を中心としたフレーム５０１の円周上に対向配置されている。これにより、光学式エンコーダ５０２を複数個配置しているので、各光学式エンコーダ５０２から検出される値を平均化でき、第１の固定部材と第２の固定部材との相対移動量の検出精度を向上させることができる。
Further, the
なお、スケールパターンは、算出の方式によっては１条のみならず、（例えば配置位相の異なる）複数条の濃淡パターンを複数条配置することもできる。スケールパターンのピッチは、位置検出に必要とされる分解能などに応じて決定するが、近年ではエンコーダの高精度化／高分解能化に伴い、μｍオーダのピッチの物も利用可能である。 Note that, depending on the calculation method, the scale pattern may be not only one line but also a plurality of grayscale patterns (for example, with different arrangement phases). The pitch of the scale pattern is determined depending on the resolution required for position detection, but in recent years, as encoders have become more accurate and have higher resolution, scale patterns with a pitch on the μm order are also available.
以上によりトルクセンサ５６２によってリンク２０１、リンク２０２間に生じているトルクを計測することができる。
As described above, the torque generated between the
このトルクセンサ５６２を構成する、弾性体となるフレーム５０１の剛性が低下、もしくは、変位検出センサとなる光学式エンコーダ５０２の、検出ヘッド５０９、スケール５０８の配置がズレることで、トルクセンサ５６２に不具合が生じる。
The
図３に戻り、リンク２０１とリンク２０２には、減速機を介さずにリンク間の相対的な位置を直接計測する事が可能な出力軸エンコーダ５５２が配置されている。
Returning to FIG. 3, an
出力軸エンコーダ５５２も、上記で説明したトルクセンサ５６２に設けられた光学式エンコーダ５０２と同様に、発光素子と受光素子を備えた検出ヘッド５５２ｂと、光学パターンを備えたスケール５５２ａとを備えている。
Similarly to the
図３では、リンク２０１に検出ヘッド５５２ｂ、リンク２０２にスケール５５２ａが配置されている。
In FIG. 3, a
リンク２０２が、モータ２１２により駆動されると、リンク２０１とリンク２０２との相対位置が変化する。
When link 202 is driven by
その際、スケール５５２ａに照射されている光の照射位置がスケール５５２ａに配置されている光学パターン上を移動する。
At this time, the irradiation position of the light irradiating the
このとき、スケール５５２ａに照射されている光がスケール５５２ａ上に設けられた光学パターンを通過すると、検出ヘッド５５２ｂの受光素子で検出される光の光量が変化する。この光量の変化から、リンク２０１とリンク２０２との相対移動量を検出する。
At this time, when the light irradiating the
ここで、リンク間の相対的な位置を計測する方法として、入力軸エンコーダ２７２によりモータの回転軸の位置を検出し、減速機２３２の減速比から計測する方法がある。
Here, as a method of measuring the relative position between the links, there is a method of detecting the position of the rotating shaft of the motor using the
しかしながら、減速機２３２の精度などの影響で入力軸エンコーダ２７２では、正確にリンク間の角度を計測することが困難である。
However, due to the accuracy of the
それに対して、上記のように出力軸エンコーダ５５２によってリンク間の相対的な位置を直接計測すると、減速機２３１などの誤差要因を取り除くことが可能になり、正確にリンク間の相対的な位置を検出することができる。
On the other hand, if the relative position between the links is directly measured by the
上述したモータ２１２、減速機２３２、トルクセンサ５６２の、リンク２０１、リンク２０２に対する配置は一つの例でありこれ以外の公知の構造を利用することも可能である。
The arrangement of the
次に制御装置４００の制御ブロックについて説明する。図３では、制御装置４００のＣＰＵ４０１と、ＲＯＭ４０２、外部入力装置５００を示している。
Next, the control blocks of the
まず、ＣＰＵ４０１は、プログラムを動作させることによって、比較器４４１、判定器４４２、目標値生成部４４３として機能する。ＲＡＭ４０３は、入力軸エンコーダ記憶器４３１、トルク記憶器４３２、出力軸エンコーダ記憶器４３３として機能する。
First, the
目標値生成部４４３は関節Ｊ２の位置制御やトルクセンサ５６２を用いた力制御を行うために、モータ２１２の目標値を生成する。目標値生成部４４３には外部入力装置５００が接続されており、作業者が外部入力装置５００により指令値を入力することで、それを達成するための目標値を生成する。
The target
サーボ制御器２３０は、目標値生成部４４３で生成された関節Ｊ２の目標値に合わせた制御値を、ロボットアーム本体２００内部に設けられたケーブルを介してモータ２１２に送信しモータ２１２を駆動させる。
The
入力軸エンコーダ記憶器４３１は、複数のタイミングにおける入力軸エンコーダ２７２で検出されるモータ２１２の回転軸の位置の値を、検出したタイミングに紐づけて記憶する。
The input shaft
トルク記憶器４３２は、複数のタイミングにおけるトルクセンサ５６２で検出されるトルクの値を検出したタイミングに紐づけて記憶している。
The
ここで、トルク記憶器４３２は、トルクセンサ５６２のフレーム５０１の剛性値も記憶しており、トルクセンサ５６２の光学式エンコーダ５０２から入力される相対変位の値に剛性値を掛け合わせ、トルク値として記憶するものとする。
Here, the
出力軸エンコーダ記憶器４３３は、複数のタイミングにおける出力軸エンコーダ５５２で検出される、リンク２０１とリンク２０２との相対的な位置の値を、検出したタイミングに紐づけて記憶する。
The output shaft
比較器４４１は、上記３種類の記憶器に記憶された過去の複数のタイミングにおける各値を、それぞれ比較し変化の有無を判定する。
The
判定器４４２は、比較器４４１で比較した結果をもとにトルクセンサ５６２およびまたは出力軸エンコーダ５５２の状態を判定する。
The
そして、判定した状態をモニタ４２１に出力する。
Then, the determined state is output to the
また判定器４４２は、入力軸エンコーダ２７２、出力軸エンコーダ５５２、トルクセンサ５６２によって検出した値を目標値生成部４４３に返している。
Further, the
これにより、目標値生成部４４３は各センサの検出値によるフィードバック制御を実行することができる。以下、トルクセンサ５６２およびまたは出力軸エンコーダ５５２の状態を判定する方法についてフローチャートを用いて詳述する。
Thereby, the target
図５は、トルクセンサ５６２およびまたは出力軸エンコーダ５５２の状態を判定するための制御方法を例示した制御フローチャートである。図５（ａ）は、トルクセンサ５６２およびまたは出力軸エンコーダ５５２の状態を判定する為の事前準備を示したフローチャートである。以下では、関節Ｊ２を例に取り説明を行うものとする。今回は関節Ｊ２を例に取り説明するが、必要に応じて他の関節において以下の制御フローが実施されるものとする。
FIG. 5 is a control flowchart illustrating a control method for determining the states of
まず図５（ａ）より、Ｓ１０１により所定のタイミングで、ロボットアーム本体２００を所定の姿勢に動作させる。
First, referring to FIG. 5A, the robot arm
ここで、所定の姿勢は、状態を判定したい関節に合わせて精度よく判定を行うことができる姿勢にすることが望ましい。 Here, it is desirable that the predetermined posture be a posture that allows accurate determination in accordance with the joint whose condition is to be determined.
例えば関節Ｊ２なら、関節Ｊ２を回転させ、リンク２０１からリンク２０６までが、ロボットアーム本体２００の設置面に対して水平に伸びるような姿勢とする。これにより関節Ｊ２に大きな自重トルクが印加される状態となり関節Ｊ２に搭載されたトルクセンサ５６２の不具合を発見しやすくなる。
For example, in the case of joint J 2 , joint J 2 is rotated so that
そしてＳ１０３で、Ｓ１０１で動作させた所定の姿勢の状態で、出力軸エンコーダ５５２からの検出値を取得し、出力軸エンコーダ記憶器４３３に格納する。
Then, in S103, the detection value from the
次にＳ１０４で、Ｓ１０１で動作させた所定の姿勢の状態で、トルクセンサ５６２からの検出値を取得し、トルク記憶器４３２に格納する。
Next, in S104, the detection value from the
以上により、トルクセンサ５６２およびまたは出力軸エンコーダ５５２の状態を判定する為の基準値を各記憶器に格納しておく。そして制御フローを終了し、事前準備を終了する。
As described above, reference values for determining the states of the
次に図５（ｂ）より、ロボット装置１００をある程度使用した上で、トルクセンサ５６２と出力軸エンコーダ５５２の状態を判定する制御を行う。
Next, referring to FIG. 5B, after using the
製品の生産ラインが止まっている状態で、Ｓ１０１により、作業者の指示によりロボットアーム本体２００を所定の姿勢に変更する。所定の姿勢は、図５（ａ）で説明した事前準備の際の制御と同じ姿勢である。
While the product production line is stopped, in S101, the
そして、再度、Ｓ１０３、Ｓ１０４の処理を行う。 Then, the processing in S103 and S104 is performed again.
以上により、出力軸エンコーダ５５２からの検出値と、トルクセンサ５６２からの検出値において、事前準備の段階と、検査を行う段階とのいう２つ以上のタイミングで検出し、記憶させた上でＳ１０５に進む。
As described above, the detected value from the
次にＳ１０５で、比較器４４１により、出力軸エンコーダ記憶器４３３に記憶された２つのタイミングにおける出力軸エンコーダ５５２の検出値を比較する。
Next, in S105, the
その差があらかじめ決められた閾値以下であれば、Ｓ１０６に進み、その差が閾値より大きい場合、Ｓ１０７に進む。 If the difference is less than or equal to a predetermined threshold, the process proceeds to S106, and if the difference is greater than the threshold, the process proceeds to S107.
Ｓ１０６、Ｓ１０７では、比較器４４１により、トルク記憶器４３２に記憶された２つのタイミングにおけるトルクセンサ５６２の検出値を比較する。
In S106 and S107, the
Ｓ１０５で出力軸エンコーダ５５２からの検出値の差が閾値以下であり、Ｓ１０６でトルクセンサ５６２からの検出値の差が閾値以下ならば、Ｓ１０８に進む。
If the difference between the detected values from the
Ｓ１０８では、判定器４４２によって、出力軸エンコーダ５５２、トルクセンサ５６２どちらも異常なしと判定され、Ｓ１０９に進む。
In S108, the
Ｓ１０９において、上記で説明した１つ目の検査の場合、モニタ４２１に異常なし、と表示させ、フローを終了する。
In S109, in the case of the first test described above, the
Ｓ１０５で出力軸エンコーダ５５２からの検出値の差が閾値以下であり、Ｓ１０６でトルクセンサ５６２からの検出値の差が閾値より大きければ、Ｓ１１０に進む。
If the difference between the detected values from the
Ｓ１１０に進むということは、出力軸エンコーダ５５２からの検出値の変化は無く、トルクセンサ５６２からの検出値に変化が生じたという事である。
Proceeding to S110 means that there is no change in the detected value from the
言い換えると、２つのタイミング間において、リンク２０１とリンク２０２との相対的な位置は変化していないので、ロボットアーム本体２００の姿勢は変化しておらず、トルクセンサ５６２の変形量も変化していないと考えられる。
In other words, since the relative position of
つまり、トルクセンサ５６２の弾性体となるフレーム５０１には、疲労による剛性の低下は生じていないと考えられる。
In other words, it is considered that the
それにもかかわらず、トルクセンサ５６２からの検出値に変化が生じたという事は、トルクセンサ５６２の弾性体となるフレーム５０１の変形量を測定する変位検出センサである光学式エンコーダ５０２に異常が発生したと判定される。
Nevertheless, a change in the detected value from the
変位検出センサのトラブルとして想定されることは、発光素子、受光素子の位置ズレ、熱による発光素子、受光素子の故障などが想定される。 Possible problems with the displacement detection sensor include misalignment of the light-emitting element and light-receiving element, failure of the light-emitting element and light-receiving element due to heat, and the like.
また本実施形態では、変位検出センサとしての光学式エンコーダ５０２を２個対向させて個配置しており、２つの光学式エンコーダ５０２の検出値を平均した値からトルクを算出している。
Further, in this embodiment, two
よって、トルク記憶器４３２において平均した値だけでなく、各光学式エンコーダ５０２の検出値を個別に記憶しておくことで、どの光学式エンコーダ５０２にトラブルが生じたのかを判別することも可能である。
Therefore, by individually storing the detected values of each
Ｓ１１０の場合はＳ１１１に進み、モニタ４２１に、トルクセンサ５６２の変位検出センサに異常あり、と表示する。
In the case of S110, the process advances to S111 and displays on the
変位検出センサに異常が発生した場合の対応は２つあり、１つ目はトルクセンサ５６２をロボットアーム本体２００から取り外し修理を行う対応がある。
There are two possible responses when an abnormality occurs in the displacement detection sensor. The first is to remove the
２つ目はトルクセンサ５６２に２個配置されている光学式エンコーダ５０２から、異常が生じている光学式エンコーダ５０２の検出値を除外してトルクを求めることで、現状のままトルクセンサ５６２の修理をせずに製造を再開するという対応がある。
The second method is to obtain the torque from the two
以上により、トルクセンサ５６２における変位検出センサに異常が発生した場合の効果的な対応をロボット装置１００により作業者に促すことができる。
As described above, the
Ｓ１０５で出力軸エンコーダ５５２からの検出値の差が閾値よりも大きく、Ｓ１０７でトルクセンサ５６２からの検出値の差が閾値以下であれば、Ｓ１１２に進む。
If the difference between the detected values from the
Ｓ１１２に進むということは、出力軸エンコーダ５５２からの検出値に変化が生じ、トルクセンサ５６２からの検出値には変化が生じていないという事である。
Proceeding to S112 means that the detected value from the
言い換えると、２つのタイミング間において、リンク２０１とリンク２０２との相対的な位置は変化しているため、ロボットアーム本体２００の姿勢が変化していると考えられるが、トルクセンサ５６２の変形量に変化が生じていないという事である。
In other words, since the relative position of the
ロボットアーム本体２００の姿勢が変化すると、自重による関節への負荷が変化していると予測されるが、トルクセンサ５６２からの検出値が変化していないことから、ロボットアーム本体２００の姿勢はやはり変化していないと考えらえる。
If the posture of the
それにもかかわらず、出力軸エンコーダ５５２からの検出値が変化したという事は、出力軸エンコーダ５６２に異常が発生したと判定できる。
Nevertheless, the fact that the detected value from the
出力軸エンコーダ５６２の異常のさらなる確認方法として、入力軸エンコーダ記憶器４３１と出力軸エンコーダ記憶器４３３との検出値を比較して、減速機２３１の減速比と同じ関係になっているかどうかで確認する方法もある。
As a further method of confirming the abnormality of the
Ｓ１１２の場合はＳ１１３に進み、モニタ４２１に、出力軸エンコーダ５５２に異常あり、と表示する。
In the case of S112, the process advances to S113 and displays on the
この場合、出力軸エンコーダ５５２の修理が必要であり、出力軸エンコーダ５５２をロボットアーム本体２００から取り外す必要がある。そして、出力軸エンコーダ５５２に修理を施すか、新しい出力軸エンコーダ５５２をロボットアーム本体２００に取り付ける。
In this case, it is necessary to repair the
以上により、出力軸エンコーダ５５２に異常が発生した場合の効果的な対応をロボット装置１００により作業者に促すことができる。
As described above, the
Ｓ１０５で出力軸エンコーダ５５２からの検出値の差が閾値よりも大きく、Ｓ１０７でトルクセンサ５６２からの検出値の差も閾値より大きければ、Ｓ１１４に進む。
If the difference between the detected values from the
Ｓ１１４に進むという事は、出力軸エンコーダ５５２からの検出値とトルクセンサ５６２からの検出値の両方に変化が生じたという事である。
Proceeding to S114 means that both the detected value from the
言い換えると、２つのタイミング間において、リンク２０１とリンク２０２との相対的な位置は変化しているため、ロボットアーム本体２００の姿勢が変化し、トルクセンサ５６２の変形量にも変化が生じているという事である。
In other words, since the relative position between the
一般的に出力軸エンコーダ５５２と、トルクセンサ５６２とに同時に異常が発生するという事は考えづらい。
Generally, it is difficult to imagine that an abnormality occurs in the
上記のような事が起こる場合は、トルクセンサ５６２の弾性体となるフレーム５０１の剛性が疲労によって低下し、それによって、フレーム５０１の変形量が大きくなる場合が考えられる。
If the above occurs, the rigidity of the
これにより、トルクセンサ５６２の検出値が変化すると共に、リンク間の相対的な位置も変化し、出力軸エンコーダ５５２の検出値の変化が生じたと判定できる。
As a result, the detected value of the
Ｓ１１４の場合はＳ１１５に進み、モニタ４２１に、トルクセンサ５６２の剛性値が変化、と表示し、フローを終了する。
In the case of S114, the process advances to S115, displays on the
この際、トルクセンサ５６２をロボットアーム本体２００から取り外し、トルクセンサ５６２に修理を施すか、新しいトルクセンサ５６２をロボットアーム本体２００に取り付ける対応を行う。
At this time, the
この対応は、このまま継続して使うとフレーム５０１が破断し大きなトラブルにつながると判断した場合に行う。
This measure is taken when it is determined that if the
以上、本実施形態によれば、出力軸エンコーダとトルクセンサとの２つの検出装置を用いて、各検出装置の問題発生の判定を行っているので、問題発生の状況を場合分けすることができ、各検出値のどの部分で問題が発生しているのか特定することができる。 As described above, according to this embodiment, two detection devices, the output shaft encoder and the torque sensor, are used to determine whether a problem has occurred in each detection device, so it is possible to differentiate the situation in which a problem occurs. , it is possible to identify which part of each detected value is causing the problem.
よって各検出装置の問題の発生場所により異なる対応を、効果的に作業者に行わせることができる。 Therefore, it is possible to effectively have the operator take different measures depending on the location where the problem occurs in each detection device.
また、ロボット装置を静止させて安定した状態で時間をかけて検査をすることができるので精度の高い検査が可能になり故障の初期段階から発見することができる。 In addition, since the robot device can be held still and the robot device can be inspected in a stable state over time, highly accurate inspections can be performed and failures can be detected at an early stage.
さらに近年、３Ｄプリンタなどで従来の切削加工では実現できない形状で高機能な弾性体を製作することが提案されている。しかしながら、３Ｄプリンタで造形された弾性体の内部には空孔が形成される可能性があり、ロボット装置の動作により繰り返して荷重を受けると、空孔が起点となって弾性体の剛性の低下などの問題が生じる可能性が高まる。 Furthermore, in recent years, it has been proposed to use 3D printers and the like to produce highly functional elastic bodies with shapes that cannot be realized using conventional cutting processes. However, there is a possibility that holes may be formed inside an elastic body modeled with a 3D printer, and if the load is repeatedly applied due to the operation of a robot device, the holes will become a starting point and the rigidity of the elastic body will decrease. There is an increased possibility that such problems will occur.
しかしながら、本実施形態により、上記のように弾性体の剛性の低下などの問題が生じる可能性が高い検出装置の場合でも、問題が生じた箇所に応じて適切な対応を行い、早期に製品の生産を再開することができる。 However, according to this embodiment, even in the case of a detection device that is likely to have problems such as a decrease in the rigidity of the elastic body as described above, appropriate measures can be taken depending on the location where the problem has occurred, and the product can be improved at an early stage. Production can be resumed.
（変形例１）
図６は、本実施形態の変形例を表した制御フローチャートである。第１の実施形態ではロボット装置の日常点検などのタイミングで実施する検査で、製品の生産ラインが止まっている状態で作業者の指示によって開始される場合について説明した。
(Modification 1)
FIG. 6 is a control flowchart showing a modification of this embodiment. In the first embodiment, a case has been described in which an inspection is performed at a timing such as a daily inspection of a robot device, and is started by an operator's instruction while the product production line is stopped.
それに対し本変形例では製品の生産ラインを止めずにロボット装置の一連の動きの最中に任意のタイミングで検査を行う。 In contrast, in this modification, the inspection is performed at any timing during a series of movements of the robot device without stopping the product production line.
図６より、第１の実施形態と本変形例で異なる点は、図５（ｂ）のフローチャートにおいて、Ｓ１０１に代わりＳ１０２のステップが設定されている点である。なお、図６で示したフローチャートは、図５（ａ）で説明した事前準備を終えた段階で開始される。 From FIG. 6, the difference between the first embodiment and this modification is that in the flowchart of FIG. 5(b), step S102 is set instead of S101. Note that the flowchart shown in FIG. 6 is started when the advance preparation described in FIG. 5(a) is completed.
Ｓ１０２では、ロボット装置１００が製造工程を実行している最中に任意のタイミングで、事前準備のＳ１０１で設定した所定の姿勢をロボットアーム本体２００に取らせる。
In S102, the robot arm
Ｓ１０２以降の処理は、第１の実施形態と同様であり、トルクセンサ５６２と出力軸エンコーダ５５２の状態を判定する。
The processing after S102 is the same as that in the first embodiment, and the states of the
また、製造を行っている最中に検査を行っているため、図５（ｂ）で説明した、Ｓ１０９、Ｓ１１１、Ｓ１１３、Ｓ１１５の内容が異なっている。 Furthermore, since the inspection is performed during manufacturing, the contents of S109, S111, S113, and S115 explained with reference to FIG. 5(b) are different.
図６のＳ１０９では、各検出装置の異常は発生していないと判断し、モニタ４２１に異常なし、と表示し、ロボット装置１００による製品の製造を続行させ、フローを終了する。
In S109 of FIG. 6, it is determined that no abnormality has occurred in each of the detection devices, and the
図６のＳ１１１では、光学式エンコーダ５０２に異常があると判断し、モニタ４５１に変位検出センサに異常あり、と表示した上でロボット装置１００による製造を停止し、フローを終了する。
In S111 of FIG. 6, it is determined that there is an abnormality in the
その後の対応については、第１の実施形態と同様である。 The subsequent actions are the same as in the first embodiment.
図６のＳ１１３では、出力軸エンコーダ５５２に異常があると判断し、モニタ４２１に出力軸エンコーダ５５２に異常あり、と表示した上でロボット装置１００による製造を停止し、フローを終了する。
In S113 of FIG. 6, it is determined that there is an abnormality in the
その後の対応については、第１の実施形態と同様である。 The subsequent actions are the same as in the first embodiment.
図６のＳ１１５では、トルクセンサ５６２のフレーム５０１の剛性値が変化したと判断、モニタ４２１に剛性値の変化を表示した上で、トルク記憶器４３２に記憶している剛性値を設定し直し、ロボット装置１００による製造を続行する。
In S115 of FIG. 6, it is determined that the stiffness value of the
その際、トルクセンサ５６２の弾性体であるフレーム５０１の剛性の設定値を変更してトルク記憶器４３２に記憶させる。
At this time, the set value of the rigidity of the
剛性値を再取得する方法は、ロボットアーム本体２００を所定の姿勢にして関節Ｊ２に任意のトルクを負荷し、そのときのトルクセンサ５６２の値から設定値（剛性：Ｎｍ／ｒａｄ）を変更する方法がある。
The method of reacquiring the stiffness value is to place the
以上より、本変形例の検査タイミングであれば製品の生産ラインを止めずに検査することが可能なので、生産ラインの生産性を落とさずに検査することができる。 As described above, at the inspection timing of this modification, it is possible to inspect the product without stopping the production line, so the inspection can be carried out without reducing the productivity of the production line.
（第２の実施形態）
上記第１の実施形態では、トルクセンサ５６２と出力軸エンコーダ５５２からの検出値を用いて、トルクセンサ５６２と出力軸エンコーダ５５２の状態を判定する方法を示した。
(Second embodiment)
In the first embodiment described above, a method of determining the states of the
しかしながら、一般的には考えづらいとはいえ、ロボットアーム本体２００の予期せぬ動作により、周辺の装置とロボットアーム本体２００とが衝突すると、リンクに直接つながっているトルクセンサ５６２と出力軸エンコーダ５５２とが故障する可能性がある。
However, although it is generally difficult to imagine, if the
この場合、トルクセンサ５６２と出力軸エンコーダ５５２とからの検出値がどちらも信用できなくなるため、第１の実施形態で述べた方法では、トルクセンサ５６２と出力軸エンコーダ５５２の状態を正しく判定することが困難となる。
In this case, the detected values from the
本実施形態では、トルクセンサ５６２と出力軸エンコーダ５５２の両方が故障した場合でも、トルクセンサ５６２と出力軸エンコーダ５５２の状態を正しく判定する方法について説明する。
In this embodiment, a method for correctly determining the states of the
以下では、第１の実施形態とは異なるハードウェアや制御系の構成の部分について図示し説明する。また、第１の実施形態と同様の部分については上記と同様の構成ならびに作用が可能であるものとし、その詳細な説明は省略するものとする。 Below, parts of the hardware and control system configuration that are different from those in the first embodiment will be illustrated and explained. Furthermore, it is assumed that the same configuration and operation as described above are possible for the same parts as in the first embodiment, and detailed explanation thereof will be omitted.
ロボットアーム本体２００が周辺機器と衝突すると、ロボットアーム本体２００の各リンクに大きくダメージがかかるが、減速機２３２及びモータ２１２を介してリンク２０１に設けられている入力軸エンコーダ２７２は故障する可能性が低い。
If the
よって、入力軸エンコーダ２７２の検出値から、トルクセンサ５６２と出力軸エンコーダ５５２の状態を判定することができる。
Therefore, the states of the
具体的には、入力軸エンコーダ２７２からの検出値と減速機２３１の減速比から想定されるリンク２０２とリンク２０１との相対的な位置と、出力軸エンコーダ５５２の値を比較することで出力軸エンコーダ５５２の状態が判定できる。
Specifically, by comparing the relative positions of the
また、入力軸エンコーダ２７２の検出値から推定されるロボットアーム本体２００の姿勢とそのときに生じる自重トルクの推定値と、トルクセンサ５６２からの検出値を比較することでトルクセンサ５６２の状態が判定できる。
Additionally, the state of the
以上、本実施形態では、トルクセンサ５６２と出力軸エンコーダ５５２の他に、入力軸エンコーダ２７２も用い、３つのセンサにより状態を判定している。よってトルクセンサ５６２と出力軸エンコーダ５５２の両方に異常が発生した可能性が高い場合でも、入力軸エンコーダ２７２によって、トルクセンサ５６２と出力軸エンコーダ５５２の状態を判定することができる。
As described above, in this embodiment, in addition to the
上述した種々の実施形態の処理手順は具体的には制御装置４００により実行されるものとして説明したが、上述した機能を実行可能なソフトウェアの制御プログラムおよびそのプログラムを記録した記録媒体を外部入力装置５００に搭載させて実施しても良い。
Although the processing procedures of the various embodiments described above have been specifically described as being executed by the
従って上述した機能を実行可能なソフトウェアの制御プログラムおよびそのプログラムを記録した記録媒体は本発明を構成することになる。 Therefore, a software control program capable of executing the above-mentioned functions and a recording medium on which the program is recorded constitute the present invention.
また、上記実施形態では、コンピュータで読み取り可能な記録媒体がＲＯＭ或いはＲＡＭであり、ＲＯＭ或いはＲＡＭに制御プログラムが格納される場合について説明したが、本発明はこのような形態に限定されるものではない。 Furthermore, in the above embodiments, the computer-readable recording medium is ROM or RAM, and the control program is stored in the ROM or RAM, but the present invention is not limited to such a form. do not have.
本発明を実施するための制御プログラムは、コンピュータ読み取り可能な記録媒体であれば、いかなる記録媒体に記録されていてもよい。例えば、制御プログラムを供給するための記録媒体としては、ＨＤＤ、外部記憶装置、記録ディスク等を用いてもよい。 The control program for implementing the present invention may be recorded on any computer-readable recording medium. For example, as a recording medium for supplying the control program, an HDD, an external storage device, a recording disk, etc. may be used.
（その他の実施形態）
上述した第１の実施形態では、出力軸エンコーダ５５２とトルクセンサ５６２の状態をロボット装置１００に設けられた制御装置４００により判定しているがこれに限られない。
(Other embodiments)
In the first embodiment described above, the states of the
例えば、出力軸エンコーダ５５２とトルクセンサ５６２とを一体にした検出装置に、図５で述べた制御フローを実行できる制御基板を備え１つのユニットとして、第１の実施形態を実施しても良い。
For example, the first embodiment may be implemented by combining a detection device that integrates the
また、上述した第１の実施形態、第２の実施形態では、出力軸エンコーダ５５２の検出値の比較、トルクセンサ５６２の検出値の比較を、どちらも検出した値同士で比較したがこれに限られない。
Further, in the first embodiment and the second embodiment described above, the detected values of the
例えば、比較器４４１に予め、出力軸エンコーダ５５２とトルクセンサ５６２の正常な状態の判定に用いるそれぞれの基準データを格納しておき、その基準データと、検出した値とを比較し、その差が閾値を超えたかどうかで状態を判定しても良い。
For example, the
また上述した第１の実施形態、第２の実施形態では、第１の固定部材５０４と第２の固定部材５０５との相対移動量を検出するために光学式のエンコーダを用いたが別の形態を取っても良い。
Further, in the first embodiment and the second embodiment described above, an optical encoder is used to detect the relative movement amount between the first fixing
例えば磁気的に変位を計測する方法に関して、第１の固定部材５０４と第２の固定部材５０５のどちらかに磁束発生源、磁電変換素子を配置して検出しても良い。第１の固定部材５０４と第２の固定部材５０５が相対移動することで、磁束発生源と磁電変換素子との距離の変化に伴い、磁電変換素子へ流入する磁束密度の大きさに変化が生じ、磁束密度の変化にともなう磁電変換素子の出力が変化する。この磁電変換素子の出力の変化を検出することで変位を計測することができる。
For example, regarding a method of magnetically measuring displacement, a magnetic flux generation source or a magnetoelectric transducer may be placed on either the first fixing
また、上述した第１の実施形態、第２の実施形態では、出力軸エンコーダ５５２と、トルクセンサ５６２とは、別々の構成で説明したが、所定の部品にそれぞれ設けられ、一体のコンポーネントとして構成してもよい。これにより、一体のコンポーネントとして、出力軸エンコーダ５５２と、トルクセンサ５６２とを構成した場合でも、容易にどの箇所に問題が生じているのか判定することができ、適切な処置を行うことができる。
Further, in the first embodiment and the second embodiment described above, the
上述した第１の実施形態、第２の実施形態では、ロボット装置１００が複数の関節を有する多関節ロボットアームを用いた場合を説明したが、関節の数はこれに限定されるものではない。ロボット装置の形式として、垂直多軸構成を示したが、パラレルリンク型など異なる形式の関節においても上記と同等の構成を実施することができる。
In the first and second embodiments described above, a case has been described in which the
また、ロボット装置１００が単軸の場合、関節は１つであるため、関節に設ける力検出手段として、トルクを検出するトルクセンサではなく、荷重を検出する力覚センサを使用する場合がある。この場合でも上記第１の実施形態、第２の実施形態を実施することができる。
Further, when the
また、ロボット装置１００の構成例を各実施形態の例図により示したが、これに限定されるものではなく、当業者において任意に設計変更が可能である。また、ロボット装置１００に設けられる各モータは、上述の構成に限定されるものではなく、各関節を駆動する駆動源は例えば人工筋肉のようなデバイス等であってもよい。
Further, although the configuration example of the
また上述した第１の実施形態、第２の実施形態は、制御装置に設けられる記憶装置の情報に基づき、伸縮、屈伸、上下移動、左右移動もしくは旋回の動作またはこれらの複合動作を自動的に行うことができる機械に適用可能である。 Furthermore, the first and second embodiments described above automatically perform stretching, bending, stretching, vertical movement, left/right movement, or turning operations, or a combination of these operations, based on information in a storage device provided in the control device. Applicable to machines that can perform
１００ ロボット装置
２００ ロボットアーム本体
２０１～２０６ リンク
２１０ 基台
２１１～２１６ モータ
２２１～２２６ センサ部
２３０、３５０ サーボ制御部
２３１～２３６ 減速機
２７２ 入力軸エンコーダ
３００ ロボットハンド本体
４００ 制御装置
４３１ 入力軸エンコーダ記憶器
４３２ トルク記憶器
４３３ 出力軸エンコーダ記憶器
４２１ モニタ
４４１ 比較器
４４２ 判定器
４４３ 目標値生成部
５００ 外部入力蔵置
５０１ フレーム
５０２ 光学式エンコーダ
５０４ 第１の固定部材
５０５ 第２の固定部材
５０６ 連結部材
５０８、５５２ａ スケール
５０９、５５２ｂ 検出ヘッド
５７１ 発光素子
５７２ 受光素子
100
Claims (30)
前記ロボット本体を制御する制御装置と、を備えたロボットシステムであって、
前記第１リンクに対して相対的に変位した前記第２リンクの位置の値に関する情報を出力する第１位置検出手段と、
前記第１リンクと前記第２リンクとの間の力の値に関する情報を出力する力検出手段と、を備え、
前記制御装置は、
前記第１位置検出手段に基づき取得された前記位置の値に関する情報と、前記位置の値に関する情報に対応する第１閾値と、前記力検出手段に基づき取得された前記力の値に関する情報と、前記力の値に関する情報に対応する第２閾値とに基づき、前記力検出手段が有する少なくとも２つの部品の少なくとも１つの状態を取得する、
ことを特徴とするロボットシステム。 a robot body including a first link and a second link that is displaced relative to the first link;
A robot system comprising: a control device for controlling the robot body;
a first position detection means that outputs information regarding a position value of the second link that is displaced relative to the first link;
Force detection means for outputting information regarding the value of force between the first link and the second link,
The control device includes:
Information regarding the value of the position acquired based on the first position detection means, a first threshold value corresponding to the information regarding the value of the position, and information regarding the value of the force acquired based on the force detection means, acquiring a state of at least one of at least two parts included in the force detection means based on a second threshold value corresponding to information regarding the force value ;
A robot system characterized by:
前記制御装置は、
前記位置の値に関する情報と前記第１閾値と前記力の値に関する情報と前記第２閾値とに基づき、前記第１位置検出手段における異常の発生および前記部品の少なくとも１つにおける異常の発生を特定する、
ことを特徴とするロボットシステム。 The robot system according to claim 1,
The control device includes:
Occurrence of an abnormality in the first position detection means and occurrence of an abnormality in at least one of the parts based on information regarding the position value, the first threshold value, information regarding the force value, and the second threshold value. identify ,
A robot system characterized by:
前記制御装置は
前記ロボット本体を所定姿勢に位置させ、第１タイミングにおいて、前記第１位置検出手段に基づき前記位置の値に関する情報を取得すると共に、前記力検出手段に基づき前記力の値に関する情報を取得し、
前記第１タイミングとは異なる第２タイミングにおいて、前記ロボット本体を前記所定姿勢に位置させ、前記第１位置検出手段に基づき前記位置の値に関する情報を取得すると共に、前記力検出手段により前記力の値に関する情報を取得し、
前記第１タイミングにおける前記位置の値に関する情報と、前記第２タイミングにおける前記位置の値に関する情報とを比較すると共に、前記第１タイミングにおける前記力の値に関する情報と、前記第２タイミングにおける前記力の値に関する情報とを比較し、前記第１位置検出手段の状態、及び前記部品の少なくとも１つの状態を取得する、
ことを特徴とするロボットシステム。 The robot system according to claim 1 or 2,
The control device positions the robot body in a predetermined posture, and at a first timing, acquires information regarding the value of the position based on the first position detection means, and acquires information regarding the value of the force based on the force detection means. get
At a second timing different from the first timing, the robot body is positioned in the predetermined posture, information regarding the position value is acquired based on the first position detection means, and information about the force is detected by the force detection means. Get information about the value,
Information regarding the value of the position at the first timing and information regarding the value of the position at the second timing are compared, and information regarding the value of the force at the first timing and information regarding the force at the second timing are compared. and information regarding the value of the first position detecting means to obtain the state of the first position detecting means and the state of at least one of the parts.
A robot system characterized by:
前記ロボット本体は、
前記第２リンクを前記第１リンクに対して相対的に変位させる駆動源と、
前記駆動源の回転軸の位置に関する情報を出力する第２位置検出手段と、を備え、
前記制御装置は、
前記第２位置検出手段に基づき取得される前記回転軸の位置の値に関する情報に基づき前記ロボット本体を前記所定姿勢に位置させる、
ことを特徴とするロボットシステム。 The robot system according to claim 3,
The robot body is
a drive source that displaces the second link relative to the first link;
a second position detection means for outputting information regarding the position of the rotation axis of the drive source,
The control device includes:
positioning the robot body in the predetermined posture based on information regarding the position value of the rotation axis acquired based on the second position detection means;
A robot system characterized by:
前記部品は、弾性体と、前記弾性体の変位を検出する変位検出センサの少なくとも２つであり、
前記制御装置は、
前記第１タイミングにおける前記位置の値に関する情報と、前記第２タイミングにおける前記位置の値に関する情報との差が、前記第１閾値以下であり、
前記第１タイミングにおける前記力の値に関する情報と、前記第２タイミングにおける前記力の値に関する情報との差が、前記第２閾値より大きい場合、
前記変位検出センサに異常が発生していると特定する、
ことを特徴とするロボットシステム。 The robot system according to claim 3 or 4,
The parts are at least two of an elastic body and a displacement detection sensor that detects displacement of the elastic body,
The control device includes:
a difference between information regarding the value of the position at the first timing and information regarding the value of the position at the second timing is equal to or less than the first threshold;
If the difference between the information regarding the force value at the first timing and the information regarding the force value at the second timing is greater than the second threshold,
identifying that an abnormality has occurred in the displacement detection sensor;
A robot system characterized by:
前記変位検出センサの異常は、前記変位検出センサの配置が変化している状態である、
ことを特徴とするロボットシステム。 The robot system according to claim 5,
The abnormality of the displacement detection sensor is a state in which the arrangement of the displacement detection sensor is changed;
A robot system characterized by:
前記変位検出センサは複数設けられており、
前記制御装置は、
前記変位検出センサのうち異常と判定された変位検出センサを除外して前記力の値に関する情報を取得する、
ことを特徴とするロボットシステム。 The robot system according to claim 5 or 6,
A plurality of displacement detection sensors are provided,
The control device includes:
obtaining information regarding the force value by excluding a displacement detection sensor determined to be abnormal among the displacement detection sensors;
A robot system characterized by:
前記制御装置は、
前記第１タイミングにおける前記位置の値に関する情報と、前記第２タイミングにおける前記位置の値に関する情報との差が、前記第１閾値より大きく、
前記第１タイミングにおける前記力の値に関する情報と、前記第２タイミングにおける前記力の値に関する情報との差が、前記第２閾値より大きい場合、
前記弾性体に異常が発生していると判定する、
ことを特徴とするロボットシステム。 The robot system according to any one of claims 5 to 6,
The control device includes:
a difference between information regarding the value of the position at the first timing and information regarding the value of the position at the second timing is greater than the first threshold;
If the difference between the information regarding the force value at the first timing and the information regarding the force value at the second timing is greater than the second threshold,
determining that an abnormality has occurred in the elastic body;
A robot system characterized by:
前記弾性体の異常は、前記弾性体の剛性が変化している状態である、
ことを特徴とするロボットシステム。 The robot system according to claim 8,
The abnormality in the elastic body is a state in which the rigidity of the elastic body is changing,
A robot system characterized by:
前記制御装置は、
前記弾性体の剛性が変化していると判定された場合、前記力検出手段を用いて前記力の値に関する情報を取得する際に使用する剛性の値に関する情報を変更する、
ことを特徴とするロボットシステム。 The robot system according to claim 9,
The control device includes:
If it is determined that the stiffness of the elastic body has changed, changing information about the stiffness value used when acquiring information about the force value using the force detection means;
A robot system characterized by:
前記制御装置は、
前記第１タイミングにおける前記位置の値に関する情報と、前記第２タイミングにおける前記位置の値に関する情報との差が、前記第１閾値より大きく、
前記第１タイミングにおける前記力の値に関する情報と、前記第２タイミングにおける前記力の値に関する情報との差が、前記第２閾値以下である場合、
前記第１位置検出手段に異常が発生していると判定する、
ことを特徴とするロボットシステム。 The robot system according to any one of claims 3 to 10,
The control device includes:
a difference between information regarding the value of the position at the first timing and information regarding the value of the position at the second timing is greater than the first threshold;
If the difference between the information regarding the force value at the first timing and the information regarding the force value at the second timing is equal to or less than the second threshold,
determining that an abnormality has occurred in the first position detection means;
A robot system characterized by:
前記第１位置検出手段の異常は、前記第１位置検出手段に修理が必要、または前記第１位置検出手段の交換が必要、となる状態である、
ことを特徴とするロボットシステム。 The robot system according to claim 11,
The abnormality of the first position detecting means is a state in which the first position detecting means requires repair or replacement of the first position detecting means.
A robot system characterized by:
前記制御装置は、
前記第１タイミングにおける前記位置の値に関する情報と、前記第２タイミングにおける前記位置の値に関する情報との差が、前記第１閾値以下であり、
前記第１タイミングにおける前記力の値に関する情報と、前記第２タイミングにおける前記力の値に関する情報との差が、前記第２閾値以下である場合、
前記第１位置検出手段と、前記力検出手段と、には異常が発生していないと判定する、
ことを特徴とするロボットシステム。 The robot system according to any one of claims 3 to 12,
The control device includes:
a difference between information regarding the value of the position at the first timing and information regarding the value of the position at the second timing is equal to or less than the first threshold;
If the difference between the information regarding the force value at the first timing and the information regarding the force value at the second timing is equal to or less than the second threshold,
determining that no abnormality has occurred in the first position detection means and the force detection means;
A robot system characterized by:
前記制御装置は、
前記第１タイミングにおける前記位置の値に関する情報と、前記第２タイミングにおける前記位置の値に関する情報との差が、前記第１閾値より大きく、
前記第１タイミングにおける前記力の値に関する情報と、前記第２タイミングにおける前記力の値に関する情報との差が、前記第２閾値より大きい場合、
前記回転軸の位置の値に関する情報に基づいて取得される前記位置の値に関する情報と、前記第２タイミングにおける前記位置の値に関する情報とを比較すると共に、前記回転軸の位置の値に関する情報に基づいて取得される前記力の値に関する情報と、前記第２タイミングにおける前記力の値に関する情報とを比較することで前記第１位置検出手段の状態、及びまたは前記部品の少なくとも１つ状態を取得する、
ことを特徴とするロボットシステム。 The robot system according to claim 4,
The control device includes:
a difference between information regarding the value of the position at the first timing and information regarding the value of the position at the second timing is greater than the first threshold;
If the difference between the information regarding the force value at the first timing and the information regarding the force value at the second timing is greater than the second threshold,
Comparing the information regarding the position value obtained based on the information regarding the position value of the rotation axis with the information regarding the position value at the second timing, and comparing the information regarding the position value of the rotation axis with the information regarding the position value at the second timing. The state of the first position detection means and/or the state of at least one of the parts is obtained by comparing information regarding the value of the force acquired based on the second timing with information regarding the value of the force at the second timing. do,
A robot system characterized by:
前記制御装置は、
前記回転軸の位置の値に関する情報に基づいて取得される前記位置の値に関する情報と、前記第２タイミングにおける前記位置の値に関する情報との差が、前記第１閾値より大きく、
前記回転軸の位置の値に関する情報に基づいて取得される前記力の値に関する情報と、前記第２タイミングにおける前記力の値に関する情報との差が、前記第２閾値以下の場合、
前記第１位置検出手段に異常が発生していると判定する、
ことを特徴とするロボットシステム。 The robot system according to claim 14,
The control device includes:
The difference between the information regarding the position value acquired based on the information regarding the position value of the rotation axis and the information regarding the position value at the second timing is larger than the first threshold value,
If the difference between the information regarding the force value acquired based on the information regarding the position value of the rotation axis and the information regarding the force value at the second timing is equal to or less than the second threshold value,
determining that an abnormality has occurred in the first position detection means;
A robot system characterized by:
前記制御装置は、
前記回転軸の位置の値に関する情報に基づいて取得される前記位置の値に関する情報と、前記第２タイミングにおける前記位置の値に関する情報との差が、前記第１閾値以下であり、
前記回転軸の位置の値に関する情報に基づいて取得される前記力の値に関する情報と、前記第２タイミングにおける前記力の値に関する情報との差が、前記第２閾値よりも大きい場合、
前記力検出手段に異常が発生していると判定する、
ことを特徴とするロボットシステム。 The robot system according to claim 14 or 15,
The control device includes:
a difference between information regarding the position value acquired based on information regarding the position value of the rotation axis and information regarding the position value at the second timing is equal to or less than the first threshold;
If the difference between the information regarding the force value acquired based on the information regarding the position value of the rotating shaft and the information regarding the force value at the second timing is larger than the second threshold value,
determining that an abnormality has occurred in the force detection means;
A robot system characterized by:
前記制御装置は、
取得した前記部品の少なくとも１つの状態を表示装置に表示する、
ことを特徴とするロボットシステム。 The robot system according to any one of claims 1 to 16,
The control device includes:
displaying the obtained state of at least one of the parts on a display device;
A robot system characterized by:
前記第２タイミングは、前記ロボットシステムにより製品の製造を行っている最中のタイミングである、
ことを特徴とするロボットシステム。 The robot system according to any one of claims 3 to 16,
The second timing is a timing when the robot system is manufacturing the product.
A robot system characterized by:
前記第１閾値および前記第２閾値は、基準データであり、
前記制御装置は、
前記第１位置検出手段に基づき取得された前記位置の値に関する情報と前記第１閾値とを比較し、前記力検出手段に基づき取得された前記力の値に関する情報と第２閾値とを比較することで、前記部品の少なくとも１つの状態を取得する、
ことを特徴とするロボットシステム。 The robot system according to claim 1 or 2 ,
The first threshold value and the second threshold value are reference data ,
The control device includes:
Comparing information regarding the value of the position acquired based on the first position detection means with the first threshold value, and comparing information regarding the value of the force acquired based on the force detection means with a second threshold value. obtaining the state of at least one of the parts;
A robot system characterized by:
前記第１位置検出手段は、前記第１リンクと前記第２リンクとの間の相対的な位置に関する情報を直接検出する、
ことを特徴とするロボットシステム。 The robot system according to any one of claims 1 to 19,
The first position detection means directly detects information regarding the relative position between the first link and the second link.
A robot system characterized by:
前記第１位置検出手段は光学式エンコーダであり、前記力検出手段はトルクセンサである、
ことを特徴とするロボットシステム。 The robot device according to any one of claims 1 to 20,
The first position detection means is an optical encoder, and the force detection means is a torque sensor.
A robot system characterized by:
前記第１位置検出手段と、前記力検出手段とは、一体となっている、
ことを特徴とするロボットシステム。 The robot system according to any one of claims 1 to 21,
The first position detection means and the force detection means are integrated,
A robot system characterized by:
前記ロボット本体を制御する制御装置と、
前記第１リンクに対して相対的に変位した前記第２リンクの位置の値に関する情報を出力する第１位置検出手段と、
前記第１リンクと前記第２リンクとの間の力の値に関する情報を出力する力検出手段と、を備えたロボットシステムの制御方法であって、
前記制御装置は、
前記第１位置検出手段に基づき取得された前記位置の値に関する情報と、前記位置の値に関する情報に対応する第１閾値と、前記力検出手段に基づき取得された前記力の値に関する情報、前記力の値に関する情報に対応する第２閾値とに基づき、前記力検出手段が有する少なくとも２つの部品の少なくとも１つの状態を取得する、
ことを特徴とする制御方法。 a robot body including a first link and a second link that is displaced relative to the first link;
a control device that controls the robot body;
a first position detection means that outputs information regarding a position value of the second link that is displaced relative to the first link;
A method for controlling a robot system, comprising: force detection means for outputting information regarding a force value between the first link and the second link,
The control device includes:
information regarding the position value acquired based on the first position detection means; a first threshold value corresponding to the information regarding the position value; information regarding the force value acquired based on the force detection means; acquiring the state of at least one of the at least two parts included in the force detection means based on a second threshold value corresponding to information regarding the force value ;
A control method characterized by:
前記第１リンクに対して相対的に変位した前記第２リンクの位置の値に関する情報を出力する第１位置検出手段と、
前記第１リンクと前記第２リンクとの間の力の値に関する情報を出力する力検出手段と、を備え、
処理部が、
前記第１位置検出手段に基づき取得された前記位置の値に関する情報と、前記位置の値に関する情報に対応する第１閾値と、前記力検出手段に基づき取得された前記力の値に関する情報、前記力の値に関する情報に対応する第２閾値とに基づき、前記力検出手段が有する少なくとも２つの部品の少なくとも１つの状態を取得する、
ことを特徴とする検出装置。 A detection device provided on a robot body, comprising a first link and a second link that is displaced relative to the first link,
a first position detection means that outputs information regarding a position value of the second link that is displaced relative to the first link;
Force detection means for outputting information regarding the value of force between the first link and the second link,
The processing section
information regarding the position value acquired based on the first position detection means; a first threshold value corresponding to the information regarding the position value; information regarding the force value acquired based on the force detection means; acquiring the state of at least one of the at least two parts included in the force detection means based on a second threshold value corresponding to information regarding the force value ;
A detection device characterized by:
前記検出装置は、
前記第１リンクに対して相対的に変位した前記第２リンクの位置の値に関する情報を出力する第１位置検出手段と、
前記第１リンクと前記第２リンクとの間の力の値に関する情報を出力する力検出手段と、を備え、
処理部が、
前記第１位置検出手段に基づき取得された前記位置の値に関する情報と、前記位置の値に関する情報に対応する第１閾値と、前記力検出手段に基づき取得された前記力の値に関する情報、前記力の値に関する情報に対応する第２閾値とに基づき、前記力検出手段が有する少なくとも２つの部品の少なくとも１つの状態を取得する、
ことを特徴とする制御方法。 A method for controlling a detection device provided in a robot body including a first link and a second link that is displaced relative to the first link,
The detection device includes:
a first position detection means that outputs information regarding a position value of the second link that is displaced relative to the first link;
Force detection means for outputting information regarding the value of force between the first link and the second link,
The processing section
information regarding the position value acquired based on the first position detection means; a first threshold value corresponding to the information regarding the position value; information regarding the force value acquired based on the force detection means; acquiring the state of at least one of the at least two parts included in the force detection means based on a second threshold value corresponding to information regarding the force value ;
A control method characterized by:
前記第１リンクに対して相対的に変位した前記第２リンクの位置の値に関する情報を出力する第１位置検出手段と、
前記第１リンクと前記第２リンクとの間の力の値に関する情報を出力する力検出手段と、を備え、
処理部が、
前記第１位置検出手段に基づき取得された前記位置の値に関する情報と、前記位置の値に関する情報に対応する第１閾値と、前記力検出手段に基づき取得された前記力の値に関する情報、前記力の値に関する情報に対応する第２閾値とに基づき、前記力検出手段が有する少なくとも２つの部品の少なくとも１つの状態を取得する、
ことを特徴とする駆動装置。 A drive device that displaces a second link relative to the first link,
a first position detection means that outputs information regarding a position value of the second link that is displaced relative to the first link;
Force detection means for outputting information regarding the value of force between the first link and the second link,
The processing section
information regarding the position value acquired based on the first position detection means; a first threshold value corresponding to the information regarding the position value; information regarding the force value acquired based on the force detection means; acquiring the state of at least one of the at least two parts included in the force detection means based on a second threshold value corresponding to information regarding the force value ;
A drive device characterized by:
前記駆動装置は、
前記第１リンクに対して相対的に変位した前記第２リンクの位置の値に関する情報を出力する第１位置検出手段と、
前記第１リンクと前記第２リンクとの間の力の値に関する情報を出力する力検出手段と、を備え、
処理部が、
前記第１位置検出手段に基づき取得された前記位置の値に関する情報と、前記位置の値に関する情報に対応する第１閾値と、前記力検出手段に基づき取得された前記力の値に関する情報、前記力の値に関する情報に対応する第２閾値とに基づき、前記力検出手段が有する少なくとも２つの部品の少なくとも１つの状態を取得する、
ことを特徴とする制御方法。 A method of controlling a drive device for displacing a second link relative to a first link, the method comprising:
The drive device is
a first position detection means that outputs information regarding a position value of the second link that is displaced relative to the first link;
Force detection means for outputting information regarding the value of force between the first link and the second link,
The processing section
information regarding the position value acquired based on the first position detection means; a first threshold value corresponding to the information regarding the position value; information regarding the force value acquired based on the force detection means; acquiring the state of at least one of the at least two parts included in the force detection means based on a second threshold value corresponding to information regarding the force value ;
A control method characterized by:
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2018235918A JP7353755B2 (en) | 2018-12-17 | 2018-12-17 | Robot system, method for controlling the robot system, method for manufacturing articles using the robot system, detection device, method for controlling the detection device, drive device, method for controlling the drive device, control program, and recording medium |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2018235918A JP7353755B2 (en) | 2018-12-17 | 2018-12-17 | Robot system, method for controlling the robot system, method for manufacturing articles using the robot system, detection device, method for controlling the detection device, drive device, method for controlling the drive device, control program, and recording medium |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2020097078A JP2020097078A (en) | 2020-06-25 |
| JP7353755B2 true JP7353755B2 (en) | 2023-10-02 |
Family
ID=71106775
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2018235918A Active JP7353755B2 (en) | 2018-12-17 | 2018-12-17 | Robot system, method for controlling the robot system, method for manufacturing articles using the robot system, detection device, method for controlling the detection device, drive device, method for controlling the drive device, control program, and recording medium |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP7353755B2 (en) |
Families Citing this family (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP7405307B1 (en) * | 2022-11-02 | 2023-12-26 | 住友電気工業株式会社 | Sensor abnormality determination device, sensor abnormality determination system, sensor abnormality determination method, computer program, non-temporary storage medium, and machine tool |
| CN116141082A (en) * | 2023-04-19 | 2023-05-23 | 烟台匠为电子科技有限公司 | Integrated alignment detection device and alignment detection method |
Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2012061535A (en) | 2010-09-15 | 2012-03-29 | Yaskawa Electric Corp | Method and device for determining failure of speed reducer, robot, and robot system |
| WO2015137038A1 (en) | 2014-03-14 | 2015-09-17 | ソニー株式会社 | Robot arm device, robot arm control method and program |
| JP2017177290A (en) | 2016-03-30 | 2017-10-05 | ソニー株式会社 | Arm control method and arm control device |
-
2018
- 2018-12-17 JP JP2018235918A patent/JP7353755B2/en active Active
Patent Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2012061535A (en) | 2010-09-15 | 2012-03-29 | Yaskawa Electric Corp | Method and device for determining failure of speed reducer, robot, and robot system |
| WO2015137038A1 (en) | 2014-03-14 | 2015-09-17 | ソニー株式会社 | Robot arm device, robot arm control method and program |
| JP2017177290A (en) | 2016-03-30 | 2017-10-05 | ソニー株式会社 | Arm control method and arm control device |
Also Published As
| Publication number | Publication date |
|---|---|
| JP2020097078A (en) | 2020-06-25 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP7237904B2 (en) | ROBOT DEVICE, CONTROL METHOD, PRODUCT MANUFACTURING METHOD, PROGRAM, AND RECORDING MEDIUM | |
| JP6164948B2 (en) | Robot apparatus and component manufacturing method | |
| JP2017019080A (en) | Measuring method for robot device and measuring method for rotary drive device | |
| JP6711854B2 (en) | Failure prediction device and machine learning device | |
| EP3339801B1 (en) | Self-monitoring manufacturing system, production monitoring unit and use of production monitoring unit | |
| JP7353755B2 (en) | Robot system, method for controlling the robot system, method for manufacturing articles using the robot system, detection device, method for controlling the detection device, drive device, method for controlling the drive device, control program, and recording medium | |
| JP2015199192A (en) | Control method of robot system, program, recording medium, and robot system | |
| CN105583826A (en) | An Industrial Robot And A Method For Controlling An Industrial Robot | |
| JP2010531238A (en) | Apparatus and method for position adjustment of universal bearing device for cutting machine | |
| CN110303491B (en) | Action history management system | |
| JP2006318419A (en) | Calibration method of parallel mechanism machine | |
| US20210299871A1 (en) | Failure Prediction Method And Failure Prediction Apparatus | |
| JP2011088219A (en) | Operation diagnosis method of robot, control device of robot, control device of mini-environment system, robot, and mini-environment system | |
| US11331810B2 (en) | Device, method and program for estimating weight and position of gravity center of load by using robot | |
| JP6234091B2 (en) | Robot apparatus and teaching point setting method | |
| US20230136568A1 (en) | Robot, control method therefor, method for manufacturing article using robot, and storage medium | |
| JP6668665B2 (en) | Robot device | |
| JP2022094042A (en) | Detector, detection method, robot apparatus, control method of robot apparatus, production method of article using robot apparatus, driving device, control program, and recording medium | |
| Burghardt et al. | Automatic Detection of Industrial Robot Tool Damage Based on Force Measurement | |
| CN110549373A (en) | driving mechanism | |
| JP7278803B2 (en) | Information processing method, information processing device, robot system, robot system control method, article manufacturing method using robot system, program, and recording medium | |
| JP7267725B2 (en) | Robot control method, program, recording medium, robot system, article manufacturing method | |
| JP7274846B2 (en) | link actuator | |
| Ahmad et al. | Design of a Compliant Robotic End-effector Tool for Normal Contact Estimation | |
| JP2022071927A (en) | Robot arm state determination method, robot system, and computer program |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20211216 |
|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20211216 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20221011 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20221025 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20221220 |
|
| A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20230404 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20230627 |
|
| A911 | Transfer to examiner for re-examination before appeal (zenchi) |
Free format text: JAPANESE INTERMEDIATE CODE: A911 Effective date: 20230705 |
|
| 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: 20230822 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20230920 |
|
| R151 | Written notification of patent or utility model registration |
Ref document number: 7353755 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |