JP7225625B2 - Specific device, specific method and specific program - Google Patents
Specific device, specific method and specific program Download PDFInfo
- Publication number
- JP7225625B2 JP7225625B2 JP2018175420A JP2018175420A JP7225625B2 JP 7225625 B2 JP7225625 B2 JP 7225625B2 JP 2018175420 A JP2018175420 A JP 2018175420A JP 2018175420 A JP2018175420 A JP 2018175420A JP 7225625 B2 JP7225625 B2 JP 7225625B2
- Authority
- JP
- Japan
- Prior art keywords
- information
- rotation
- torque
- tool
- comparison
- 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
- 238000000034 method Methods 0.000 title claims description 74
- 238000012545 processing Methods 0.000 description 126
- 238000010586 diagram Methods 0.000 description 20
- 238000001514 detection method Methods 0.000 description 8
- 230000000052 comparative effect Effects 0.000 description 7
- 230000010365 information processing Effects 0.000 description 7
- 238000004891 communication Methods 0.000 description 6
- 238000005259 measurement Methods 0.000 description 5
- 230000005484 gravity Effects 0.000 description 4
- 230000010354 integration Effects 0.000 description 4
- 230000000694 effects Effects 0.000 description 3
- 239000000758 substrate Substances 0.000 description 3
- 238000009795 derivation Methods 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
Images
Landscapes
- Automatic Tool Replacement In Machine Tools (AREA)
- Machine Tool Sensing Apparatuses (AREA)
Description
本発明は、物を特定する方法に関する The present invention relates to a method for identifying an object
工作用ロボット等の作業装置により工作等を行う場合、複数の工具等を使い分けることにより、種々の工作等を行う場合がある。その場合、行う工作の種類に応じた工具等の特定と装着を行う必要がある。 2. Description of the Related Art When working with a working device such as a working robot, various tools may be used to perform various kinds of work. In that case, it is necessary to specify and install tools according to the type of work to be done.
行う工作の種類に応じた工具等の特定を支援する方法として、工具等に刻印されたバーコードをバーコードリーダで読み込む方法が開示されている（特許文献１参照）。 As a method for assisting in specifying a tool or the like according to the type of work to be performed, a method is disclosed in which a barcode engraved on the tool or the like is read by a barcode reader (see Patent Document 1).
しかしながら、特許文献１が開示する方法は、工具等に刻印されたバーコードを読み取る専用のバーコードリーダが必要となりコスト高になるという課題がある。 However, the method disclosed in Patent Literature 1 requires a dedicated bar code reader for reading the bar code stamped on the tool or the like, resulting in a problem of high cost.
本発明は、より安価に作業装置等に装着する物の特定を容易化し得る特定装置等の提供を目的とする。 SUMMARY OF THE INVENTION It is an object of the present invention to provide a specification device or the like that can facilitate specification of an object to be attached to a work device or the like at a lower cost.
本発明の特定装置は、複数の種類の装着部材のうち装着された一つが、鉛直方向と異なる少なくとも一つの回転軸の周りに回転する際に発生するトルクを表す値の、前記回転の角度に対する依存性を示す依存性情報を取得し、少なくとも一つの前記依存性情報である比較用情報については対応する前記装着部材を示す情報である識別情報とともに記録する取得部と、前記取得した二つの前記依存性情報が近似すると判定し、いずれか一方のみが前記比較用情報である場合に、前記識別情報を出力する出力部とを備える。 A specific device of the present invention is a method for determining a value representing a torque generated when one of a plurality of types of mounting members mounted rotates around at least one rotation axis different from the vertical direction with respect to the angle of rotation. an acquisition unit that acquires dependency information indicating dependency and records at least one comparison information that is the dependency information together with identification information that is information that indicates the corresponding mounting member; and an output unit that determines that the dependency information is similar and outputs the identification information when only one of them is the comparison information.
本発明の特定装置等は、より安価に作業装置等に装着する物の特定を容易化し得る。 The identification device or the like of the present invention can facilitate identification of an object to be attached to a working device or the like at a lower cost.
本実施形態のツール特定装置は、作業用装置の可動部にツールを装着した状態で、前記ツールを第一回転軸の周りに回転させる。ここで、前記作業用装置は、装着したツールを前記可動部ごと所定の回転軸の周りに回転させることにより所定の作業を行うと共に、その回転軸の周りのトルクを表すトルク値を出力する、一般的な多軸回転ロボット等である。 The tool identification device of this embodiment rotates the tool around the first rotation axis in a state in which the tool is attached to the movable portion of the working device. Here, the working device performs a predetermined work by rotating the attached tool together with the movable portion around a predetermined rotation axis, and outputs a torque value representing the torque around the rotation axis. It is a general multi-axis rotating robot or the like.
そして、前記ツール特定装置は、取得した、前記ツール等に印加される重力に起因する前記第一回転軸周りのトルクの回転角度位置依存性と予め取得しておいた回転角度位置依存性が対応するかを後述の方法により判定する。そして、前記ツール特定装置は、前記対応することを判定した場合に、予め取得しておいた回転角度位置依存性と関連付けられたツール識別情報を出力する。 Then, the tool identification device associates the obtained rotational angle position dependence of the torque about the first rotation axis caused by the gravity applied to the tool or the like with the pre-obtained rotational angle position dependence. It is determined by the method described later whether Then, the tool identification device outputs the tool identification information associated with the rotation angle position dependency acquired in advance when it is determined to correspond to the above.
上記動作を行う部分のうち、前記回転角度位置依存性を取得する部分と、予め取得しておいた前記回転角度位置依存性が対応する場合にツール識別情報を特定し出力する部分以外は、前記作業用装置が予め備えている。そのため、前記作業用装置が出力する前記トルク値から前記回転角度位置依存性を取得し、予め取得しておいたものと対応できるときに前記識別情報を特定し出力する構成を用いるだけで、前記ツール特定装置を簡単に構成できる。 Among the parts that perform the above operations, the parts other than the part that acquires the rotation angle position dependency and the part that specifies and outputs the tool identification information when the rotation angle position dependency that has been acquired in advance corresponds to the above Work equipment is provided in advance. Therefore, only by using a configuration that acquires the rotation angle position dependency from the torque value output by the work device and specifies and outputs the identification information when it can correspond to the previously acquired one, the above The tool identification device can be easily constructed.
そのため、前記ツール特定装置は、工具等に刻印されたバーコードを読み取る専用のバーコードリーダが不要である。このため、前記ツール特定装置は、特許文献１が開示する方法よりもコストを抑えることができる。すなわち、前記ツール特定装置は、より安価に、ロボット等に装着する工具等の特定を容易化し得る。
［構成と動作］
図１は、実施形態のツール特定装置の例であるツール特定装置１００の構成を表す概念図である。
Therefore, the tool identification device does not require a dedicated bar code reader for reading the bar code stamped on the tool or the like. Therefore, the tool identification device can be made at a lower cost than the method disclosed in Patent Document 1. That is, the tool identification device can facilitate identification of a tool or the like to be attached to a robot or the like at a lower cost.
[Configuration and operation]
FIG. 1 is a conceptual diagram showing the configuration of a tool identification device 100, which is an example of a tool identification device according to an embodiment.
ツール特定装置１００は、ツール操作部２００と制御部３００とを備える。
The tool identification device 100 includes a
ツール操作部２００は、装着された図示しないツールを操作して、ツールに所定の作業を行わせる部分である。当該作業は、例えば、物品の加工である。
The
ツール操作部２００は、ツール装着部２０１と、回転部２０６とを備える。
The
ツール装着部２０１は、図示しないツールを固定可能な機構を備えている。当該機構は、例えば、バイスである。ツール装着部２０１は、回転部２０６の図示しない可動部に固定されている。
The
回転部２０６の設置面は、図示しない基体に固定されている。回転部２０６は、制御部３００から送付される制御情報により、前記可動部を所定の回転軸周りに回転させる。当該回転軸の数は、単数又は複数である。当該回転軸の数は例えば、６軸である。
The installation surface of the rotating
回転部２０６は、前記各回転軸について、前記回転角度位置を表す角度位置情報を検出する角度位置センサを備えている。前記角度位置は、基準角度位置（０度）からの角度である。当該角度位置センサは、前記角度位置情報を制御部３００へ逐次送付する。
The rotating
ツール装着部２０１及び回転部２０６の備える上記構成は、一般的な、多軸回転アームを備えるロボットアームが供える構成である。従い、ここでは、その詳細説明は省略されるものとする。一般的な多軸回転アームを備えるロボットアームは、例えば、デンソーウェーブ社製のＶＳ－０５０である。
The above configuration of the
一方、制御部３００は、処理部３２１と、記憶部３２６と、出力部３３１とを備える。
On the other hand, the
処理部３２１は、例えば、中央演算処理装置である。 The processing unit 321 is, for example, a central processing unit.
処理部３２１は、回転制御部３０１と、トルク検出部３０６と、トルク情報生成部３１１と、ツール特定部３１６とを備える。
The processing unit 321 includes a
回転制御部３０１は、回転部２０６に制御情報を送付し、前記可動部を、所定の回転軸の周りに回転させる。当該制御情報には、回転部２０６が行う、前記可動部の各回転軸周りの回転角度位置を表す情報である角度位置指示情報が含まれる。
The
回転制御部３０１は、回転部２０６の複数の回転軸のうちの一つを除き、その回転軸に関する可動構成要素の回転角度位置を固定させる。ここで、可動構成要素は、その回転軸周りに相対的に回転する二つのアーム構成要素のうちの固定されていない方をいうことにする。
そして、回転制御部３０１は、前記可動構成要素を、その回転軸の周りに３６０度以上回転させる。
Then, the
回転制御部３０１には、回転部２０６から、前記角度位置情報が送付される。回転制御部３０１は、前記角度位置指示情報と前記角度位置情報から次のタイミングで回転部へ送付する前記角度位置指示情報を導出する。回転制御部３０１が行う上記動作は、一般的な多軸回転ロボット（デンソーウェーブ社製のＶＳ－０５０等）で行われているものである。
The angular position information is sent from the
回転制御部３０１は、前記角度位置指示情報と、回転部２０６から送付を受けた前記角度位置情報とを、トルク検出部３０６へ送付する。
The
トルク検出部３０６は、回転制御部３０１から送付された前記角度位置指示情報と前記角度位置情報との乖離の度合いから、各回転軸に係るトルクを導出する。そして、トルク検出部３０６は、前記角度位置情報と導出したトルクとの対応情報である第一取得トルク情報を、逐次、記憶部３２６に格納させる。当該動作は、一般的な多軸回転ロボット（デンソーウェーブ社製のＶＳ－０５０等）の制御部で行われているものである。
The
前述のように、回転制御部３０１は、前記可動構成要素を、その回転軸の周りに３６０度以上回転させる。従い、記憶部３２６には、３６０度以上の範囲の各回転角度位置に対応するトルクを表すトルク値（第一取得トルク情報）が格納される。
As described above,
トルク情報生成部３１１は、トルク検出部３０６が記憶部３２６に格納させた第一取得トルク情報から、取得トルク情報を導出する。当該取得トルク情報は、前記第一取得トルク情報から、設定された回転角度位置範囲のトルク値を抽出等したものである。当該回転角度位置範囲は、例えば、０度以上３６０度以下の範囲である。ここで、取得トルク情報における回転角度位置の０度は、例えば、前記トルクの値が０であり、かつ、回転角度位置を増やした場合にトルクの値が増加する角度位置として導出される。
Torque
トルク情報生成部３１１は、生成した取得トルク情報を、記憶部３２６に格納させる。
The torque
ツール特定部３１６は、トルク情報生成部３１１が生成した取得トルク情報に対応するものが、記憶部３２６が保持する比較用トルク情報にあるかの判定を行う。記憶部３２６は、予め、ツール装着部２０１へ装着される可能性があるツールの各々について同じ条件で測定した取得トルク情報を比較用トルク情報として予め保持している。当該比較用トルク情報の各々には、対応する前記ツールの識別情報が関連付けられている。前記判定動作の具体例は、図５及び図６を参照して後述される。
The
ツール特定部３１６は、トルク情報生成部３１１が生成した取得トルク情報の組合せに対応するものが、記憶部３２６が保持する比較用トルク情報の組合せにあるかの判定を行っても構わない。その場合、記憶部３２６は、予め、ツール装着部２０１へ装着される可能性があるツールの各々について同じ条件で測定した取得トルク情報の組合せを比較用トルク情報の組合せとして予め保持している。当該比較用トルク情報の組合せの各々には、対応する前記ツールの識別情報が関連付けられている。前記判定動作の具体例は、図７及び図８を参照して後述される。
The
そして、ツール特定部３１６は、トルク情報生成部３１１が生成した取得トルク情報等に対応する前記比較用トルク情報を、記憶部３２６が保持することを判定したとする。その場合、ツール特定部３１６は、その比較用トルク情報に関連付けられているツールＩＤを出力部３３１に出力させる。
Then, it is assumed that the
出力部３３１は、ツール特定部３１６が指示する情報を出力する。出力部３３１は、例えば、表示部や、他の装置へ情報を送信する送信部である。
The
記憶部３２６は、制御部３００の各構成が上記動作を行うために必要なプログラムや情報を保持する。記憶部３２６は、制御部３００の各構成が格納を指示する情報を格納する。記憶部３２６は、制御部３００の各構成が送付を指示する格納情報を、指示された送付先である制御部３００の構成へ送付する。
The
図２は、図１に表す回転部２０６の例を表すイメージ図である。
FIG. 2 is an image diagram showing an example of the
回転部２０６は、一般的な多軸回転ロボットである。
The
回転部２０６は、部材２１１乃至２１７を備える。
Rotating
部材２１１の底面は、基体８０１上に固定されている。 A bottom surface of the member 211 is fixed on the base 801 .
部材２１２は、前記回転制御部３０１から送付される前記制御情報により、部材２１１に対して相対的に、回転軸７０１の周囲を回転する。
The member 212 rotates around the rotary shaft 701 relative to the member 211 according to the control information sent from the
部材２１３は、前記制御情報により、部材２１２に対して相対的に、回転軸７０２の周囲を回転する。 The member 213 rotates around the rotation axis 702 relative to the member 212 according to the control information.
部材２１４は、前記制御情報により、部材２１３に対して相対的に、回転軸７０３の周囲を回転する。 The member 214 rotates around the rotation axis 703 relative to the member 213 according to the control information.
部材２１５は、前記制御情報により、部材２１４に対して相対的に、回転軸７０４の周囲を回転する。 The member 215 rotates about the rotation axis 704 relative to the member 214 according to the control information.
部材２１６は、前記制御情報により、部材２１５に対して相対的に、回転軸７０５の周囲を回転する。 The member 216 rotates about the rotation axis 705 relative to the member 215 according to the control information.
部材２１７は、前記制御情報により、部材２１６に対して相対的に、回転軸７０６の周囲を回転する。 Member 217 rotates about rotation axis 706 relative to member 216 according to the control information.
部材２１７の面９５１は、図１に表すツール装着部２０１が固定されることが予定された面である。
［具体例］
次に、前述のトルク情報を導出する際に回転部２０６が行う動作の具体例について説明する。
A surface 951 of the member 217 is a surface to which the
[Concrete example]
Next, a specific example of the operation performed by the
図１に表す回転制御部３０１は、まず、例えば、回転軸７０１乃至７０４の各々の周りの回転角度位置を調整し、部材２１６が基体８０１に平行であり、かつ、回転軸７０５の周りの部材２１６の回転が基体８０１の上面に対し垂直な面内で行われるようにする。
The
そして、作業者等は、ツール装着部２０１にツール４０１を装着する。
Then, the operator or the like mounts the tool 401 on the
図３は、上記動作等が完了した状態（初期状態等）におけるツール操作部２００の様子を表すイメージ図である。
FIG. 3 is an image diagram showing the state of the
図３に表す状態では、回転軸７０６の周りの回転角度位置により、ツールに印加される重力により回転軸７０６の周りのトルクが変化するようになっている。また、同図に表す状態では、部材２１６、部材２１７、ツール装着部２０１及びツール４０１の組合せに印加される重力により、回転軸７０５の周りの回転角度位置により、回転軸７０５の周りのトルクが生じるようになっている。
3, the angular position of rotation about the axis of rotation 706 is such that the force of gravity applied to the tool causes the torque about the axis of rotation 706 to vary. In addition, in the state shown in the figure, due to the gravitational force applied to the combination of the member 216, the member 217, the
また、図３に表す状態では、回転軸７０６は鉛直方向に垂直である。そのため、部材２１７、ツール装着部２０１及びツール４０１の組合せに含まれるいずれの点の回転軸７０６周りの回転も、鉛直面内で行われる。
Also, in the state shown in FIG. 3, the rotation axis 706 is perpendicular to the vertical direction. As such, rotation of any point included in the combination of member 217,
また、図３に表す状態では、回転軸７０５も鉛直方向に垂直である。そのため、部材２１６、部材２１７、ツール装着部２０１及びツール４０１の組合せに含まれるいずれの点の回転軸７０５周りの回転も、鉛直面内で行われる。
Further, in the state shown in FIG. 3, the rotation axis 705 is also perpendicular to the vertical direction. Therefore, the rotation of any point included in the combination of member 216, member 217,
これらのように、トルク情報を取得する際に行う回転は、回転する部分の各点が鉛直面内で行われるようにする方が望ましい。その理由は、回転軸の周りに重力により生じるトルクの値がより大きくなり、トルク情報の測定が容易になるからである。 As described above, it is desirable that each point of the rotating portion be rotated within the vertical plane when the torque information is acquired. The reason for this is that the value of the torque produced by gravity around the axis of rotation is greater, making it easier to measure torque information.
また、図３に表す状態では、回転軸７０６周りの回転に係る回転面と、回転軸７０５周りの回転に係る回転面とは略直交する。 In addition, in the state shown in FIG. 3, the plane of rotation related to rotation about the rotation axis 706 and the plane of rotation related to rotation about the rotation axis 705 are substantially perpendicular to each other.
次に、処理部３２１が行う動作の第一の具体例を説明する。第一の具体例は、回転軸７０６回りの部材２１７の回転により取得した取得トルク情報からツールを特定するものである。 Next, a first specific example of the operation performed by the processing unit 321 will be described. A first specific example is to identify the tool from the acquired torque information acquired by rotating the member 217 around the rotation axis 706 .
回転制御部３０１は、部材２１７を、回転軸７０６の周りに、矢印９９８ａの表す向きに、３６０度以上回転させる。
The
その間、トルク検出部３０６は、回転軸７０５回りのトルクを導出し、回転角度位置とトルクとの組合せを、順次、記憶部３２６に格納させる。
During this time, the
そして、トルク情報生成部３１１は、当該組合せから、前述の取得トルク情報を導出し、記憶部３２６に格納させる。
Then, the
当該取得トルク情報は、例えば、０度以上３６０度以下の回転軸７０６回りのトルクを表すものである。 The acquired torque information represents, for example, the torque around the rotating shaft 706 at 0 degrees or more and 360 degrees or less.
そして、ツール特定部３１６は、トルク情報生成部３１１が生成した取得トルク情報と記憶部３２６が格納している比較用トルク情報の各々とを比較する。
Then, the
そして、ツール特定部３１６は、記憶部３２６が格納している比較用トルク情報に当該取得トルク情報に合致するものがある旨を判定した場合は、ツールＩＤを記憶部３２６から読み出し、出力部３３１に出力させる。ここで、ＩＤはＩｄｅｎｔｉｆｉｅｒの略である。また、当該ツールＩＤは、その比較用トルク情報に予め関連付けられたものである。前記ツールＩＤは、ツール名称、ツール記号、ツール番号等のツールの特定を可能にする識別情報である。
Then, when it is determined that the comparison torque information stored in the
処理部３２１は、回転軸７０５回りの回転動作によりツールＩＤを特定しても構わない。 The processing unit 321 may specify the tool ID by rotating the rotation axis 705 .
以下に説明する第二の具体例は、回転軸７０５回りの回転動作により、処理部３２１がツールＩＤを出力する動作の具体例である。 A second specific example described below is a specific example of an operation in which the processing unit 321 outputs a tool ID by a rotation operation about the rotation axis 705 .
図１に表す回転制御部３０１は、まず、回転軸７０１乃至７０４の各々の周りの回転角度位置を調整し、部材２１６が基体８０１に平行であり、かつ、回転軸７０５の周りの部材２１６の回転が基体８０１の上面に対し垂直な面内で行われるようにする。
The
さらに、回転制御部３０１は、部材２１７の回転角度位置を所定の値にする。
Furthermore, the
そして、作業者等は、ツール装着部２０１にツール４０１を装着する。ここで、ツール４０１のツール装着部２０１への装着のされ方は、常に一定であるものとする。
Then, the operator or the like mounts the tool 401 on the
そして、回転制御部３０１は、部材２１６を、回転軸７０５の周りに、矢印９９８ｂの向きに、３６０度以上回転させる。ここで、図３に表す状態では、部材２１６が回転軸７０５の周りに３６０度以上回転しても、部材２１７及びツール４０１は、部材２１４と干渉しないものとする。
Then, the
その間、トルク検出部３０６は、回転軸７０６回りのトルクを導出し、回転角度位置とトルクとの組合せを、順次、記憶部３２６に格納させる。
During this time, the
そして、トルク情報生成部３１１は、当該組合せから、前述の取得トルク情報を導出し、記憶部３２６に格納させる。
Then, the
当該取得トルク情報は、例えば、０度以上３６０度以下の回転軸７０５回りのトルクを表すものである。 The acquired torque information represents, for example, the torque around the rotating shaft 705 at 0 degrees or more and 360 degrees or less.
そして、ツール特定部３１６は、トルク情報生成部３１１が生成した取得トルク情報と記憶部３２６が格納している比較用トルク情報の各々とを比較する。
Then, the
そして、ツール特定部３１６は、記憶部３２６が格納している比較用トルク情報に当該取得トルク情報に対応するものがある旨を判定した場合は、その比較用トルク情報に予め関連付けられたツールＩＤを記憶部３２６から読み出し、出力部３３１に出力させる。
Then, when the
図４は、前述の取得トルク情報の例である取得トルク情報７５１と比較用トルク情報の例である比較用トルク情報７５６を表すイメージ図である。 FIG. 4 is an image diagram showing acquired torque information 751, which is an example of the aforementioned acquired torque information, and comparison torque information 756, which is an example of comparison torque information.
取得トルク情報７５１は、位置に対してサインカーブを描く。そして、トルクの最大値Ｔｍの値は、長さＬと重量Ｗとの積で表される。ここで、長さＬは、
回転軸の位置から、前記可動構成要素、ツール装着部２０１及びツール４０１の組合せの重心までの距離である。また、重量Ｗは、前記可動構成要素、ツール装着部２０１及びツール４０１の組合せの重量である。
Acquired torque information 751 draws a sine curve with respect to position. The value of the maximum torque value Tm is represented by the product of the length L and the weight W. Here, the length L is
It is the distance from the position of the axis of rotation to the center of gravity of the moveable component,
図４に表す比較用トルク情報７５６は、取得トルク情報７５１と、ほぼ同様なものである。その場合、ツール特定部３１６は、取得トルク情報７５１が比較用トルク情報７５６と略同一であることを判定する。そして、ツール特定部３１６は、比較用トルク情報７５６と予め関連付けられたツールＩＤである「ツールＡ」を、出力部３３１に出力させる。
［処理フロー例］
図５は、図１に表す処理部３２１が行う処理の処理フロー例を表す概念図である。
The torque information for comparison 756 shown in FIG. 4 is substantially the same as the acquired torque information 751 . In that case, the
[Processing flow example]
FIG. 5 is a conceptual diagram showing a processing flow example of processing performed by the processing unit 321 shown in FIG.
処理部３２１は、例えば、外部からの開始情報の入力により図５に表す処理を開始する。 For example, the processing unit 321 starts the processing shown in FIG. 5 by inputting start information from the outside.
そして、処理部３２１は、作業者等の外部から測定条件の入力があったかについての判定を行う。当該測定条件は、例えば、取得トルク情報の取得のために回転させる回転軸を特定する情報である。 Then, the processing unit 321 determines whether measurement conditions have been input from outside, such as by an operator. The measurement condition is, for example, information specifying a rotating shaft to be rotated to acquire the acquired torque information.
処理部３２１は、Ｓ１０１の処理による判定結果がｙｅｓの場合は、Ｓ１０２の処理を行う。 The processing unit 321 performs the processing of S102 when the determination result of the processing of S101 is yes.
一方、処理部３２１は、Ｓ１０１の処理による判定結果がｎｏの場合は、Ｓ１０１の処理を再度行う。 On the other hand, when the determination result of the process of S101 is no, the processing unit 321 performs the process of S101 again.
処理部３２１は、Ｓ１０２の処理を行う場合は、同処理として、各部材の回転位置の初期状態の設定を行う。Ｓ１０２の処理は、回転部２０６を、例えば、図３に表すような状態にする処理である。
When performing the process of S102, the processing unit 321 sets the initial state of the rotational position of each member as the same process. The process of S102 is a process of bringing the
次に、処理部３２１は、Ｓ１０３の処理として、第一取得トルク情報を取得し、記憶部３２６に格納させる。同処理は、回転制御部３０１が、回転部２０６の可動構成要素を３６０度以上回転させつつ、各回転角度位置に対応するトルクをトルク検出部が取得し、記憶部３２６に格納させる処理である。
Next, the processing unit 321 acquires the first acquired torque information and stores it in the
そして、処理部３２１は、Ｓ１０４の処理として、Ｓ１０３の処理により記憶部３２６に格納させた第一取得トルク情報から、前述の取得トルク情報を導出し、記憶部３２６に格納させる。当該処理の内容は前述の通りである。Ｓ１０４の処理は、図１に表すトルク情報生成部３１１が行う処理である。
Then, as the process of S104, the processing unit 321 derives the acquired torque information described above from the first acquired torque information stored in the
そして、処理部３２１は、Ｓ１０５の処理として、Ｓ１０４の処理により記憶部３２６に格納させた前記取得トルク情報に合致する前述の比較用トルク情報を、記憶部３２６が保持しているかについての判定を行う。処理部３２１は、当該判定を、例えば次に説明する三つの方法のいずれかにより行う。
Then, as the processing of S105, the processing unit 321 determines whether or not the
一つ目の方法を用いる場合、処理部３２１は、まず、角度位置０から角度がΔＡ増加するごとに、前記取得トルク情報と前記比較用トルク情報の差の大きさを、すべて導出する。ここで、角度ΔＡは、例えば、３６０度と比較して十分に小さい角度である。角度ΔＡは、例えば１度である。
When using the first method, the processing unit 321 first derives all the magnitudes of the differences between the acquired torque information and the comparative torque information each time the angle increases by ΔA from the
そして、処理部３２１は、導出した差の大きさ（絶対値）をすべて積算する。そして、処理部３２１は、当該積算に係る積算値が予め設定された閾値Ｔｈ１よりも小さい時に、前記取得トルク情報は、前記比較用トルク情報と合致したことを判定する。ここで、閾値Ｔｈ１は、前記積算値が閾値Ｔｈ１より小さい時に前記取得トルク情報が前記比較用トルク情報と合致することを判定する趣旨で予め定められた前記積算値についての閾値である。 Then, the processing unit 321 integrates all the magnitudes (absolute values) of the derived differences. Then, the processing unit 321 determines that the acquired torque information matches the comparison torque information when the integrated value related to the integration is smaller than a preset threshold value Th1. Here, the threshold Th1 is a predetermined threshold for the integrated value for the purpose of determining that the acquired torque information matches the comparison torque information when the integrated value is smaller than the threshold Th1.
二つ目の方法を用いる場合、処理部３２１は、前記取得トルク情報と前記比較用トルク情報の各々のトルクの最大値の差を求める。そして当該差が、閾値Ｔｈ２以下の場合に、前記取得トルク情報は、前記比較用トルク情報と合致したことを判定する。ここで、閾値Ｔｈ２は、前記最大値の差が閾値Ｔｈ２より小さい時に前記取得トルク情報が前記比較用トルク情報と合致することを判定する趣旨で予め定められた前記最大値の差についての閾値である。 When using the second method, the processing unit 321 obtains the difference between the maximum torque values of the obtained torque information and the torque information for comparison. Then, when the difference is equal to or smaller than the threshold Th2, it is determined that the acquired torque information matches the comparison torque information. Here, the threshold Th2 is a predetermined threshold for the difference between the maximum values for the purpose of determining that the obtained torque information matches the comparison torque information when the difference between the maximum values is smaller than the threshold Th2. be.
三つ目の方法を用いる場合、処理部３２１は、前記取得トルク情報と前記比較用トルク情報の各々についての、トルクの最大値とトルクの最小値の絶対値との平均値、の差の大きさ（絶対値）を求める。そして当該平均値の差が、閾値Ｔｈ３以下の場合に、前記取得トルク情報は、前記比較用トルク情報と合致したことを判定する。ここで、閾値Ｔｈ３は、前記平均値の差が閾値Ｔｈ３より小さい時に前記取得トルク情報が前記比較用トルク情報と合致することを判定する趣旨で予め定められた前記平均値の差についての閾値である。 When using the third method, the processing unit 321 determines the magnitude of the difference between the average values of the absolute values of the maximum torque value and the minimum torque value for each of the acquired torque information and the comparative torque information. (absolute value). Then, when the difference between the average values is equal to or less than the threshold value Th3, it is determined that the acquired torque information matches the comparison torque information. Here, the threshold value Th3 is a predetermined threshold value for the difference in the average values for the purpose of determining that the acquired torque information matches the comparative torque information when the difference in the average values is smaller than the threshold Th3. be.
Ｓ１０５の処理は、図１に表すツール特定部３１６が行う処理である。
The processing of S105 is processing performed by the
処理部３２１は、Ｓ１０５の処理による判定結果がｙｅｓの場合は、Ｓ１０６の処理を行う。 The processing unit 321 performs the processing of S106 when the determination result of the processing of S105 is yes.
一方、処理部３２１は、Ｓ１０５の処理による判定結果がｎｏの場合は、Ｓ１０７の処理を行う。 On the other hand, the processing unit 321 performs the processing of S107 when the determination result of the processing of S105 is no.
処理部３２１は、Ｓ１０６の処理を行う場合は、同処理として、Ｓ１０５の処理により合致することを判定した比較用トルク情報に関連付けられて記憶部３２６が保持するツールＩＤを、出力部３３１に出力させる。そして、処理部３２１は、図５に表す処理を終了する。
When performing the processing of S106, the processing unit 321 outputs to the
処理部３２１は、Ｓ１０７の処理を行う場合は、同処理として、該当するツールがない旨を表す情報、出力部３３１に出力させる。そして、処理部３２１は、図５に表す処理を終了する。
When performing the processing of S107, the processing unit 321 causes the
図５に表すＳ１０５乃至Ｓ１０７の処理は、次に説明する図６に表す処理により置き換えることができる。 The processing of S105 to S107 shown in FIG. 5 can be replaced by the processing shown in FIG. 6 described below.
図６は、図５に表すＳ１０５乃至Ｓ１０７の処理を置き換える処理を表す概念図である。 FIG. 6 is a conceptual diagram showing the process of replacing the processes of S105 to S107 shown in FIG.
処理部３２１は、図５に表すＳ１０４の処理の次に、Ｓ１０５ｂの処理として、Ｓ１０４の処理により導出した取得トルク情報に最も近い比較用トルク情報を特定する。 After the process of S104 shown in FIG. 5, the processing unit 321 specifies the torque information for comparison that is closest to the acquired torque information derived by the process of S104 as the process of S105b.
処理部３２１は、当該特定を、例えば、次に説明する三つの方法のいずれかににより行う。 The processing unit 321 performs the identification by, for example, one of the three methods described below.
一つ目の方法を用いる場合、処理部３２１は、まず、角度位置０から角度がΔＡ増加するごとに前記取得トルク情報と前記比較用トルク情報の各々との差の大きさ（絶対値）をすべて導出する。ここで、角度ΔＡは、３６０度と比較して十分に小さい角度である。角度ΔＡは、例えば１度である。
When using the first method, the processing unit 321 first calculates the magnitude (absolute value) of the difference between the acquired torque information and the comparison torque information each time the angle increases by ΔA from the
そして、処理部３２１は、前記比較用トルク情報の各々について、導出した差の大きさをすべて積算する。そして、処理部３２１は、当該積算に係る積算値が最も小さい前記比較用トルク情報を、取得トルク情報に最も近似した比較用トルク情報として特定する。 Then, the processing unit 321 integrates all the magnitudes of the derived differences for each piece of the torque information for comparison. Then, the processing unit 321 specifies the comparison torque information with the smallest integrated value related to the integration as the comparison torque information that is most similar to the acquired torque information.
二つ目の方法を用いる場合、処理部３２１は、前記取得トルク情報と、前記比較用トルク情報の各々との、トルクの最大値の差を求める。そして当該差が最も小さい前記比較用トルク情報を、取得トルク情報に最も近似した比較用トルク情報として特定する。 When using the second method, the processing unit 321 obtains a difference in maximum torque value between the acquired torque information and each of the comparison torque information. Then, the comparison torque information with the smallest difference is specified as the comparison torque information that is most similar to the acquired torque information.
三つ目の方法を用いる場合、処理部３２１は、前記取得トルク情報と前記比較用トルク情報の各々についての、トルクの最大値とトルクの最小値の絶対値との平均値、の差の大きさ（絶対値）を求める。そして当該平均値の差が最も小さい前記比較用トルク情報を、取得トルク情報に最も近似した比較用トルク情報として特定する。 When using the third method, the processing unit 321 determines the magnitude of the difference between the average values of the absolute values of the maximum torque value and the minimum torque value for each of the acquired torque information and the comparative torque information. (absolute value). Then, the comparison torque information having the smallest difference in the average values is specified as the comparison torque information that is most similar to the obtained torque information.
そして、処理部３２１は、Ｓ１０６ｂの処理として、Ｓ１０５ｂの処理により最も近似していることを判定した比較用トルク情報に関連付けられて記憶部３２６が保持するツールＩＤを、出力部３３１に出力させる。そして、処理部３２１は、図５に表す処理を終了する。
Then, as the processing of S106b, the processing unit 321 causes the
ツール特定装置１００は、複数の異なる回転軸周りの取得トルク情報の組合せから、ツールを特定しても構わない。その場合は、処理部３２１は、例えば、図５に表すＳ１０５乃至Ｓ１０７の処理を図７に表す処理により置き換えた処理を行う。 The tool identification device 100 may identify a tool from a combination of acquired torque information about a plurality of different rotation axes. In that case, the processing unit 321 performs, for example, the processing of S105 to S107 shown in FIG. 5 replaced with the processing shown in FIG.
図７は、図５に表すＳ１０５乃至Ｓ１０７の処理を置き換える処理を表す概念図である。 FIG. 7 is a conceptual diagram showing the process of replacing the processes of S105 to S107 shown in FIG.
処理部３２１は、図５に表すＳ１０４の処理の次に、Ｓ１０２－２の処理として、各部材の回転位置を第二の状態に設定する。当該第二の設定位置は、図５に表すＳ１０２の処理の説明において述べた初期状態と同じであっても構わない。その場合は、Ｓ１０２－２の処理は、回転部２０６を、例えば、図３に表すような状態にする処理である。
After the process of S104 shown in FIG. 5, the processing unit 321 sets the rotational position of each member to the second state as the process of S102-2. The second set position may be the same as the initial state described in the description of the process of S102 shown in FIG. In that case, the process of S102-2 is the process of putting the
次に、処理部３２１は、Ｓ１０３－２の処理として、第二取得トルク情報を取得し、記憶部３２６に格納させる。同処理は、回転制御部３０１が、回転部２０６の可動構成要素を３６０度以上回転させつつ、各回転角度位置に対応するトルクをトルク検出部が取得し、記憶部３２６に格納させる処理である。当該回転は、図５に表すＳ１０３の処理により行われる回転の回転軸とは異なる回転軸について行われるものである。
Next, the processing unit 321 acquires the second acquired torque information and stores it in the
そして、処理部３２１は、Ｓ１０４－２の処理として、Ｓ１０３－２の処理により記憶部３２６に格納させた第二取得トルク情報から、第三取得トルク情報を導出し、記憶部３２６に格納させる。第一取得トルク情報と取得トルク情報との関係は、第二取得トルク情報と第三取得トルク情報との関係と同じである。従い、処理部３２１は、第一取得トルク情報から取得トルク情報を導出する処理と同様の処理により、第二取得トルク情報から第三取得トルク情報を導出する。
Then, as the processing of S104-2, the processing unit 321 derives the third acquired torque information from the second acquired torque information stored in the
Ｓ１０４－２の処理は、図１に表すトルク情報生成部３１１が行う処理である。
The processing of S104-2 is processing performed by the torque
そして、処理部３２１は、Ｓ１０５－２の処理として、前記取得トルク情報と前記第三取得トルク情報との組合せに合致する比較用トルク情報の組合せが、記憶部３２６に格納されているかについての判定を行う。前記取得トルク情報は、Ｓ１０４の処理により記憶部３２６が格納したものである。また、前記第三取得トルク情報は、Ｓ１０４－２の処理により記憶部３２６が格納したものである。
Then, as the process of S105-2, the processing unit 321 determines whether a combination of torque information for comparison that matches the combination of the acquired torque information and the third acquired torque information is stored in the
処理部３２１は、当該判定を、例えば、次に説明する三つの方法のいずれかにより行う。 The processing unit 321 makes the determination by, for example, one of the following three methods.
一つ目の方法を用いる場合、処理部３２１は、まず、角度位置０から角度がΔＡ増加するごとに前記測定情報及び前記第三取得トルク情報の各々と、各々の比較対象の前記比較用トルク情報の差の大きさ（絶対値）を、すべて導出する。ここで、角度ΔＡは、３６０度と比較して十分に小さい角度である。角度ΔＡは、例えば１度である。
When the first method is used, the processing unit 321 first, each time the angle increases by ΔA from the
そして、処理部３２１は、導出した差の大きさをすべて積算する。そして、処理部３２１は、当該積算に係る積算値が予め設定された閾値Ｔｈ４よりも小さい時に、前記取得トルク情報は、前記比較用トルク情報と合致したことを判定する。ここで、閾値Ｔｈ４は、前記積算値が閾値Ｔｈ４より小さい時に前記取得トルク情報が前記比較用トルク情報と合致することを判定する趣旨で予め定められた前記積算値についての閾値である。 Then, the processing unit 321 integrates all the magnitudes of the derived differences. Then, the processing unit 321 determines that the acquired torque information matches the comparison torque information when the integrated value related to the integration is smaller than a preset threshold value Th4. Here, the threshold Th4 is a predetermined threshold for the integrated value for the purpose of determining that the obtained torque information matches the comparison torque information when the integrated value is smaller than the threshold Th4.
二つ目の方法を用いる場合、処理部３２１は、前記取得トルク情報及び前記第三取得トルク情報と、比較対象の前記比較用トルク情報の各々のトルクの最大値の差の和を求める。そして当該和が、閾値Ｔｈ５以下の場合に、前記取得トルク情報は、前記比較用トルク情報と合致したことを判定する。ここで、閾値Ｔｈ５は、前記最大値の差が閾値Ｔｈ５より小さい時に前記取得トルク情報が前記比較用トルク情報と合致することを判定する趣旨で予め定められた前記最大値の差の和についての閾値である。 When using the second method, the processing unit 321 obtains the sum of the difference between the maximum torque values of the acquired torque information, the third acquired torque information, and the comparison torque information to be compared. When the sum is equal to or less than the threshold Th5, it is determined that the obtained torque information matches the comparison torque information. Here, the threshold Th5 is a predetermined sum of the differences between the maximum values for the purpose of determining that the obtained torque information matches the comparison torque information when the difference between the maximum values is smaller than the threshold Th5. is the threshold.
三つ目の方法を用いる場合、処理部３２１は、前記取得トルク情報及び前記第三取得トルク情報の各々と、比較対象の前記比較用トルク情報の各々についての、トルクの最大値とトルクの最小値の絶対値との平均値、の差の大きさ（絶対値）を求める。そして比較対象同士の当該平均値の差が、閾値Ｔｈ６以下の場合に、前記取得トルク情報は、前記比較用トルク情報と合致したことを判定する。ここで、閾値Ｔｈ６は、前記平均値の差が閾値Ｔｈ６より小さい時に前記取得トルク情報が前記比較用トルク情報と合致することを判定する趣旨で予め定められた前記平均値の差の和についての閾値である。 When using the third method, the processing unit 321 calculates the maximum torque value and the minimum torque value for each of the acquired torque information and the third acquired torque information and each of the comparison torque information to be compared. Find the magnitude (absolute value) of the difference between the absolute value and the average value. Then, when the difference in the average values between the comparison targets is equal to or less than the threshold value Th6, it is determined that the acquired torque information matches the comparison torque information. Here, the threshold Th6 is a predetermined sum of the differences in the average values for the purpose of determining that the obtained torque information matches the comparison torque information when the difference in the average values is smaller than the threshold Th6. is the threshold.
Ｓ１０５－２の処理は、図１に表すツール特定部３１６が行う処理である。
The processing of S105-2 is processing performed by the
処理部３２１は、Ｓ１０５－２の処理による判定結果がｙｅｓの場合は、Ｓ１０６－２の処理を行う。 The processing unit 321 performs the processing of S106-2 when the determination result of the processing of S105-2 is yes.
一方、処理部３２１は、Ｓ１０５－２の処理による判定結果がｎｏの場合は、Ｓ１０７－２の処理を行う。 On the other hand, when the determination result of the process of S105-2 is no, the processing unit 321 performs the process of S107-2.
処理部３２１は、Ｓ１０６－２の処理を行う場合は、同処理として、Ｓ１０５－２の処理により合致することを判定した比較用トルク情報の組合せに関連付けられて記憶部３２６が保持するツールＩＤを、出力部３３１に出力させる。そして、処理部３２１は、図５に表す処理を終了する。
When performing the processing of S106-2, the processing unit 321, as the same processing, selects the tool ID held by the
処理部３２１は、Ｓ１０７－２の処理を行う場合は、同処理として、該当するツールがない旨を表す情報、出力部３３１に出力させる。そして、処理部３２１は、図７に表す処理を終了する。
When performing the processing of S107-2, the processing unit 321 causes the
図７に表すＳ１０５－２乃至Ｓ１０７－２の処理は、図８の処理により置き換えることもできる。 The processing of S105-2 to S107-2 shown in FIG. 7 can also be replaced with the processing of FIG.
図８は、図７に表すＳ１０５－２乃至Ｓ１０７－２の処理を置き換える処理を表す概念図である。 FIG. 8 is a conceptual diagram showing the process of replacing the processes of S105-2 to S107-2 shown in FIG.
処理部３２１は、図７に表すＳ１０４－２の処理の次に、Ｓ１０５ｂ－２の処理として、前記取得トルク情報と前記第三取得トルク情報との組合せに最も近い比較用トルク情報の組合せを特定する。 After the processing of S104-2 shown in FIG. 7, the processing unit 321 specifies the combination of the torque information for comparison that is closest to the combination of the acquired torque information and the third acquired torque information as the processing of S105b-2. do.
処理部３２１は、当該判定を、例えば次の三つの方法のいずれかにより行う。 The processing unit 321 makes the determination by, for example, one of the following three methods.
一つ目の方法を用いる場合、処理部３２１は、まず、角度位置０から角度がΔＡ増加するごとに前記測定情報及び前記第三取得トルク情報の各々と、各々と比較対象の前記比較用トルク情報の差の大きさ（絶対値）を、すべて導出する。ここで、角度ΔＡは、３６０度と比較して十分に小さい角度である。角度ΔＡは、例えば１度である。
In the case of using the first method, the processing unit 321 first calculates each of the measurement information and the third acquired torque information each time the angle increases by ΔA from the
そして、処理部３２１は、導出した差の大きさをすべて積算する。そして、処理部３２１は、当該積算に係る積算値が最も小さい比較用トルク情報の組合せを、最も近似したものとして特定する。 Then, the processing unit 321 integrates all the magnitudes of the derived differences. Then, the processing unit 321 identifies the combination of the comparison torque information with the smallest integrated value related to the integration as the most approximate one.
二つ目の方法を用いる場合、処理部３２１は、前記取得トルク情報及び前記第三取得トルク情報と、比較対象の前記比較用トルク情報の各々のトルクの最大値の差の和を求める。そして当該差の和が最も小さい比較用トルク情報の組合せを、最も近似したものとして特定する。 When using the second method, the processing unit 321 obtains the sum of the difference between the maximum torque values of the acquired torque information, the third acquired torque information, and the comparison torque information to be compared. Then, the combination of the comparison torque information with the smallest sum of the differences is identified as the most approximate combination.
三つ目の方法を用いる場合、処理部３２１は、前記取得トルク情報及び前記第三取得トルク情報の各々と、比較対象の前記比較用トルク情報の各々についての、トルクの最大値とトルクの最小値の絶対値との平均値、の差の大きさ（絶対値）を求める。そして比較対象同士の当該平均値の差の和が比較用トルク情報の組合せを、最も近似したものとして特定する。 When using the third method, the processing unit 321 calculates the maximum torque value and the minimum torque value for each of the acquired torque information and the third acquired torque information and each of the comparison torque information to be compared. Find the magnitude (absolute value) of the difference between the absolute value and the average value. Then, the sum of the differences in the average values of the comparison objects specifies the combination of the comparison torque information as the most approximate combination.
Ｓ１０５ｂ－２の処理は、図１に表すツール特定部３１６が行う処理である。
The processing of S105b-2 is processing performed by the
そして、処理部３２１は、Ｓ１０６ｂ－２の処理として、Ｓ１０５ｂ－２の処理により最も近似することを判定した比較用トルク情報の組合せに関連付けられて記憶部３２６が保持するツールＩＤを、出力部３３１に出力させる。そして、処理部３２１は、図５に表す処理を終了する。
［効果］
本実施形態のツール特定装置は、ツール装着部にツールを装着した状態で、ある回転軸の周りに回転させ、その回転軸周りのトルクの回転角度位置依存性と予め取得しておいたものとの合致により装着されたツールを特定し出力する。
Then, as the processing of S106b-2, the processing unit 321 outputs the tool ID held by the
[effect]
The tool identification device of the present embodiment rotates a tool attached to the tool attachment portion around a certain rotation axis, and acquires in advance the rotational angle position dependency of the torque around the rotation axis. Identifies and outputs the fitted tool by matching
前記ツール特定装置が行う上記動作を行う部分のうち、トルクの回転角度位置依存性を取得する部分と、予め取得しておいたものとの合致によりツールを特定し出力する部分以外は、ツールを装着して利用するロボット等が予め備えている。そのため、前記ツール特定装置は、前記ロボット等に、トルクの回転角度位置依存性を取得する部分と、予め取得しておいたものとの合致によりツールを特定し出力する部分を追加するだけで構成することができる。そのため、前記ツール特定装置は、前記装着部材に刻印されたバーコードを読み取る専用のバーコードリーダが不要である。このため、前記ツール特定装置は、特許文献１が開示する方法よりもコストを抑えることができる。すなわち、前記ツール特定装置は、より安価に、ロボット等に装着する工具等の特定を容易化し得る。 Among the parts that perform the above operations performed by the tool identifying device, except for the part that acquires the rotational angle position dependency of the torque and the part that specifies and outputs the tool by matching with the previously acquired information, the tool is used. A robot or the like that is worn and used is provided in advance. Therefore, the tool identification device is configured by simply adding to the robot or the like a part for acquiring the rotational angle position dependence of torque and a part for specifying and outputting the tool based on matching with previously acquired data. can do. Therefore, the tool identification device does not require a dedicated bar code reader for reading the bar code stamped on the mounting member. Therefore, the tool identification device can be made at a lower cost than the method disclosed in Patent Document 1. That is, the tool identification device can facilitate identification of a tool or the like to be attached to a robot or the like at a lower cost.
上の説明では、装着を行う部分に装着される装着物品がツールである例を説明したが、当該装着物品の種類は任意である。 In the above description, an example in which the attachment article attached to the portion to be attached is a tool has been described, but the attachment article may be of any type.
図９は、実施形態の特定装置を実現可能な情報処理装置のハードウェア構成例を表す概念図である。 FIG. 9 is a conceptual diagram showing a hardware configuration example of an information processing device that can implement the specific device of the embodiment.
情報処理装置９０は、通信インタフェース９１、入出力インタフェース９２、演算装置９３、記憶装置９４、不揮発性記憶装置９５及びドライブ装置９６を備える。
The
通信インタフェース９１は、各実施形態の特定装置が、有線あるいは／及び無線で外部装置と通信するための通信手段である。なお、特定装置を、少なくとも二つの情報処理装置を用いて実現する場合、それらの装置の間を通信インタフェース９１経由で相互に通信可能なように接続しても良い。
The
入出力インタフェース９２は、入力デバイスの一例であるキーボードや、出力デバイスとしてのディスプレイ等のマンマシンインタフェースである。
The input/
演算装置９３は、汎用のＣＰＵ（Ｃｅｎｔｒａｌ Ｐｒｏｃｅｓｓｉｎｇ Ｕｎｉｔ）やマイクロプロセッサ等の演算処理装置である。演算装置９３は、例えば、不揮発性記憶装置９５に記憶された各種プログラムを記憶装置９４に読み出し、読み出したプログラムに従って処理を実行することが可能である。
The
記憶装置９４は、演算装置９３から参照可能な、ＲＡＭ（Ｒａｎｄｏｍ Ａｃｃｅｓｓ Ｍｅｍｏｒｙ）等のメモリ装置であり、プログラムや各種データ等を記憶する。記憶装置９４は、揮発性のメモリ装置であっても良い。
The
不揮発性記憶装置９５は、例えば、ＲＯＭ（Ｒｅａｄ Ｏｎｌｙ Ｍｅｍｏｒｙ）、フラッシュメモリ、等の、不揮発性の記憶装置であり、各種プログラムやデータ等を記憶することが可能である。
The
ドライブ装置９６は、例えば、後述する記録媒体９７に対するデータの読み込みや書き込みを処理する装置である。
The
記録媒体９７は、例えば、光ディスク、光磁気ディスク、半導体フラッシュメモリ等、データを記録可能な任意の記録媒体である。
The
本発明の各実施形態は、例えば、図９に例示した情報処理装置９０により特定装置を構成し、この特定装置に対して、上記各実施形態において説明した機能を実現可能なプログラムを供給することにより実現してもよい。
In each embodiment of the present invention, for example, the
この場合、特定装置に対して供給したプログラムを、演算装置９３が実行することによって、実施形態を実現することが可能である。また、特定装置のすべてではなく、一部の機能を情報処理装置９０で構成することも可能である。
In this case, the embodiment can be realized by having the
さらに、上記プログラムを記録媒体９７に記録しておき、特定装置の出荷段階、あるいは運用段階等において、適宜上記プログラムが不揮発性記憶装置９５に格納されるよう構成してもよい。なお、この場合、上記プログラムの供給方法は、出荷前の製造段階、あるいは運用段階等において、適当な治具を利用して特定装置内にインストールする方法を採用してもよい。また、上記プログラムの供給方法は、インターネット等の通信回線を介して外部からダウンロードする方法等の一般的な手順を採用してもよい。
Further, the program may be recorded in the
なお、上述する各実施の形態は、本発明の好適な実施の形態であり、本発明の要旨を逸脱しない範囲内において種々変更実施が可能である。 The embodiments described above are preferred embodiments of the present invention, and various modifications can be made without departing from the gist of the present invention.
図１０は、実施形態の特定装置の最小限の構成を表す特定装置１００ｘの構成を表すブロック図である。 FIG. 10 is a block diagram showing the configuration of a specific device 100x representing the minimum configuration of the specific device of the embodiment.
特定装置１００ｘは、取得部３１１ｘと、出力部３１６ｘとを備える。
The specific device 100x includes an
取得部３１１ｘは、複数の種類の装着部材のうち装着された一つが、鉛直方向と異なる少なくとも一つの回転軸の周りに回転する際に発生するトルクを表す値の、前記回転角度に対する依存性を示す依存性情報を取得する。そして、取得部３１１ｘは、少なくとも一つの前記依存性情報である比較用情報については対応する前記装着部材を示す情報である識別情報とともに記録する。
The obtaining
出力部３１６ｘは、前記取得した二つの前記依存性情報が近似すると判定し、いずれか一方のみが前記比較用情報である場合に、前記識別情報を出力する。
The
特定装置１００ｘは、前記装着部材を前記回転軸の周りに回転させ、その回転軸周りの前記依存性情報と前記比較用情報との比較により、前記装着部材についての前記識別情報を出力する。 The specific device 100x rotates the mounting member about the rotation axis, and outputs the identification information about the mounting member by comparing the dependency information about the rotation axis with the comparison information.
前記回転及び前記値の導出は、前記装着部材を装着して作業を行う、一般的な多軸回転ロボット及びその制御装置等からなる作業装置により行うことができる。また、当該作業装置は前記作業を行うために取得等すべき物であり、前記出力の前提として既に取得されているものである。 The rotation and the derivation of the value can be performed by a working device including a general multi-axis rotating robot, its control device, and the like, which performs work with the mounting member attached. Further, the work device is an object to be acquired in order to perform the work, and has already been acquired as a prerequisite for the output.
従い、特定装置１００ｘは、動作の前提として既に取得している前記作業装置を用いて、取得部３１１ｘと出力部３１６ｘを追加するだけで構成することができる。そのため、特定装置１００ｘは、前記装着部材に刻印されたバーコードを読み取る専用のバーコードリーダが不要である。このため、特定装置１００ｘは、特許文献１が開示する方法よりもコストを抑えることができる。すなわち、特定装置１００ｘは、より安価に、前記作業装置に装着する工具等の特定を容易化し得る。
Therefore, the specific device 100x can be configured by simply adding the
そのため、特定装置１００ｘは、前記構成により、［発明の効果］の項に記載した効果を奏する。 Therefore, the specific device 100x has the effects described in the section [Effects of the Invention] due to the above configuration.
なお、図１０に表す特定装置１００ｘは、例えば、図１に表すツール特定装置１００である。また、取得部３１１ｘは、例えば、トルク情報生成部３１１である。また、出力部３１６ｘは、例えば、ツール特定部３１６である。また、前記依存性情報は、例えば、前述の取得トルク情報、取得トルク情報の組合せ、比較用トルク情報、又は、比較用トルク情報の組合せである。また、前記比較用情報は、例えば、前述の比較用トルク情報、又は、比較用トルク情報の組合せである。また、前記出力は、例えば、ツール特定部３１６から出力部３３１への出力、又は、出力部３３１による出力である。
The identification device 100x shown in FIG. 10 is, for example, the tool identification device 100 shown in FIG. Also, the
以上、本発明の各実施形態を説明したが、本発明は、前記した実施形態に限定されるものではなく、本発明の基本的技術的思想を逸脱しない範囲で更なる変形、置換、調整を加えることができる。例えば、各図面に示した要素の構成は、本発明の理解を助けるための一例であり、これらの図面に示した構成に限定されるものではない。 Although the embodiments of the present invention have been described above, the present invention is not limited to the above-described embodiments, and further modifications, replacements, and adjustments can be made without departing from the basic technical idea of the present invention. can be added. For example, the configuration of elements shown in each drawing is an example for helping understanding of the present invention, and the configuration is not limited to the configuration shown in these drawings.
また、前記の実施形態の一部又は全部は、以下の付記のようにも記述され得るが、以下には限られない。
（付記１）
複数の種類の装着部材のうち装着された一つが、鉛直方向と異なる少なくとも一つの回転軸の周りに回転する際に発生するトルクを表す値の、前記回転の角度に対する依存性を示す依存性情報を取得し、少なくとも一つの前記依存性情報である比較用情報については対応する前記装着部材を示す情報である識別情報とともに記録する取得部と、
前記取得した二つの前記依存性情報が近似すると判定し、いずれか一方のみが前記比較用情報である場合に、前記識別情報を出力する出力部と
を備える特定装置。
（付記２）
前記回転軸が鉛直方向に垂直である、付記１に記載された特定装置。
（付記３）
前記依存性情報が、異なる複数の前記回転軸に係るものである、付記１又は付記２に記載された特定装置。
（付記４）
前記複数が２であり、一方の前記回転軸と、他方の前記回転軸とが略直交する、付記３に記載された特定装置。
（付記５）
前記判定を、前記二つの前記依存性情報の乖離の程度を表す乖離情報により行う、付記１乃至付記４のうちのいずれか一に記載された特定装置。
（付記６）
前記判定を、前記二つの前記依存性情報の乖離の程度を表す乖離情報の、二つ以上の前記比較情報についての比較により行う、付記１乃至付記４のうちのいずれか一に記載された特定装置。
（付記７）
前記乖離情報が、前記回転に係る二以上の前記角度についての、前記二つの前記依存性情報の差の大きさの積算値である、付記５又は付記６に記載された特定装置。
（付記８）
前記乖離情報が前記二つの前記依存性情報の最大値の差である、付記５又は付記６に記載された特定装置。
（付記９）
前記乖離情報が前記二つの前記依存性情報の、最大値と最小値の大きさの平均値の差の大きさである、付記５又は付記６に記載された特定装置。
（付記１０）
前記回転及び前記値の導出が多軸回転ロボット及びその制御装置により行われる、付記１乃至付記９のうちのいずれか一に記載された特定装置。
（付記１１）
前記装着部材がツール又は工具である付記１乃至付記１０のうちのいずれか一に記載された特定装置。
（付記１２）
複数の種類の装着部材のうち装着された一つが、鉛直方向と異なる少なくとも一つの回転軸の周りに回転する際に発生するトルクを表す値の、前記回転の角度に対する依存性を示す依存性情報を取得し、少なくとも一つの前記依存性情報である比較用情報については対応する前記装着部材を示す情報である識別情報とともに記録し、
前記取得した二つの前記依存性情報が近似すると判定し、いずれか一方のみが前記比較用情報である場合に、前記識別情報を出力する
特定方法。
（付記１３）
複数の種類の装着部材のうち装着された一つが、鉛直方向と異なる少なくとも一つの回転軸の周りに回転する際に発生するトルクを表す値の、前記回転の角度に対する依存性を示す依存性情報を取得し、少なくとも一つの前記依存性情報である比較用情報については対応する前記装着部材を示す情報である識別情報とともに記録する処理と、
前記取得した二つの前記依存性情報が近似すると判定し、いずれか一方のみが前記比較用情報である場合に、前記識別情報を出力する処理と
をコンピュータに実行させる特定プログラム。
Also, part or all of the above embodiments may be described as the following additional remarks, but are not limited to the following.
(Appendix 1)
Dependency information indicating the dependence of a value representing a torque generated when one of a plurality of types of mounting members is rotated around at least one rotation axis different from the vertical direction on the angle of rotation. and records at least one piece of comparison information, which is the dependency information, together with identification information, which is information indicating the corresponding mounting member;
and an output unit that outputs the identification information when it determines that the two pieces of the obtained dependency information are similar to each other and only one of them is the comparison information.
(Appendix 2)
2. The particular apparatus of clause 1, wherein the axis of rotation is perpendicular to the vertical direction.
(Appendix 3)
3. The specific device according to appendix 1 or
(Appendix 4)
The specific device according to appendix 3, wherein the plurality is 2, and one of the rotation axes and the other rotation axis are substantially perpendicular to each other.
(Appendix 5)
4. The identifying apparatus according to any one of appendices 1 to 4, wherein the determination is performed using divergence information representing a degree of divergence between the two pieces of dependency information.
(Appendix 6)
The identification according to any one of appendices 1 to 4, wherein the determination is performed by comparing two or more of the comparison information with the divergence information representing the degree of divergence between the two pieces of the dependency information. Device.
(Appendix 7)
6. The specifying device according to appendix 5 or appendix 6, wherein the divergence information is an integrated value of magnitudes of differences between the two pieces of dependency information for two or more angles relating to the rotation.
(Appendix 8)
The specific device according to appendix 5 or appendix 6, wherein the divergence information is a difference between the maximum values of the two pieces of dependency information.
(Appendix 9)
7. The specific device according to appendix 5 or 6, wherein the divergence information is the difference between the average values of the maximum and minimum values of the two pieces of dependency information.
(Appendix 10)
10. The specific device according to any one of appendices 1 to 9, wherein the rotation and the derivation of the values are performed by a multi-axis rotary robot and its controller.
(Appendix 11)
11. The particular device of any one of clauses 1-10, wherein the mounting member is a tool or tools.
(Appendix 12)
Dependency information indicating the dependence of a value representing a torque generated when one of a plurality of types of mounting members is rotated around at least one rotation axis different from the vertical direction on the angle of rotation. and recording at least one piece of comparison information, which is the dependency information, together with identification information, which is information indicating the corresponding mounting member,
determining that the two pieces of the obtained dependency information are similar to each other, and outputting the identification information when only one of them is the comparison information.
(Appendix 13)
Dependency information indicating the dependence of a value representing a torque generated when one of a plurality of types of mounting members is rotated around at least one rotation axis different from the vertical direction on the angle of rotation. and recording at least one piece of comparison information, which is the dependency information, together with identification information, which is information indicating the corresponding mounting member;
A specific program that causes a computer to execute a process of outputting the identification information when it is determined that the two pieces of the acquired dependency information are similar and only one of them is the comparison information.
９０ 情報処理装置
９１ 通信インタフェース
９２ 入出力インタフェース
９３ 演算装置
９４ 記憶装置
９５ 不揮発性記憶装置
９６ ドライブ装置
９７ 記録媒体
１００ ツール特定装置
２００ ツール操作部
２０１ ツール装着部
２０６ 回転部
２１１、２１２、２１３、２１４、２１５、２１６、２１７ 部材
３００ 制御部
３０１ 回転制御部
３０６ トルク検出部
３１１ トルク情報生成部
３１１ｘ 取得部
３１６ ツール特定部
３２１ 処理部
３２６ 記憶部
３１６ｘ、３３１ 出力部
４０１ ツール
７０１、７０２、７０３、７０４、７０５、７０６ 回転軸
７５１ 取得トルク情報
７５６ 比較用トルク情報
８０１ 基体
９５１ 面
９９８ａ、９９８ｂ 矢印
90
Claims (9)
前記取得した二つの前記依存性情報が近似すると判定し、いずれか一方のみが前記比較用情報である場合に、前記識別情報を出力する出力部と
を備える特定装置。 showing the dependence of a value representing the torque generated when one of the plurality of mounting members mounted rotates about at least one axis of rotation perpendicular to the vertical direction, on the angle of said rotation an acquisition unit that acquires dependency information and records at least one piece of comparison information that is the dependency information together with identification information that is information that indicates the corresponding mounting member;
and an output unit that outputs the identification information when it determines that the two pieces of the obtained dependency information are similar to each other and only one of them is the comparison information.
前記取得した二つの前記依存性情報が近似すると判定し、いずれか一方のみが前記比較用情報である場合に、前記識別情報を出力する特定方法。 showing the dependence of a value representing the torque generated when one of the plurality of mounting members mounted rotates about at least one axis of rotation perpendicular to the vertical direction, on the angle of said rotation acquiring dependency information, and recording at least one piece of comparison information, which is the dependency information, together with identification information, which is information indicating the corresponding mounting member;
A specifying method for outputting the identification information when it is determined that the obtained two pieces of dependency information are similar to each other, and only one of them is the comparison information.
前記取得した二つの前記依存性情報が近似すると判定し、いずれか一方のみが前記比較用情報である場合に、前記識別情報を出力する処理と
をコンピュータに実行させる特定プログラム。 showing the dependence of a value representing the torque generated when one of the plurality of mounting members mounted rotates about at least one axis of rotation perpendicular to the vertical direction, on the angle of said rotation a process of acquiring dependency information and recording at least one piece of comparison information, which is the dependency information, together with identification information, which is information indicating the corresponding mounting member;
A specific program that causes a computer to execute a process of outputting the identification information when it is determined that the two pieces of the acquired dependency information are similar and only one of them is the comparison information.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2018175420A JP7225625B2 (en) | 2018-09-19 | 2018-09-19 | Specific device, specific method and specific program |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2018175420A JP7225625B2 (en) | 2018-09-19 | 2018-09-19 | Specific device, specific method and specific program |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2020044615A JP2020044615A (en) | 2020-03-26 |
| JP7225625B2 true JP7225625B2 (en) | 2023-02-21 |
Family
ID=69899189
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2018175420A Active JP7225625B2 (en) | 2018-09-19 | 2018-09-19 | Specific device, specific method and specific program |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP7225625B2 (en) |
Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2013052486A (en) | 2011-09-06 | 2013-03-21 | Seiko Epson Corp | Robot and robot control method |
| JP2015074074A (en) | 2013-10-11 | 2015-04-20 | ファナック株式会社 | Machine tool |
| US20170274489A1 (en) | 2014-08-15 | 2017-09-28 | Baron Investments, Llc | Data collection, transfer and feedback in working tools |
Family Cites Families (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH11188556A (en) * | 1997-12-22 | 1999-07-13 | Toshiba Mach Co Ltd | Method and device for automatic tool identification |
| JP5902901B2 (en) * | 2011-09-06 | 2016-04-13 | 東芝機械株式会社 | Main spindle for machine tools |
-
2018
- 2018-09-19 JP JP2018175420A patent/JP7225625B2/en active Active
Patent Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2013052486A (en) | 2011-09-06 | 2013-03-21 | Seiko Epson Corp | Robot and robot control method |
| JP2015074074A (en) | 2013-10-11 | 2015-04-20 | ファナック株式会社 | Machine tool |
| US20170274489A1 (en) | 2014-08-15 | 2017-09-28 | Baron Investments, Llc | Data collection, transfer and feedback in working tools |
Also Published As
| Publication number | Publication date |
|---|---|
| JP2020044615A (en) | 2020-03-26 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN105965505B (en) | Robot control method, robot device, program and recording medium | |
| JP6316858B2 (en) | Automatic measuring device for motor shaft accuracy | |
| EP3450096B1 (en) | Machine tool, method for manufacturing processed article, and processing system | |
| US20160202691A1 (en) | Method for compensating errors occurring in a production process | |
| JP7049978B2 (en) | Cutting system, machining error measuring method, and machining error measuring device | |
| CN108121294A (en) | Kinematic calibration | |
| CN1246087A (en) | Device and method for calibrating robot | |
| EP1841570A1 (en) | Device and method for calibrating the center point of tool mounted on a robot by means of a camera | |
| CN112904797A (en) | Numerical controller and control method | |
| CA2537155A1 (en) | Grinding machine with concentricity correction | |
| CN109693146B (en) | Life Estimation Device and Machine Learning Device | |
| JP5917563B2 (en) | Apparatus and method for detecting the posture of an object on a machine tool | |
| US10184774B2 (en) | Correcting apparatus and correcting method | |
| JP2010067905A (en) | Wafer alignment method and equipment | |
| US20220024049A1 (en) | Servo Motor Device, and Control Method | |
| WO2022025059A1 (en) | Robot system | |
| EP1886771B1 (en) | Rotation center point calculating method, rotation axis calculating method, program creating method, operation method, and robot apparatus | |
| JP7752945B2 (en) | Systems and methods for use in performing maintenance on turbine rotors | |
| TWI647037B (en) | Fixture correction device and method | |
| JP7225625B2 (en) | Specific device, specific method and specific program | |
| CN105881099A (en) | Method and test assembly for determining machine parameters | |
| Omodei et al. | Calibration of a measuring robot: Experimental results on a 5 DOF structure | |
| JP6234091B2 (en) | Robot apparatus and teaching point setting method | |
| US20210172719A1 (en) | Method for Determining Dimensional Properties Of a Measurement Object Using a Coordinate Measuring Machine | |
| JP6542742B2 (en) | Drill blade phase measurement device and drill blade phase measurement method |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20210816 |
|
| RD01 | Notification of change of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7421 Effective date: 20211015 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20220413 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20220510 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20220610 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20220913 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20221027 |
|
| 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: 20230110 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20230123 |
|
| R151 | Written notification of patent or utility model registration |
Ref document number: 7225625 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |