JP2020142324A - Robot device and automatic correction method - Google Patents

Robot device and automatic correction method Download PDF

Info

Publication number
JP2020142324A
JP2020142324A JP2019040678A JP2019040678A JP2020142324A JP 2020142324 A JP2020142324 A JP 2020142324A JP 2019040678 A JP2019040678 A JP 2019040678A JP 2019040678 A JP2019040678 A JP 2019040678A JP 2020142324 A JP2020142324 A JP 2020142324A
Authority
JP
Japan
Prior art keywords
robot
component
axis
force sensor
angle
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.)
Pending
Application number
JP2019040678A
Other languages
Japanese (ja)
Inventor
祥一 市岡
Shoichi Ichioka
祥一 市岡
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Mitsubishi Electric Corp
Original Assignee
Mitsubishi Electric Corp
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Mitsubishi Electric Corp filed Critical Mitsubishi Electric Corp
Priority to JP2019040678A priority Critical patent/JP2020142324A/en
Publication of JP2020142324A publication Critical patent/JP2020142324A/en
Pending legal-status Critical Current

Links

Images

Landscapes

  • Automatic Assembly (AREA)
  • Manipulator (AREA)

Abstract

To achieve a robot device configured so that a deviation of a shaft core of a component can be corrected regardless of presence or absence of chamfering of the component.SOLUTION: The robot device comprises: a robot 1; a force sensor 101 attached to a tip of the robot 1; a holding part 104, attached to the force sensor 101, which can hold a first component; a robot controller 2 that controls the robot 1 so that loads can be generated on the first component in the opposite direction of a direction in which the first component is inserted into a second component, using a measured result by the force sensor 101, when the robot 1 performs work for inserting the first component into the second component; and a calculator 3 that controls operation of the robot 1 on the basis of an operation angle, a rotation angle of the tip of the robot 1 having an in-plane shaft orthogonal to the insertion direction as a rotation shaft. The calculator 3 stops the robot 1 and rotates the tip of the robot 1 in the opposite direction of the first direction, if the operation angle in the first direction as a rotation direction exceeds an allowable rotation angle.SELECTED DRAWING: Figure 1

Description

本発明は、組立作業を行うロボット装置および自動補正方法に関する。 The present invention relates to a robot device that performs assembly work and an automatic correction method.

近年の生産現場における生産形態は、多品種少量生産から、生産機種および生産量の変化に対応可能である変種変量生産へと移行している。このような生産形態の変遷に応じて、汎用性の高い設備が求められている。汎用性の高い設備を実現するために、ロボットが多用されている。ここで言うロボットとは、予め教示された動作を再現することで動作するティーチングプレイバック式のロボット、直交するスライド軸により構成される直交ロボットなどを指す。 In recent years, the production form at production sites has shifted from high-mix low-volume production to variable-variable production that can respond to changes in production models and production volumes. In response to such changes in production forms, highly versatile equipment is required. Robots are often used to realize highly versatile equipment. The robot referred to here refers to a teaching playback type robot that operates by reproducing a motion taught in advance, an orthogonal robot composed of orthogonal slide axes, and the like.

このようなロボットは、生産現場において部品組立工程の組立作業で使用される。部品組立工程では、例えば、挿入すべき部品である挿入部品を、挿入先である相手部品へ挿入する作業が行われる。このようなロボットは、予め動作順序がプログラミングされることにより、動作位置を教示され、決められた動作を繰り返し作業する。しかし、ロボットによる部品組立作業では、ロボットが繰り返し行う作業における位置の再現性のばらつき、温度変化によるロボットおよび設備の熱膨張等の影響で、挿入部品の軸芯と相手部品の軸芯との間に位置ズレが生じ、挿入部品が相手部品に干渉することがある。以下、挿入部品の軸芯と相手部品の軸芯との間に生じるズレを、単に部品の軸芯のズレとも呼ぶ。 Such robots are used in the assembly work of the parts assembly process at the production site. In the part assembly process, for example, an insertion part, which is a part to be inserted, is inserted into a mating part, which is an insertion destination. In such a robot, the operation position is taught by programming the operation order in advance, and the determined operation is repeatedly performed. However, in the parts assembly work by the robot, there is a variation in the reproducibility of the position in the work repeatedly performed by the robot, and the thermal expansion of the robot and equipment due to the temperature change affects the distance between the axis of the inserted part and the axis of the mating part. The position of the inserted part may shift and the inserted part may interfere with the mating part. Hereinafter, the deviation that occurs between the axis of the inserted component and the axis of the mating component is also simply referred to as the deviation of the axis of the component.

挿入部品が相手部品に干渉する課題を解決するために、干渉検知と干渉回避の2つの技術が用いられる。干渉検知は、一般的に、ロボットの先端に力覚センサを取り付け、力覚センサにより検出された反力を用いて干渉の有無を検知することにより、行われる。干渉回避の方法としては、一般的に、挿入部品の角部に面取り処理を行い、挿入方向に対して斜めの方向に、干渉時の反力を発生させ、挿入方向に直交する方向に発生する反力の分力を力覚センサで検知する方法がとられる。この方法では、力覚センサにより検知された分力が小さくなるようにロボットを動かす制御プログラムをロボットコントローラに搭載しておき、ロボットコントローラが制御プログラムに基づいてロボットの動作を制御する。または、力覚センサで検知した分力を小さくするようにロボットの動作を補正するコンプライアンス機構が用いられる。 Two techniques, interference detection and interference avoidance, are used to solve the problem that the inserted component interferes with the mating component. Interference detection is generally performed by attaching a force sensor to the tip of the robot and detecting the presence or absence of interference using the reaction force detected by the force sensor. As a method of avoiding interference, generally, a chamfering process is performed on the corners of the inserted part, a reaction force at the time of interference is generated in a direction oblique to the insertion direction, and the reaction force is generated in a direction orthogonal to the insertion direction. A method of detecting the component force of the reaction force with a force sensor is adopted. In this method, a control program for moving the robot is mounted on the robot controller so that the component force detected by the force sensor is reduced, and the robot controller controls the operation of the robot based on the control program. Alternatively, a compliance mechanism that corrects the movement of the robot so as to reduce the component force detected by the force sensor is used.

例えば、特許文献1には、挿入部品と相手部品との軸芯のズレを、挿入部品を平行移動させることにより、補正する技術が開示されている。特許文献1に記載の技術では、水平多関節ロボットの先端に力覚センサを取り付け、力覚センサの下部には、ロボットが把持する挿入部品を平行移動させることが可能なリモートセンターコンプライアンス機構を取り付けている。特許文献1に記載の技術では、挿入部品または相手部品の角部を面取り加工しておき、力覚センサで反力を検知し、反力のうち挿入方法と直交する方向の分力を小さくするようにリモートセンターコンプライアンス機構により挿入部品を平行移動させることにより、部品の軸芯のズレを補正している。 For example, Patent Document 1 discloses a technique for correcting a misalignment of the axial core between an inserted part and a mating part by moving the inserted part in parallel. In the technique described in Patent Document 1, a force sensor is attached to the tip of a horizontal articulated robot, and a remote center compliance mechanism capable of translating an insertion part gripped by the robot is attached to the lower part of the force sensor. ing. In the technique described in Patent Document 1, the corners of the inserted part or the mating part are chamfered, the reaction force is detected by the force sensor, and the component force of the reaction force in the direction orthogonal to the insertion method is reduced. By moving the inserted parts in parallel by the remote center compliance mechanism, the deviation of the axis of the parts is corrected.

特開平7−241733号公報Japanese Unexamined Patent Publication No. 7-241733

しかしながら、上記特許文献1の技術では、反力の分力を用いて部品の軸芯のズレを補正しているので、挿入部品および相手部品のうち少なくとも一方の接触角部に面取り処理が施されている必要がある。このため、挿入部品にも相手部品にも、面取り処理が施されていない場合には、部品の軸芯のズレを補正することができないという問題ある。 However, in the technique of Patent Document 1, since the deviation of the axis of the component is corrected by using the component force of the reaction force, the contact angle portion of at least one of the inserted component and the mating component is chamfered. Must be. Therefore, if neither the inserted part nor the mating part is chamfered, there is a problem that the deviation of the axis of the part cannot be corrected.

本発明は、上記に鑑みてなされたものであって、部品の面取り処理の有無にかかわらず部品の軸芯のズレを補正することができるロボット装置を得ることを目的とする。 The present invention has been made in view of the above, and an object of the present invention is to obtain a robot device capable of correcting a deviation of the axis of a component regardless of the presence or absence of chamfering of the component.

上述した課題を解決し、目的を達成するために、本発明にかかるロボット装置は、ロボットと、ロボットの先端に取り付けられる力覚センサと、力覚センサに取り付けられ、第1部品を把持可能な把持部と、を備える。また、ロボット装置は、ロボットが第1部品を第2部品へ挿入する作業を行うときに、力覚センサにより計測された計測結果を用いて、第1部品の第2部品への挿入方向と逆の方向に第1部品に荷重が生じるようにロボットを制御するロボットコントローラ、を備える。さらに、ロボット装置は、挿入方向に直交する面内の軸を回転軸とするロボットの先端の回転角度である動作角度に基づいて、ロボットの動作を制御する演算器、を備える。演算器は、第1の方向を回転方向とする動作角度が許容回転角度を超えた場合に、ロボットを停止させ、ロボットを停止させた後に、ロボットの先端を第1の方向と逆まわりの方向に回転させるようにロボットを制御する。 In order to solve the above-mentioned problems and achieve the object, the robot device according to the present invention is attached to a robot, a force sensor attached to the tip of the robot, and a force sensor, and can grip the first component. It is provided with a grip portion. Further, when the robot performs the work of inserting the first component into the second component, the robot device uses the measurement result measured by the force sensor to reverse the direction of inserting the first component into the second component. A robot controller that controls the robot so that a load is generated on the first component in the direction of Further, the robot device includes an arithmetic unit that controls the operation of the robot based on the operation angle which is the rotation angle of the tip of the robot whose rotation axis is an axis in a plane orthogonal to the insertion direction. When the operating angle with the first direction as the rotation direction exceeds the allowable rotation angle, the calculator stops the robot, stops the robot, and then turns the tip of the robot in the direction opposite to the first direction. Control the robot to rotate to.

本発明によれば、部品の面取り処理の有無にかかわらず部品の軸芯のズレを補正することができるという効果を奏する。 According to the present invention, there is an effect that the deviation of the axis of the component can be corrected regardless of the presence or absence of the chamfering process of the component.

実施の形態1にかかるロボット装置の機能構成例を示す図The figure which shows the functional structure example of the robot apparatus which concerns on Embodiment 1. 実施の形態1のロボット装置の外観を模式的に示す図The figure which shows typically the appearance of the robot apparatus of Embodiment 1. 実施の形態1の処理回路の構成例を示す図The figure which shows the structural example of the processing circuit of Embodiment 1. 実施の形態1のロボット装置における部品の軸芯の自動補正処理の手順の一例を示すフローチャートA flowchart showing an example of a procedure for automatic correction processing of the axis of a component in the robot device of the first embodiment. 軸芯が平行にずれた場合の実施の形態1のロボット装置の自動補正動作の一例を示す図The figure which shows an example of the automatic correction operation of the robot apparatus of Embodiment 1 when the axis is shifted in parallel. 軸芯が平行にずれた場合の実施の形態1のロボット装置の自動補正動作の一例を示す図The figure which shows an example of the automatic correction operation of the robot apparatus of Embodiment 1 when the axis is shifted in parallel. 軸芯が平行にずれた場合の実施の形態1のロボット装置の自動補正動作の一例を示す図The figure which shows an example of the automatic correction operation of the robot apparatus of Embodiment 1 when the axis is shifted in parallel. 軸芯が平行にずれた場合の実施の形態1のロボット装置の自動補正動作の一例を示す図The figure which shows an example of the automatic correction operation of the robot apparatus of Embodiment 1 when the axis is shifted in parallel. 軸芯が傾いた場合の実施の形態1のロボット装置の自動補正動作の一例を示す図The figure which shows an example of the automatic correction operation of the robot apparatus of Embodiment 1 when the axis is tilted. 実施の形態2のロボット装置の外観を模式的に示す図The figure which shows typically the appearance of the robot apparatus of Embodiment 2.

以下に、本発明の実施の形態にかかるロボット装置および自動補正方法を図面に基づいて詳細に説明する。なお、この実施の形態によりこの発明が限定されるものではない。 The robot apparatus and the automatic correction method according to the embodiment of the present invention will be described in detail below with reference to the drawings. The present invention is not limited to this embodiment.

実施の形態1.
図1は、本発明の実施の形態1にかかるロボット装置100の機能構成例を示す図である。図2は、ロボット装置100の外観を模式的に示す図である。ロボット装置100は、図1および図2に示すように、垂直多関節ロボットであるロボット1と、ロボット1の先端に取り付けられた力覚センサ101と、力覚センサ101の下面に取り付けられたチャック駆動部102と、チャック駆動部102の下部に取り付けられ、2つを1組としたチャック103とを備える。図2では1つのチャック103に符号を付しているが、チャック駆動部102の下部には2つのチャック103が設けられている。2つのチャック103は、第1部品である挿入部品501を挟み込んで把持することが可能である。チャック駆動部102と2つのチャック103とは、挿入部品501を挟み込み、挟み込んだ状態で回転させることが可能な把持部104を構成する。ロボット装置100は、さらに、ロボット1の動作を制御するロボットコントローラ2と、ロボットコントローラ2に接続される演算器3とを備える。
Embodiment 1.
FIG. 1 is a diagram showing a functional configuration example of the robot device 100 according to the first embodiment of the present invention. FIG. 2 is a diagram schematically showing the appearance of the robot device 100. As shown in FIGS. 1 and 2, the robot device 100 includes a robot 1 which is a vertical articulated robot, a force sensor 101 attached to the tip of the robot 1, and a chuck attached to the lower surface of the force sensor 101. The drive unit 102 and the chuck 103 attached to the lower part of the chuck drive unit 102 and forming a set of the two are provided. Although one chuck 103 is coded in FIG. 2, two chucks 103 are provided below the chuck drive unit 102. The two chucks 103 can sandwich and grip the insertion component 501, which is the first component. The chuck drive unit 102 and the two chucks 103 form a grip portion 104 that sandwiches the insertion component 501 and can rotate in the sandwiched state. The robot device 100 further includes a robot controller 2 that controls the operation of the robot 1 and a calculator 3 that is connected to the robot controller 2.

ロボット装置100は、組立作業を行うことが可能である。具体的には、ロボット装置100は、挿入部品501を、挿入部品501に対応した挿入部を有する第2部品である相手部品502に、挿入することが可能である。相手部品502は、相手部品取付台503により固定されている。ここでは、相手部品502が相手部品取付台503に載置されて固定される例を説明するが、相手部品502が動きにくいものである場合などには相手部品取付台503を設けなくてもよい。 The robot device 100 can perform assembly work. Specifically, the robot device 100 can insert the insertion component 501 into the mating component 502, which is a second component having an insertion portion corresponding to the insertion component 501. The mating component 502 is fixed by the mating component mounting base 503. Here, an example in which the mating component 502 is placed and fixed on the mating component mounting base 503 will be described, but if the mating component 502 is difficult to move, the mating component mounting base 503 may not be provided. ..

図2に示すように、ロボット1とロボットコントローラ2は接続ケーブル301で接続され、力覚センサ101とロボットコントローラ2は接続ケーブル302で接続され、ロボットコントローラ2と演算器3は、接続ケーブル303で接続されている。なお、図1および図2に示した例では、演算器3を、ロボット装置100の構成要素としているが、演算器3は、ロボットコントローラ2に接続可能であればよく、ロボット装置100の外部の装置であってもよい。 As shown in FIG. 2, the robot 1 and the robot controller 2 are connected by a connection cable 301, the force sensor 101 and the robot controller 2 are connected by a connection cable 302, and the robot controller 2 and the arithmetic unit 3 are connected by a connection cable 303. It is connected. In the examples shown in FIGS. 1 and 2, the arithmetic unit 3 is a component of the robot device 100, but the arithmetic unit 3 may be connected to the robot controller 2 and is external to the robot device 100. It may be a device.

また、実施の形態では、直交座標系であるXYZ座標系を、図2に示すように、紙面の奥から手前に向かう方向をX軸のプラス方向とし、X軸に直交し、紙面の左から右に向かう方向をY軸のプラス方向とし、紙面の下から上へ向かう方向をZ軸のプラス方向として定義する。また、図2に示すように、Z軸のマイナス方向が鉛直下向きであるとする。 Further, in the embodiment, as shown in FIG. 2, the XYZ coordinate system, which is a Cartesian coordinate system, has the direction from the back to the front of the paper surface as the plus direction of the X axis, orthogonal to the X axis, and from the left side of the paper surface. The direction to the right is defined as the positive direction of the Y axis, and the direction from the bottom to the top of the paper is defined as the positive direction of the Z axis. Further, as shown in FIG. 2, it is assumed that the negative direction of the Z axis is vertically downward.

次に、ロボット装置100を構成する各構成要素の詳細について説明する。まず、垂直多関節ロボットであるロボット1について説明する。図1に示すように、ロボット1は、各軸に対応するサーボモータ11−1〜11−6を備える。図1では、ロボット1が6軸の関節を有する例を示している。ロボット1は、各軸に対応するサーボモータ11−1〜11−6によって各関節が回転することにより、ロボット1の先端の位置および姿勢を自由に変更することができる。 Next, the details of each component constituting the robot device 100 will be described. First, the robot 1 which is a vertical articulated robot will be described. As shown in FIG. 1, the robot 1 includes servomotors 11-1 to 11-6 corresponding to each axis. FIG. 1 shows an example in which the robot 1 has 6-axis joints. The robot 1 can freely change the position and posture of the tip of the robot 1 by rotating each joint by the servomotors 11-1 to 11-6 corresponding to each axis.

なお、ここでは、ロボット1は、図2に示す下方向であるマイナスZ方向を挿入方向とした部品の挿入の作業だけでなく、マイナスY方向などの水平方向を挿入方向とした部品の挿入も可能なように、すなわち汎用性を高めるために、6軸の垂直多関節ロボットを例に挙げている。しかしながら、ロボット1は、6軸の垂直多関節ロボットに限定されず、ロボット1の備える軸の数は6に限定されず、5であってもよいし、7以上であってもよい。また、部品の挿入方向が限定される場合には、ロボット1の備える軸の数は、4以下であってもよい。ロボット1は、前工程で搬送された挿入部品501をチャック103で把持し、把持した挿入部品501を、相手部品502の上方へ移動させて下降させることができ、X軸およびY軸を中心に回転する機構があれば良い。 Here, the robot 1 not only inserts parts whose insertion direction is the minus Z direction, which is the downward direction shown in FIG. 2, but also inserts parts whose insertion direction is the horizontal direction such as the minus Y direction. To make it possible, that is, to increase versatility, a 6-axis vertical articulated robot is taken as an example. However, the robot 1 is not limited to a 6-axis vertical articulated robot, and the number of axes included in the robot 1 is not limited to 6, and may be 5 or 7 or more. Further, when the insertion direction of the parts is limited, the number of axes included in the robot 1 may be 4 or less. The robot 1 can grip the insertion component 501 conveyed in the previous process with the chuck 103, move the gripped insertion component 501 upward of the mating component 502, and lower it, centering on the X-axis and the Y-axis. It suffices if there is a rotating mechanism.

次に力覚センサ101について説明する。力覚センサ101は、ロボット1の先端に作用する荷重すなわち反力とロボット1の先端のモーメントとを計測できるセンサである。力覚センサ101は、反力に関しては、挿入部品501の挿入方向の逆方向に発生する力を計測できれば良い。例えば、図2に示すように、相手部品502の上方から挿入部品501を挿入する場合、挿入方向はマイナスZ方向であるから、力覚センサ101は、反力としてプラスZ方向に発生する力を検出できれば良い。力覚センサ101は、モーメントに関しては、挿入方向に直交する平面において挿入部品501がずれる方向に対し直交する該平面内の軸を中心に発生するモーメントを検出できれば良い。例えば、図2に示すように、挿入方向がマイナスZ方向であるとき、挿入動作で挿入部品501がX軸方向(±X方向)にずれる場合、Y軸方向を中心に発生するモーメントMyが検知できればよい。力覚センサ101は、計測した荷重およびモーメントを、計測結果として接続ケーブル302を介して周期的にロボットコントローラ2へ送信する。 Next, the force sensor 101 will be described. The force sensor 101 is a sensor capable of measuring the load acting on the tip of the robot 1, that is, the reaction force and the moment of the tip of the robot 1. As for the reaction force, the force sensor 101 may measure the force generated in the direction opposite to the insertion direction of the insertion component 501. For example, as shown in FIG. 2, when the insertion component 501 is inserted from above the mating component 502, the insertion direction is the minus Z direction, so that the force sensor 101 applies a force generated in the plus Z direction as a reaction force. It is good if it can be detected. As for the moment, the force sensor 101 may detect the moment generated around the axis in the plane orthogonal to the direction in which the insertion component 501 is displaced in the plane orthogonal to the insertion direction. For example, as shown in FIG. 2, when the insertion direction is the minus Z direction and the insertion part 501 shifts in the X-axis direction (± X direction) due to the insertion operation, the moment My generated around the Y-axis direction is detected. I hope I can. The force sensor 101 periodically transmits the measured load and moment to the robot controller 2 via the connection cable 302 as the measurement result.

次にチャック駆動部102について説明する。チャック駆動部102は力覚センサ101の下面に取り付けられており、2つのチャック103を、それぞれプラスY方向とマイナスY方向に動作させることが可能な駆動部品である。チャック駆動部102は、チャック103を駆動できれば特に機構の限定はないが、例えば、圧縮エアを供給できる環境であればエアで動作するエアチャックを使用したり、モータで動作させる電動チャックを使用したりすることができる。チャック駆動部102の筐体は、アルミをはじめとした金属の材質で形成されることが望ましい。その理由として、挿入部品501が後述の相手部品502との接触時に受ける反力が、チャック103およびチャック駆動部102を介して力覚センサ101に伝わるため、樹脂部品などの弾性変形量が多い材質を筐体に用いると、挿入部品501に実際に作用している反力を力覚センサ101で正確に検知することが困難になるためである。 Next, the chuck drive unit 102 will be described. The chuck drive unit 102 is attached to the lower surface of the force sensor 101, and is a drive component capable of operating the two chucks 103 in the plus Y direction and the minus Y direction, respectively. The mechanism of the chuck drive unit 102 is not particularly limited as long as the chuck 103 can be driven. For example, in an environment where compressed air can be supplied, an air chuck that operates with air or an electric chuck that operates with a motor is used. Can be done. The housing of the chuck drive unit 102 is preferably made of a metal material such as aluminum. The reason is that the reaction force received by the insertion part 501 when it comes into contact with the mating part 502, which will be described later, is transmitted to the force sensor 101 via the chuck 103 and the chuck drive unit 102, so that a material such as a resin part having a large amount of elastic deformation This is because it becomes difficult for the force sensor 101 to accurately detect the reaction force actually acting on the insertion component 501 when the above is used for the housing.

次にチャック103について説明する。チャック103は挿入部品501を把持するための部品である。詳細には、図2に示した例では、2つのチャック103が、挿入部品501にそれぞれプラスY方向およびマイナスY方向から近づくことにより、挿入部品501を挟んで把持する。チャック103の材質はアルミなど、樹脂部品よりも弾性変形量が少ない材質が望ましい。その理由は、チャック駆動部102と同様に、挿入部品501が相手部品502との接触時に受ける反力がチャック103およびチャック駆動部102を介して荷重を検出する力覚センサ101に伝わるため、弾性変形量が多い材質にすると、挿入部品501に実際に作用している反力を力覚センサ101で正確に検知することが困難になるためである。 Next, the chuck 103 will be described. The chuck 103 is a component for gripping the insertion component 501. Specifically, in the example shown in FIG. 2, the two chucks 103 approach the insertion component 501 from the plus Y direction and the minus Y direction, respectively, thereby sandwiching and gripping the insertion component 501. The material of the chuck 103 is preferably a material such as aluminum, which has a smaller amount of elastic deformation than resin parts. The reason is that, like the chuck drive unit 102, the reaction force received by the insertion component 501 when it comes into contact with the mating component 502 is transmitted to the force sensor 101 that detects the load via the chuck 103 and the chuck drive unit 102, and thus is elastic. This is because if the material has a large amount of deformation, it becomes difficult for the force sensor 101 to accurately detect the reaction force actually acting on the insertion part 501.

チャック103と挿入部品501との接触面積について説明する。チャック103が挿入部品501を把持しているときには重力により挿入部品501に鉛直方向下向きに力が働く。また、挿入動作で挿入部品501が相手部品502と干渉した場合には、相手部品502との接触により挿入部品501は反力を受ける。これらの場合のように、挿入部品501が、力を受けると、挿入部品501がチャック103の表面を滑ることがある。挿入部品501がチャック103の表面を滑ると、挿入部品501が、X軸、Y軸またはZ軸まわりに回転したり、チャック103から脱落したりすることもある。チャック103と挿入部品501との接触面積は、上述した回転、脱落が生じないように決定されることが望ましい。また、挿入部品501と接触するチャック103の接触面には、滑り止め防止のために、図示しないウレタンゴムなどの弾性体を取り付けてもよい。ウレタンゴムなどの弾性体を取り付けることにより、挿入部品501の傷防止にもなる。ただし、弾性体が厚すぎると、上述したように、反力が弾性体の弾性変形で力覚センサ101に正確に伝わらない可能性がある。このため、力覚センサ101における反力の検知の精度に問題が生じない範囲で、挿入部品501の滑りおよび傷の発生の状況に応じて、弾性体の厚さを調整する必要がある。 The contact area between the chuck 103 and the insertion component 501 will be described. When the chuck 103 is gripping the insertion part 501, gravity exerts a force downward on the insertion part 501 in the vertical direction. Further, when the insertion part 501 interferes with the mating part 502 in the inserting operation, the inserting part 501 receives a reaction force due to the contact with the mating part 502. As in these cases, when the insertion part 501 receives a force, the insertion part 501 may slide on the surface of the chuck 103. When the insertion part 501 slides on the surface of the chuck 103, the insertion part 501 may rotate around the X-axis, the Y-axis, or the Z-axis, or may fall off from the chuck 103. It is desirable that the contact area between the chuck 103 and the insertion component 501 is determined so that the above-mentioned rotation and dropout do not occur. Further, an elastic body such as urethane rubber (not shown) may be attached to the contact surface of the chuck 103 that comes into contact with the insertion component 501 in order to prevent slipping. By attaching an elastic body such as urethane rubber, the insertion part 501 can be prevented from being scratched. However, if the elastic body is too thick, as described above, the reaction force may not be accurately transmitted to the force sensor 101 due to the elastic deformation of the elastic body. Therefore, it is necessary to adjust the thickness of the elastic body according to the situation of slippage and scratches of the insertion component 501 within a range in which the accuracy of reaction force detection by the force sensor 101 does not cause a problem.

次に、挿入部品501について説明する。挿入部品501の材質は、挿入部品501が相手部品502との接触時に受ける反力を力覚センサ101に伝えることができるものであれば、特に制約はない。挿入部品501の形状についても特に制約はないが、例えば、円柱形状、四角柱形状などとすることができる。挿入部品501の形状が円柱形状であれば、円形状の上面および下面がそれぞれプラスZ方向およびマイナスZ方向を向いた状態で、チャック103によって把持されることが望ましい。挿入部品501の形状が四角柱状であれば、特に向きに制約はないが、できれば下面が相手部品502の上面と平行となるようにチャック103により把持されているとよい。挿入部品501の下面の角部は面取りが無く、倣い面が無い形状でよいが、面取り処理がされていてもよい。 Next, the insertion component 501 will be described. The material of the insertion component 501 is not particularly limited as long as the reaction force received by the insertion component 501 when it comes into contact with the mating component 502 can be transmitted to the force sensor 101. The shape of the insertion part 501 is not particularly limited, but may be, for example, a cylindrical shape or a quadrangular prism shape. If the shape of the insertion part 501 is a cylinder, it is desirable that the insertion part 501 be gripped by the chuck 103 with the upper and lower surfaces of the circular shape facing the plus Z direction and the minus Z direction, respectively. If the shape of the insertion part 501 is a square columnar shape, the orientation is not particularly limited, but if possible, the lower surface may be gripped by the chuck 103 so as to be parallel to the upper surface of the mating part 502. The corners of the lower surface of the insertion part 501 may have no chamfering and no copying surface, but may be chamfered.

次に、相手部品502について説明する。相手部品502は挿入部品501が挿入される挿入部を有する部品である。相手部品502の挿入部は、挿入部品501が勘合するように設けられた挿入部品501の形状にあった穴であってもよいし、挿入部品501が挿入される周辺に挿入部品501が勘合するように突起が設けられた部分であってもよい。相手部品502の材質は、挿入動作時に挿入部品501に反力を発生させるものであれば、特に制約はない。なお、挿入部品501と接触する相手部品502の挿入部の上部の角は面取りが無く、倣い面が無い形状でよいが、面取り処理されていてもよい。相手部品502は、挿入部品501の挿入動作時に、反力などで動いたり、傾いたりしないように相手部品取付台503などで固定されていることが望ましい。 Next, the mating component 502 will be described. The mating component 502 is a component having an insertion portion into which the insertion component 501 is inserted. The insertion portion of the mating part 502 may be a hole in the shape of the insertion part 501 provided so that the insertion part 501 fits, or the insertion part 501 fits around the insertion part 501. It may be a portion provided with a protrusion as described above. The material of the mating component 502 is not particularly limited as long as it generates a reaction force on the insertion component 501 during the insertion operation. The upper corner of the insertion portion of the mating component 502 that comes into contact with the insertion component 501 may have a shape without chamfering and no copying surface, but may be chamfered. It is desirable that the mating component 502 is fixed by a mating component mounting base 503 or the like so as not to move or tilt due to a reaction force or the like during the insertion operation of the inserting component 501.

次に相手部品取付台503について説明する。相手部品取付台503は相手部品502が動かないように固定するための部品である。材質は、挿入動作時に挿入部品501に反力を発生できるのであれば、特に制約はない。 Next, the mating component mounting base 503 will be described. The mating component mounting base 503 is a component for fixing the mating component 502 so as not to move. The material is not particularly limited as long as it can generate a reaction force on the insertion component 501 during the insertion operation.

次に、ロボットコントローラ2について説明する。図1に示すように、ロボットコントローラ2は、動作制御部21、送受信部22および設定受付部23を備える。送受信部22は、力覚センサ101から接続ケーブル302を介して計測結果を受信し、受信した計測結果を動作制御部21へ出力する。送受信部22は、受信した計測結果を、接続ケーブル303を介して演算器3へ送信する。送受信部22は、動作制御部21から出力される後述する動作指令を、ロボット1へ接続ケーブル301を介して送信する。送受信部22は、接続ケーブル303を介して演算器3から受信した後述する指令を動作制御部21へ出力する。 Next, the robot controller 2 will be described. As shown in FIG. 1, the robot controller 2 includes an operation control unit 21, a transmission / reception unit 22, and a setting reception unit 23. The transmission / reception unit 22 receives the measurement result from the force sensor 101 via the connection cable 302, and outputs the received measurement result to the operation control unit 21. The transmission / reception unit 22 transmits the received measurement result to the arithmetic unit 3 via the connection cable 303. The transmission / reception unit 22 transmits an operation command to be described later, which is output from the operation control unit 21, to the robot 1 via the connection cable 301. The transmission / reception unit 22 outputs a command to be described later received from the arithmetic unit 3 via the connection cable 303 to the operation control unit 21.

設定受付部23は、作業者からのロボット1の動作に関する設定を行うための設定情報の入力を受け付ける。作業者からの入力として受け付けることが可能な設定情報は、一般的なロボット1の動作制御において設定可能な情報を例示することができるが、本実施の形態では、後述するように、挿入動作を行う際の、挿入部品501における荷重およびモーメントの目標値となる設定値を含む。設定受付部23は、受け付けた設定情報を動作制御部21へ出力する。設定受付部23は、キーボード、マウス、タッチパネル、ボタンなどの入力手段である。また、ロボットコントローラ2は、作業者へ情報を提示するための図示しない表示部を備えていてもよい。表示部と設定受付部23が一体化されてタッチパネルにより実現されてもよい。 The setting reception unit 23 receives input of setting information for setting the operation of the robot 1 from the operator. The setting information that can be received as input from the operator can exemplify the information that can be set in the general motion control of the robot 1. However, in the present embodiment, as will be described later, the insertion operation is performed. Includes set values that are target values for the load and moment in the insert part 501 when performing. The setting reception unit 23 outputs the received setting information to the operation control unit 21. The setting reception unit 23 is an input means such as a keyboard, a mouse, a touch panel, and a button. Further, the robot controller 2 may include a display unit (not shown) for presenting information to the operator. The display unit and the setting reception unit 23 may be integrated and realized by a touch panel.

動作制御部21は、ロボット1を制御するためのロボットプログラム、および設定受付部23から入力される設定情報に基づいて、ロボット1の先端を目標とする位置および角度とするように、ロボット1の各関節に内蔵されたサーボモータ11−1〜11−6を制御するための動作指令を生成する。動作制御部21は、生成した動作指令を、送受信部22を介してロボット1へ送信する。このようにして、動作制御部21は、ロボット1の動作を制御する。ロボット1の先端を目標とする位置および角度とするための、ロボット1の動作制御に関しては、一般的な技術を用いることができるため、詳細な説明を省略する。なお、動作制御部21は、力覚センサ101の計測結果に基づいて、挿入部品501における荷重、モーメントが、作業者により入力された上述した設定値となるように、フィードバック制御する機能を有する。さらに、動作制御部21は、サーボモータ11−1〜11−6の回転角度を検出する図示しないエンコーダによる検出結果を、送受信部22を介してエンコーダから受信し、エンコーダにより検出された回転角度を用いてフィードバック制御を行う。この場合、送受信部22は、エンコーダによる検出結果を、演算器3へ送信してもよい。また、動作制御部21は、演算器3から、送受信部22を介して受信した指令に基づいて、ロボット1を動作させる機能も有する。 The motion control unit 21 sets the target position and angle of the tip of the robot 1 based on the robot program for controlling the robot 1 and the setting information input from the setting reception unit 23. An operation command for controlling the servomotors 11-1 to 11-6 built in each joint is generated. The motion control unit 21 transmits the generated motion command to the robot 1 via the transmission / reception unit 22. In this way, the motion control unit 21 controls the motion of the robot 1. As for the motion control of the robot 1 for setting the target position and angle of the tip of the robot 1, a general technique can be used, and therefore detailed description thereof will be omitted. The motion control unit 21 has a function of feedback control based on the measurement result of the force sensor 101 so that the load and the moment in the insertion component 501 become the above-mentioned set values input by the operator. Further, the operation control unit 21 receives the detection result by the encoder (not shown) that detects the rotation angle of the servomotors 11-1 to 11-6 from the encoder via the transmission / reception unit 22, and determines the rotation angle detected by the encoder. Use to perform feedback control. In this case, the transmission / reception unit 22 may transmit the detection result by the encoder to the arithmetic unit 3. The motion control unit 21 also has a function of operating the robot 1 based on a command received from the arithmetic unit 3 via the transmission / reception unit 22.

次に、演算器3について説明する。演算器3は、ロボット1の先端の回転角度である動作角度に基づいて、ロボット1の動作を、ロボットコントローラ2を介して制御する。演算器3は、図1に示すように、送受信部31、動作角度判定部32および回転制御部33を備える。送受信部31は、接続ケーブル303を介して、ロボットコントローラ2から、力覚センサ101の計測結果を受信し、受信した計測結果を動作角度判定部32へ出力する。さらに、送受信部31は、接続ケーブル303を介して、ロボットコントローラ2から、エンコーダによる検出結果を受信し、受信した検出結果を動作角度判定部32へ出力してもよい。送受信部31は、回転制御部33から出力される指令を、接続ケーブル303を介して、ロボットコントローラ2へ送信する。 Next, the arithmetic unit 3 will be described. The arithmetic unit 3 controls the operation of the robot 1 via the robot controller 2 based on the operation angle which is the rotation angle of the tip of the robot 1. As shown in FIG. 1, the arithmetic unit 3 includes a transmission / reception unit 31, an operation angle determination unit 32, and a rotation control unit 33. The transmission / reception unit 31 receives the measurement result of the force sensor 101 from the robot controller 2 via the connection cable 303, and outputs the received measurement result to the operation angle determination unit 32. Further, the transmission / reception unit 31 may receive the detection result by the encoder from the robot controller 2 via the connection cable 303 and output the received detection result to the operation angle determination unit 32. The transmission / reception unit 31 transmits a command output from the rotation control unit 33 to the robot controller 2 via the connection cable 303.

動作角度判定部32は、ロボット1の動作角度と許容回転角度を比較し、ロボット1の動作角度が許容回転角度を超過した場合、回転制御部33へその旨を通知する。本実施の形態では、動作角度は、挿入方向に直交する面内の軸を回転軸とするロボット1の先端の回転角度である。動作角度は、例えば、以下のように算出される。ロボットコントローラ2は、ロボット1の各関節のエンコーダによる検出結果に基づいて、ロボット1の先端の角度を算出する。ロボットコントローラ2は、この算出を一定周期で繰り返し行っており、算出結果は演算器3に送信される。演算器3は、回転開始時の算出結果を回転開始角度として記憶し、ロボットコントローラ2から新たな算出結果を受信すると、受信した算出結果と回転開始角度との差を動作角度として算出する。そして、演算器3は、動作角度と許容回転角度を比較する。動作角度の算出方法はこの例に限定されない。許容回転角度は、あらかじめ定められていてもよいし、作業者により設定されてもよい。作業者により設定される場合、ロボットコントローラ2が作業者からの入力を受け付けて演算器3へ送信してもよいし、演算器3が入力手段を有して、入力手段により作業者からの入力を受け付けてもよい。 The operation angle determination unit 32 compares the operation angle of the robot 1 with the allowable rotation angle, and when the operation angle of the robot 1 exceeds the allowable rotation angle, notifies the rotation control unit 33 to that effect. In the present embodiment, the operating angle is the rotation angle of the tip of the robot 1 whose rotation axis is an in-plane axis orthogonal to the insertion direction. The operating angle is calculated, for example, as follows. The robot controller 2 calculates the angle of the tip of the robot 1 based on the detection result by the encoder of each joint of the robot 1. The robot controller 2 repeats this calculation at regular intervals, and the calculation result is transmitted to the arithmetic unit 3. The calculator 3 stores the calculation result at the start of rotation as the rotation start angle, and when a new calculation result is received from the robot controller 2, calculates the difference between the received calculation result and the rotation start angle as the operation angle. Then, the arithmetic unit 3 compares the operating angle and the allowable rotation angle. The method of calculating the operating angle is not limited to this example. The permissible rotation angle may be predetermined or may be set by the operator. When set by the operator, the robot controller 2 may receive the input from the operator and transmit it to the arithmetic unit 3, or the arithmetic unit 3 has the input means and the input from the operator is input by the input means. May be accepted.

回転制御部33は、動作角度判定部32から、ロボット1の動作角度が許容回転角度を超過したことを通知されると、後述する回転制御を実施する。 When the rotation control unit 33 is notified by the operation angle determination unit 32 that the operation angle of the robot 1 exceeds the allowable rotation angle, the rotation control unit 33 executes the rotation control described later.

ここで、ロボットコントローラ2および演算器3のハードウェア構成について説明する。ロボットコントローラ2の送受信部22、演算器3の送受信部31は、送信機および受信機であり、通信回路により実現される。ロボットコントローラ2の設定受付部23は、上述したようにキーボードなどの入力手段により実現される。 Here, the hardware configuration of the robot controller 2 and the arithmetic unit 3 will be described. The transmitter / receiver 22 of the robot controller 2 and the transmitter / receiver 31 of the arithmetic unit 3 are a transmitter and a receiver, and are realized by a communication circuit. The setting reception unit 23 of the robot controller 2 is realized by an input means such as a keyboard as described above.

ロボットコントローラ2の動作制御部21、演算器3の動作角度判定部32および回転制御部33は、処理回路により実現される。処理回路は、プロセッサを備える回路であってもよいし、専用ハードウェアであってもよい。 The operation control unit 21 of the robot controller 2, the operation angle determination unit 32 of the arithmetic unit 3, and the rotation control unit 33 are realized by a processing circuit. The processing circuit may be a circuit including a processor or dedicated hardware.

処理回路がプロセッサを備える回路である場合、処理回路は例えば図3に示した構成の処理回路である。図3は、本実施の形態の処理回路の構成例を示す図である。図3に示す処理回路400は、プロセッサ401およびメモリ402を備える。動作制御部21、動作角度判定部32および回転制御部33が、図3に示した処理回路400によって実現される場合、プロセッサ401が、メモリ402に格納されたプログラムを読み出して実行することにより、これらが実現される。すなわち、動作制御部21、動作角度判定部32および回転制御部33が図3に示した処理回路400によって実現される場合、これらの機能は、ソフトウェアであるプログラムを用いて実現される。メモリ402はプロセッサ401の作業領域としても使用される。プロセッサ401は、CPU(Central Processing Unit)等である。メモリ402は、例えば、RAM(Random Access Memory)、ROM(Read Only Memory)、フラッシュメモリー等の不揮発性または揮発性の半導体メモリ、磁気ディスク等が該当する。 When the processing circuit is a circuit including a processor, the processing circuit is, for example, a processing circuit having the configuration shown in FIG. FIG. 3 is a diagram showing a configuration example of the processing circuit of the present embodiment. The processing circuit 400 shown in FIG. 3 includes a processor 401 and a memory 402. When the operation control unit 21, the operation angle determination unit 32, and the rotation control unit 33 are realized by the processing circuit 400 shown in FIG. 3, the processor 401 reads and executes the program stored in the memory 402. These are realized. That is, when the operation control unit 21, the operation angle determination unit 32, and the rotation control unit 33 are realized by the processing circuit 400 shown in FIG. 3, these functions are realized by using a program which is software. The memory 402 is also used as a work area for the processor 401. The processor 401 is a CPU (Central Processing Unit) or the like. The memory 402 corresponds to, for example, a non-volatile or volatile semiconductor memory such as a RAM (Random Access Memory), a ROM (Read Only Memory), a flash memory, a magnetic disk, or the like.

動作制御部21、動作角度判定部32および回転制御部33を実現する処理回路が専用ハードウェアである場合、処理回路は、例えば、FPGA(Field Programmable Gate Array)、ASIC(Application Specific Integrated Circuit)である。なお、動作制御部21、動作角度判定部32および回転制御部33は、プロセッサを備える処理回路および専用ハードウェアを組み合わせて実現されてもよい。動作制御部21、動作角度判定部32および回転制御部33は、それぞれが複数の処理回路により実現されてもよい。 When the processing circuit that realizes the operation control unit 21, the operation angle determination unit 32, and the rotation control unit 33 is dedicated hardware, the processing circuit may be, for example, an FPGA (Field Programmable Gate Array) or an ASIC (Application Specific Integrated Circuit). is there. The operation control unit 21, the operation angle determination unit 32, and the rotation control unit 33 may be realized by combining a processing circuit including a processor and dedicated hardware. The operation control unit 21, the operation angle determination unit 32, and the rotation control unit 33 may each be realized by a plurality of processing circuits.

次に、本実施の形態のロボット装置100における部品の軸芯の自動補正方法について説明する。図4は、本実施の形態のロボット装置100における部品の軸芯の自動補正処理の手順の一例を示すフローチャートである。図4に示す自動補正処理は、ロボット装置100の組立作業において、チャック103が挿入部品501を挟み込み、挿入部品501が相手部品502の上方に位置するようにチャック103が移動したときに開始される。挿入部品501が相手部品502の上方に位置するようにチャック103が移動したときに開始される動作を、以下、挿入部品501を相手部品502へ挿入する作業とも呼ぶ。ロボット装置100の組立作業において、チャック103が挿入部品501を挟み込み、挿入部品501が相手部品502の上方に位置するようにチャック103が移動するまでのロボット装置100の動作は、一般的なロボット装置における動作と同様であるため、詳細な説明を省略する。 Next, a method of automatically correcting the shaft cores of the parts in the robot device 100 of the present embodiment will be described. FIG. 4 is a flowchart showing an example of a procedure for automatic correction processing of the shaft cores of parts in the robot device 100 of the present embodiment. The automatic correction process shown in FIG. 4 is started when the chuck 103 sandwiches the insertion component 501 and the chuck 103 moves so that the insertion component 501 is located above the mating component 502 in the assembly work of the robot device 100. .. The operation started when the chuck 103 moves so that the insertion component 501 is located above the mating component 502 is also hereinafter referred to as an operation of inserting the inserting component 501 into the mating component 502. In the assembly work of the robot device 100, the operation of the robot device 100 until the chuck 103 sandwiches the insertion part 501 and the chuck 103 moves so that the insertion part 501 is located above the mating part 502 is a general robot device. Since it is the same as the operation in the above, detailed description thereof will be omitted.

本実施の形態の自動補正処理は、挿入部品501を相手部品502へ挿入する作業において実行される。自動補正処理の実行中は、力覚センサ101に作用する荷重がプラスZ方向に発生するように設定され、力覚センサ101に発生するモーメントが0(ゼロ)Nmとなるように設定される。これらの荷重およびモーメントに関する設定は、上述したように、例えば、ロボットコントローラ2が、作業者から設定情報として受け付ける。また、力覚センサ101より下に取り付けられた部品、すなわちチャック駆動部102、チャック103および挿入部品501の自重および重心位置を考慮し、重力によって力覚センサ101に発生する荷重およびモーメントはあらかじめキャンセルしておく。このキャンセルは、例えば、力覚センサ101を用いるロボット1の一般的な機能であるキャリブレーション機能により実現することができる。キャリブレーション機能は、ロボット1にチャック駆動部102およびチャック103を取り付けた状態で、ロボット1によって様々な角度にチャック103を振り、その時の力覚センサ101に発生する荷重およびモーメントから、チャック駆動部102およびチャック103の重量と重心位置をロボットコントローラが推定する機能であり、この機能を用いて、重力によって力覚センサ101に発生する荷重およびモーメントはあらかじめキャンセルしておくことができる。重力によって力覚センサ101に発生する荷重およびモーメントをキャンセルする方法はこの例に限定されない。 The automatic correction process of the present embodiment is executed in the work of inserting the insertion component 501 into the mating component 502. During the execution of the automatic correction process, the load acting on the force sensor 101 is set to be generated in the plus Z direction, and the moment generated on the force sensor 101 is set to be 0 (zero) Nm. As described above, the robot controller 2 receives the settings related to these loads and moments as setting information from the operator, for example. Further, the load and moment generated in the force sensor 101 due to gravity are canceled in advance in consideration of the weight and the position of the center of gravity of the parts mounted below the force sensor 101, that is, the chuck drive unit 102, the chuck 103, and the insertion part 501. I will do it. This cancellation can be realized, for example, by a calibration function which is a general function of the robot 1 using the force sensor 101. The calibration function is performed by swinging the chuck 103 at various angles by the robot 1 with the chuck drive unit 102 and the chuck 103 attached to the robot 1, and based on the load and moment generated in the force sensor 101 at that time, the chuck drive unit. The robot controller estimates the weight and the position of the center of gravity of the 102 and the chuck 103. By using this function, the load and the moment generated in the force sensor 101 due to gravity can be canceled in advance. The method of canceling the load and the moment generated in the force sensor 101 by gravity is not limited to this example.

図4に示すように、ロボット装置100では、まず、動作角度判定部32が、ロボット1の動作角度を算出する(ステップS1)。次に、動作角度判定部32が、ロボット1の動作角度が許容回転角度を超過しているか否かを判断する(ステップS2)。 As shown in FIG. 4, in the robot device 100, first, the operation angle determination unit 32 calculates the operation angle of the robot 1 (step S1). Next, the operation angle determination unit 32 determines whether or not the operation angle of the robot 1 exceeds the allowable rotation angle (step S2).

ロボット1の動作角度が許容回転角度を超過していない場合(ステップS2 No)、処理はステップS1へ戻る。ロボット1の動作角度が許容回転角度を超過している場合(ステップS2 Yes)、ロボット装置100は、ロボット1の回転を停止させる(ステップS3)。詳細には、演算器3の動作角度判定部32が、ロボット1の動作角度が許容回転角度を超過したことを回転制御部33へ通知し、回転制御部33が、ロボット1の動作を停止させるための指令である動作停止指令を生成して送受信部31を介してロボットコントローラ2へ送信する。ロボットコントローラ2は、動作停止指令を受信すると、ロボット1の動作を停止させる。これにより、ロボット1の回転が停止する。 When the operating angle of the robot 1 does not exceed the allowable rotation angle (step S2 No), the process returns to step S1. When the operating angle of the robot 1 exceeds the allowable rotation angle (step S2 Yes), the robot device 100 stops the rotation of the robot 1 (step S3). Specifically, the operation angle determination unit 32 of the arithmetic unit 3 notifies the rotation control unit 33 that the operation angle of the robot 1 exceeds the allowable rotation angle, and the rotation control unit 33 stops the operation of the robot 1. The operation stop command, which is a command for the robot, is generated and transmitted to the robot controller 2 via the transmission / reception unit 31. When the robot controller 2 receives the operation stop command, the robot controller 2 stops the operation of the robot 1. As a result, the rotation of the robot 1 is stopped.

上述したように、ロボット1では、力覚センサ101に作用する荷重がプラスZ方向に発生するように設定され、力覚センサ101に発生するモーメントが0Nmとなるように設定されている。このため、ロボット1は、力覚センサ101により計測された計測結果に基づいて、力覚センサ101に作用する荷重が0Nの間は力覚センサ101に作用する荷重がプラスZ方向に発生するように、ロボット1の先端をマイナスZ方向に移動させ続ける。すなわち、ロボットコントローラ2は、ロボット1が挿入部品501を相手部品502へ挿入する作業を行うときに、力覚センサ101により計測された計測結果を用いて、挿入部品501の相手部品502への挿入方向と逆の方向に挿入部品501に荷重が生じかつ挿入部品501にモーメントが生じないようにロボット1を制御する。なお、ロボットコントローラ2は、挿入部品501の相手部品502への挿入方向と逆の方向に挿入部品501に荷重が生じるように制御すればよく、挿入部品501にモーメントが生じないようにロボット1を制御することは必須ではない。ロボットコントローラ2は、例えば、挿入部品501にある程度のモーメントが生じることを許容してもよい。部品の軸芯のズレ、すなわち挿入部品501の軸芯と相手部品502の軸芯とのズレが無い場合には、挿入部品501はそのまま上方から相手部品502に挿入される。 As described above, in the robot 1, the load acting on the force sensor 101 is set to be generated in the plus Z direction, and the moment generated on the force sensor 101 is set to be 0 Nm. Therefore, based on the measurement result measured by the force sensor 101, the robot 1 so that the load acting on the force sensor 101 is generated in the plus Z direction while the load acting on the force sensor 101 is 0N. In addition, the tip of the robot 1 is continuously moved in the minus Z direction. That is, when the robot 1 inserts the insertion component 501 into the mating component 502, the robot controller 2 inserts the inserting component 501 into the mating component 502 using the measurement result measured by the force sensor 101. The robot 1 is controlled so that a load is generated on the insertion component 501 and a moment is not generated on the insertion component 501 in the direction opposite to the direction. The robot controller 2 may control the insertion component 501 so that a load is generated in the direction opposite to the insertion direction of the insertion component 501 into the mating component 502, and the robot 1 is operated so that a moment is not generated in the insertion component 501. Control is not essential. The robot controller 2 may allow, for example, a certain moment to be generated in the insertion component 501. If there is no deviation of the axis of the component, that is, the axis of the insertion component 501 and the axis of the mating component 502, the insertion component 501 is directly inserted into the mating component 502 from above.

一方、後述するように、部品の軸芯のズレが生じると、挿入部品501が相手部品502と干渉することにより、挿入部品501にモーメントが働き力覚センサ101によってモーメントが計測される。ロボット1は、設定にしたがって、力覚センサ101により計測されたモーメントを0Nmとするようにロボット1の先端を回転させるように制御するものの、ロボット1の先端をマイナスZ方向に移動させる制御も継続されるためロボット1の先端は回転し続ける。本実施の形態では、ロボット1が許容回転角度を超えて回転し続けることのないように、演算器3は、ロボット1の動作角度が許容回転角度を超えると動作停止指令をロボット1へ送信することにより、ロボット1を停止させる。 On the other hand, as will be described later, when the axis of the component is displaced, the insertion component 501 interferes with the mating component 502, so that a moment acts on the insertion component 501 and the moment is measured by the force sensor 101. The robot 1 controls to rotate the tip of the robot 1 so that the moment measured by the force sensor 101 is 0 Nm according to the setting, but the control to move the tip of the robot 1 in the minus Z direction is also continued. Therefore, the tip of the robot 1 keeps rotating. In the present embodiment, the arithmetic unit 3 transmits an operation stop command to the robot 1 when the operation angle of the robot 1 exceeds the allowable rotation angle so that the robot 1 does not continue to rotate beyond the allowable rotation angle. As a result, the robot 1 is stopped.

ステップS3の後、ロボット装置100は、ロボット1を、ロボット1がそれまで回転していた方向と反対方向に回転させる(ステップS4)。詳細には、回転制御部33は、ロボット1を、ロボット1がそれまで回転していた方向と反対方向に回転させることを指示する回転指令を生成し、送受信部31を介してロボットコントローラ2へ送信する。これにより、ロボットコントローラ2は、ロボット1を反対方向に回転させるよう制御する。 After step S3, the robot device 100 rotates the robot 1 in a direction opposite to the direction in which the robot 1 has been rotating (step S4). Specifically, the rotation control unit 33 generates a rotation command instructing the robot 1 to rotate in a direction opposite to the direction in which the robot 1 has been rotating so far, and sends the robot 1 to the robot controller 2 via the transmission / reception unit 31. Send. As a result, the robot controller 2 controls the robot 1 to rotate in the opposite direction.

ロボット装置100は、挿入部品501を挿入する作業が終了したか否かを判断し(ステップS5)、作業が終了した場合(ステップS5 Yes)、自動補正処理を終了する。作業が終了していない場合(ステップS5 No)、ロボット装置100は、ステップS4の処理を繰り返す。すなわち、ロボット装置100は、ロボット1を反対方向に回転させ続ける。挿入部品501を挿入する作業が終了したか否かの判断は、ロボットコントローラ2により行われる。具体的な判断の方法は、ロボットを用いた一般的な部品の挿入動作における終了の判断と同様である。例えば、ロボットコントローラ2は、力覚センサ101により計測された荷重およびモーメントが、一定時間以上変化しなくなり、かつ、力覚センサ101により計測された荷重がプラスZ方向である場合に、挿入部品501を挿入する作業の終了と判断する。なお、図4には図示していないが、ステップS2でNoとなりステップS1が繰り返されている間に、ロボットコントローラ2が、挿入部品501を挿入する作業が終了したと判断した場合にも、同様に、自動補正処理を終了する。この場合には、自動補正処理による補正が行われずに、すなわち部品の軸芯のズレが生じずに作業が終了したことになる。 The robot device 100 determines whether or not the work of inserting the insertion component 501 is completed (step S5), and when the work is completed (step S5 Yes), the automatic correction process ends. When the work is not completed (step S5 No), the robot device 100 repeats the process of step S4. That is, the robot device 100 keeps rotating the robot 1 in the opposite direction. The robot controller 2 determines whether or not the work of inserting the insertion component 501 has been completed. The specific method of determination is the same as the determination of the end in a general component insertion operation using a robot. For example, the robot controller 2 has the insertion component 501 when the load and the moment measured by the force sensor 101 do not change for a certain period of time or more and the load measured by the force sensor 101 is in the plus Z direction. It is judged that the work of inserting is completed. Although not shown in FIG. 4, the same applies when the robot controller 2 determines that the work of inserting the insertion component 501 is completed while the result is No in step S2 and step S1 is repeated. At the end of the automatic correction process. In this case, the work is completed without the correction by the automatic correction process, that is, without the displacement of the axis of the component.

以上説明したように、本実施の形態の自動補正方法は、ロボット1が挿入部品501を相手部品502へ挿入する作業を行うときに、力覚センサ101により計測された計測結果を用いて、挿入部品501の相手部品502への挿入方向と逆の方向に挿入部品501に荷重が生じるようにロボット1を制御する第1のステップを含む。さらに、本実施の形態の自動補正方法は、ロボット1の動作角度に基づいて、ロボット1の動作を制御する第2のステップを含む。 As described above, in the automatic correction method of the present embodiment, when the robot 1 inserts the insertion part 501 into the mating part 502, the insertion is performed by using the measurement result measured by the force sensor 101. It includes a first step of controlling the robot 1 so that a load is generated on the inserted component 501 in a direction opposite to the direction in which the component 501 is inserted into the mating component 502. Further, the automatic correction method of the present embodiment includes a second step of controlling the operation of the robot 1 based on the operation angle of the robot 1.

なお、ロボット1の高さ方向すなわちZ方向の動作原点は、挿入部品501の下面、すなわち挿入部品501の相手部品502と接触する面の付近に設定することが望ましい。これにより、ロボット1は、挿入部品501の下面付近を中心に、X軸、Y軸、X軸のそれぞれの軸まわりに回転動作することができる。 It is desirable that the operating origin of the robot 1 in the height direction, that is, the Z direction is set near the lower surface of the insertion component 501, that is, the surface of the insertion component 501 in contact with the mating component 502. As a result, the robot 1 can rotate around each of the X-axis, the Y-axis, and the X-axis around the lower surface of the insertion part 501.

次に、上述した自動補正処理を、部品の軸芯のズレの具体例を挙げて説明する。部品の軸芯のズレの要因は、それぞれの部品の加工ばらつき、ロボット1の位置の誤差、ロボット1の角度の誤差、室温変化等による相手部品取付台503の熱膨張など、原因は多岐にわたる。しかし、これらの原因で発生する部品の軸芯のズレは、次の2つに分類される。
(1)軸芯が平行にずれた場合
(2)軸芯が傾いた場合
Next, the above-mentioned automatic correction process will be described with reference to specific examples of misalignment of the shaft cores of the parts. There are various causes of misalignment of the axis of the parts, such as processing variation of each part, an error of the position of the robot 1, an error of the angle of the robot 1, and a thermal expansion of the mating component mounting base 503 due to a change in room temperature. However, the misalignment of the shaft cores of the parts caused by these causes is classified into the following two types.
(1) When the shaft core is displaced in parallel (2) When the shaft core is tilted

図2に示した例では、上記の(1)は、挿入部品501の底面の中心と相手部品502の穴の中心がずれる場合に相当する。図2に示した例では、挿入部品501は、相手部品502の挿入部である穴に挿入される。挿入部品501の底面の中心を通り挿入部品501の高さ方向に延びる線を挿入部品501の軸芯とし、相手部品502の穴中心を通り相手部品502の高さ方向に延びる線を相手部品502の軸芯とする。なお、ここでは、各部品の高さ方向は、正しく挿入され各部品に誤差のない理想的な状態における挿入方向であるとする。 In the example shown in FIG. 2, the above (1) corresponds to the case where the center of the bottom surface of the insertion component 501 and the center of the hole of the mating component 502 deviate from each other. In the example shown in FIG. 2, the insertion component 501 is inserted into the hole which is the insertion portion of the mating component 502. The line extending in the height direction of the insertion part 501 passing through the center of the bottom surface of the insertion part 501 is the axis of the insertion part 501, and the line extending in the height direction of the mating part 502 passing through the center of the hole of the mating part 502 is the mating part 502. As the axis of. Here, it is assumed that the height direction of each component is the insertion direction in an ideal state where each component is inserted correctly and there is no error in each component.

図2に示した例では、上記の(2)は、挿入部品501がX軸まわりに回転することにより、挿入部品501の軸芯が相手部品502の軸芯とずれることに相当する。 In the example shown in FIG. 2, the above (2) corresponds to the rotation of the insertion component 501 around the X-axis causing the axis of the insertion component 501 to deviate from the axis of the mating component 502.

まず、上記(1)の軸芯が平行にずれた場合について図面を用いて説明する。図5から図8は、軸芯が平行にずれた場合の本実施の形態のロボット装置100の自動補正動作の一例を示す図である。まず、図5の左図に示すように、挿入部品501が相手部品502の上方に位置しており、挿入部品501が相手部品502に接触していない状態で、ロボット1は、下降すなわちマイナスZ方向への移動を開始する。これは、上述した通り、力覚センサ101にプラスZ方向に作用するようにロボット1を制御するように設定されており、力覚センサ101で計測される荷重が0Nであることから、ロボットコントローラ2が、ロボット1をマイナスZ方向へ移動させるように制御するためである。 First, the case where the axis of the above (1) is displaced in parallel will be described with reference to the drawings. 5 to 8 are diagrams showing an example of the automatic correction operation of the robot device 100 of the present embodiment when the axes are displaced in parallel. First, as shown in the left figure of FIG. 5, the robot 1 descends, that is, minus Z, in a state where the insertion part 501 is located above the mating part 502 and the inserting part 501 is not in contact with the mating part 502. Start moving in the direction. As described above, this is set to control the robot 1 so as to act on the force sensor 101 in the plus Z direction, and the load measured by the force sensor 101 is 0N, so that the robot controller This is because 2 controls the robot 1 to move in the minus Z direction.

ロボット1がそのまま下降の動作を続けると、軸芯が平行にずれているため、図5の右図に示すように、相手部品502と接触する。図5に示した例では、挿入部品501が相手部品502の穴より右側すなわちプラスY方向にずれているため、挿入部品501は、相手部品502の穴の右側の角部と接触する。このような接触602が生じると、挿入部品501は、中心より右側の接触箇所に反力を受けるため、X軸まわりモーメント+Mxが発生する。なお、X軸まわりのモーメントは、反時計まわりをプラスとする。これにより、ロボット1は、反時計まわりの回転方向601に回転する。すなわち、この例は、挿入方向はマイナスZ方向であり、挿入方向に直交する面内の軸であるX軸を回転軸としてロボット1の先端が回転する。 When the robot 1 continues the descending operation as it is, the axis is displaced in parallel, so that the robot 1 comes into contact with the mating component 502 as shown in the right figure of FIG. In the example shown in FIG. 5, since the insertion part 501 is displaced to the right side of the hole of the mating part 502, that is, in the plus Y direction, the insertion part 501 comes into contact with the right corner of the hole of the mating part 502. When such contact 602 occurs, the insertion part 501 receives a reaction force at the contact point on the right side of the center, so that a moment around the X axis + Mx is generated. The moment around the X-axis is positive counterclockwise. As a result, the robot 1 rotates in the counterclockwise rotation direction 601. That is, in this example, the insertion direction is the minus Z direction, and the tip of the robot 1 rotates around the X axis, which is an in-plane axis orthogonal to the insertion direction.

ロボット1は、反時計まわりに回転することにより、図6の左図に示すように傾く。このとき、挿入部品501は、相手部品502の接触箇所で、傾いた方向と同じ方向である滑り方向603に滑る。挿入部品501が、滑り方向603に滑ることにより、図6の右図に示すように、挿入部品501の左側の角部が、相手部品502の穴の左側の側面と接触する。このような接触604が生じた状態では、挿入部品501の右側の角部は、相手部品502の、穴の右側の角部の上に載っており、挿入部品501の左側の角部は相手部品502の穴の左側の側面に接触している。このため、この時も、+Mxのモーメントが発生している。そのため、ロボット1は、モーメントを0Nmにする動作を行うが、下降動作も行っているため、図7の左図に示すように、さらに反時計方向に回転し続ける。 By rotating counterclockwise, the robot 1 tilts as shown in the left figure of FIG. At this time, the insertion component 501 slides in the sliding direction 603, which is the same direction as the tilted direction, at the contact point of the mating component 502. As the insertion part 501 slides in the sliding direction 603, the left corner of the insertion part 501 comes into contact with the left side surface of the hole of the mating part 502, as shown in the right figure of FIG. In the state where such contact 604 occurs, the right corner of the insertion part 501 rests on the right corner of the hole of the mating part 502, and the left corner of the insertion part 501 is the mating part. It is in contact with the left side of the hole in 502. Therefore, at this time as well, a moment of + Mx is generated. Therefore, the robot 1 performs an operation of setting the moment to 0 Nm, but also performs a descending operation, so that the robot 1 continues to rotate counterclockwise as shown in the left figure of FIG.

一方、演算器3は、図4を用いて説明したように、ロボット1の動作角度が許容回転角度を超えるかどうかを判断しているため、ロボット1が反時計方向に回転し続けて動作角度が許容回転角度を超えると、図4のステップS2でYesと判断され、ロボット装置100は、ロボット1の回転を停止させる。その後、図7の右図に示すように、図4のステップS4で述べた動作により、回転方向601と反対の方向である回転方向605にロボット1が回転する。 On the other hand, as described with reference to FIG. 4, the arithmetic unit 3 determines whether or not the operating angle of the robot 1 exceeds the allowable rotation angle, so that the robot 1 continues to rotate counterclockwise and the operating angle. When exceeds the permissible rotation angle, it is determined to be Yes in step S2 of FIG. 4, and the robot device 100 stops the rotation of the robot 1. After that, as shown in the right figure of FIG. 7, the robot 1 rotates in the rotation direction 605, which is the direction opposite to the rotation direction 601 by the operation described in step S4 of FIG.

これらの動作、すなわち、ロボット1を下降させ続けることにより挿入部品501を相手部品502に押し付けて回転させ許容回転角度を超えると反対側に回転させる動作を行うことで、図8の左図に示すように、挿入部品501の軸芯と相手部品502の軸芯が一致する。軸芯が一致するため、図8の右図に示すように、ロボット1が下降することにより、挿入部品501を相手部品502に挿入することができる。 These operations, that is, the operation of pressing the insertion component 501 against the mating component 502 to rotate the robot 1 by continuing to lower it and rotating it to the opposite side when the allowable rotation angle is exceeded, as shown in the left figure of FIG. As described above, the axis of the insertion component 501 and the axis of the mating component 502 coincide with each other. Since the axes are aligned, the insertion component 501 can be inserted into the mating component 502 by lowering the robot 1 as shown in the right figure of FIG.

次に、上記(2)の軸芯が傾いた場合について図面を用いて説明する。図9は、軸芯が傾いた場合の本実施の形態のロボット装置100の自動補正動作の一例を示す図である。図9の左図に示すように、図9では、挿入部品501の軸芯が反時計まわりの方向に傾いた例を示している。(1)の軸芯が平行にずれた場合と同様に、挿入部品501が相手部品502の上方に位置しており、挿入部品501が相手部品502に接触していない状態で、ロボット1は、下降を開始する。その後、図9の右図に示すように、挿入部品501の下面の右側の角部が、相手部品502の右側の角部と接触する。このような接触606が生じると、挿入部品501は、中心より右側の接触箇所に反力を受けるため、X軸まわりモーメント+Mxが発生する。これにより、ロボット1は、反時計まわりの回転方向601に回転する。その後の、動作は、図6、図7および図8に示した動作と同様である。 Next, the case where the shaft core of the above (2) is tilted will be described with reference to the drawings. FIG. 9 is a diagram showing an example of an automatic correction operation of the robot device 100 according to the present embodiment when the axis is tilted. As shown in the left figure of FIG. 9, FIG. 9 shows an example in which the axis of the insertion component 501 is tilted in the counterclockwise direction. Similar to the case where the axes of (1) are displaced in parallel, the robot 1 is in a state where the insertion part 501 is located above the mating part 502 and the inserting part 501 is not in contact with the mating part 502. Start descending. After that, as shown in the right figure of FIG. 9, the right corner portion of the lower surface of the insertion component 501 comes into contact with the right corner portion of the mating component 502. When such contact 606 occurs, the insertion part 501 receives a reaction force at the contact point on the right side of the center, so that a moment around the X axis + Mx is generated. As a result, the robot 1 rotates in the counterclockwise rotation direction 601. Subsequent operations are similar to those shown in FIGS. 6, 7, and 8.

以上のように、(1)軸芯が平行にずれた場合、および(2)軸芯が傾いた場合のいずれの場合も、図4に示した自動補正処理により、軸芯のズレを補正して挿入部品501を相手部品502に挿入することができる。なお、図5から図9に示した例では、挿入部品501の軸芯が、相手部品502の軸芯に対して、X方向に平行にずれる例およびX軸まわりに回転する方向に傾く例を説明した。ロボット装置100の構成によっては、X方向に平行なズレとX軸まわりに回転する方向の傾きの替わりに、Y方向に平行なズレとY軸まわりに回転する方向の傾きが生じる場合がある。このような場合には、上述した説明のX軸をY軸に読み替えて、同様に、演算器3が、Y軸周りの動作角度が許容回転角度を超えた場合に、ロボット1を停止させた後に反対方向に回転させる制御を行えばよい。 As described above, in both cases (1) when the shaft cores are displaced in parallel and (2) when the shaft cores are tilted, the deviation of the shaft cores is corrected by the automatic correction process shown in FIG. The insertion component 501 can be inserted into the mating component 502. In the examples shown in FIGS. 5 to 9, the axis of the insertion component 501 is displaced parallel to the axis of the mating component 502 in the X direction and is tilted in the direction of rotation around the X axis. explained. Depending on the configuration of the robot device 100, instead of the deviation parallel to the X direction and the inclination in the direction of rotation around the X axis, the deviation parallel to the Y direction and the inclination in the direction of rotation around the Y axis may occur. In such a case, the X-axis described above is read as the Y-axis, and similarly, the arithmetic unit 3 stops the robot 1 when the operating angle around the Y-axis exceeds the allowable rotation angle. Later, control may be performed to rotate the robot in the opposite direction.

また、ロボット1として垂直多関節ロボットを用いる場合、ロボット1の動作の自由度が高い。このため、挿入部品501の軸芯が相手部品502の軸芯に対して、X方向に平行なズレとX軸まわりに回転する方向の傾きに加え、さらにY軸方向に平行にずれたり、Y軸を中心に回転した方向に傾いたりすることも考えられる。このような場合には、Y軸まわりの動作角度についても許容回転角度を設定し、演算器3が、X軸と同様に、Y軸まわりの動作角度が許容回転角度を超えた場合に、ロボット1を停止させた後に反対方向に回転させる制御を行えばよい。この場合には、X軸、Y軸のそれぞれについて独立に上述した制御を独立して実施すればよい。X軸まわりの動作角度のみが許容回転角度を超えた場合にはX軸まわりに関して上述した動作が実施され、Y軸まわりの動作角度のみが許容回転角度を超えた場合にはY軸まわりに関して上述した動作が実施され、X軸まわりおよびY軸まわりの両方の動作角度が許容回転角度を超えた場合に、X軸まわりおよびY軸まわりの両方に関して上述した動作が実施される。 Further, when a vertical articulated robot is used as the robot 1, the degree of freedom of movement of the robot 1 is high. Therefore, in addition to the deviation parallel to the axis of the mating component 502 and the inclination in the direction of rotation around the X axis, the axis of the inserted component 501 may be further displaced parallel to the Y axis, or Y. It is also conceivable to tilt in the direction of rotation around the axis. In such a case, the allowable rotation angle is also set for the operation angle around the Y-axis, and when the operation angle around the Y-axis exceeds the allowable rotation angle of the arithmetic unit 3 as in the X-axis, the robot Control may be performed to rotate 1 in the opposite direction after stopping it. In this case, the above-mentioned control may be independently performed for each of the X-axis and the Y-axis. If only the operating angle around the X-axis exceeds the allowable rotation angle, the above-mentioned operation is performed with respect to the X-axis, and if only the operating angle around the Y-axis exceeds the allowable rotation angle, the above-mentioned operation is performed with respect to the Y-axis. When the operating angles both around the X-axis and around the Y-axis exceed the permissible rotation angle, the above-mentioned operations are performed for both the X-axis and the Y-axis.

なお、以上の説明では、演算器3をロボットコントローラ2とは別に備える例を説明したが、ロボットコントローラ2が本実施の形態の演算器3の機能を有していてもよい。 In the above description, an example in which the arithmetic unit 3 is provided separately from the robot controller 2 has been described, but the robot controller 2 may have the function of the arithmetic unit 3 of the present embodiment.

以上のように、本実施の形態では、ロボットコントローラ2が、ロボット1を、挿入方向に移動させつつモーメントが打ち消されるように制御する。そして、演算器3が、ロボット1の動作角度が許容回転角度を超えた場合に、ロボット1を、停止させ、その後に反対方向に回転させるように制御するようにした。このため、部品の面取り処理の有無にかかわらず部品の軸芯のズレを補正することができる。また、本実施の形態では、上述した動作により軸芯のズレを補正するため、部品の軸芯が平行にずれた場合だけでなく、軸芯が傾いた場合であっても、部品の軸芯のズレを補正することができる。 As described above, in the present embodiment, the robot controller 2 controls the robot 1 so as to cancel the moment while moving the robot 1 in the insertion direction. Then, the arithmetic unit 3 controls the robot 1 to stop and then rotate in the opposite direction when the operating angle of the robot 1 exceeds the allowable rotation angle. Therefore, it is possible to correct the deviation of the axis of the component regardless of the presence or absence of the chamfering process of the component. Further, in the present embodiment, since the deviation of the shaft core is corrected by the above-described operation, the shaft core of the component is not only when the shaft core of the component is displaced in parallel but also when the shaft core is tilted. It is possible to correct the deviation of.

実施の形態2.
次に、本発明にかかる実施の形態2のロボット装置100の動作を説明する。本実施の形態のロボット装置100の構成は、実施の形態1と同様である。以下、実施の形態1と異なる点を主に説明し、実施の形態1と重複する説明を省略する。
Embodiment 2.
Next, the operation of the robot device 100 according to the second embodiment of the present invention will be described. The configuration of the robot device 100 of the present embodiment is the same as that of the first embodiment. Hereinafter, the points different from those of the first embodiment will be mainly described, and the description overlapping with the first embodiment will be omitted.

図10は、実施の形態2のロボット装置100の外観を模式的に示す図である。実施の形態1では、挿入部品501は、チャック103に挟まれた状態で上から下へ移動することにより、相手部品502に挿入される。すなわち、実施の形態1では、挿入部品501の挿入方向は鉛直方向であった。これに対し、本実施の形態では、挿入部品501は、図10に示すように、水平方向に移動することにより、相手部品502に挿入される。すなわち、実施の形態2では、挿入部品501の挿入方向は水平方向である。 FIG. 10 is a diagram schematically showing the appearance of the robot device 100 of the second embodiment. In the first embodiment, the insertion part 501 is inserted into the mating part 502 by moving from top to bottom while being sandwiched between the chucks 103. That is, in the first embodiment, the insertion direction of the insertion component 501 was the vertical direction. On the other hand, in the present embodiment, the insertion part 501 is inserted into the mating part 502 by moving in the horizontal direction as shown in FIG. That is, in the second embodiment, the insertion direction of the insertion component 501 is the horizontal direction.

図10に示した例のように、挿入部品501の挿入方向が水平方向である場合であっても、実施の形態1と同様の自動補正処理を実施することで、部品の軸芯のズレを補正することができる。具体的には、ロボットコントローラ2を、力覚センサ101で計測される荷重がプラスY方向の値となり力覚センサ101で計測されるモーメントが0Nmとなるようにロボット1を制御するように、設定しておく。ロボットコントローラ2は、実施の形態1のZ軸をY軸と読み替えた場合と同様の動作を行う。これにより、ロボットコントローラ2は、自動補正処理を開始すると、ロボット1をマイナスY方向に移動させる。部品の軸芯のズレにより挿入部品501と相手部品502が接触すると、ロボット1が回転を始める。ロボット1の動作角度が、許容回転角度を超えると、実施の形態1と同様に、演算器3が、ロボットコントローラ2を介して、ロボット1を、停止させその後に反対方向に回転させるように制御する。 As in the example shown in FIG. 10, even when the insertion direction of the insertion component 501 is the horizontal direction, the deviation of the axis of the component can be prevented by performing the same automatic correction process as in the first embodiment. It can be corrected. Specifically, the robot controller 2 is set to control the robot 1 so that the load measured by the force sensor 101 becomes a value in the plus Y direction and the moment measured by the force sensor 101 becomes 0 Nm. I will do it. The robot controller 2 performs the same operation as when the Z-axis of the first embodiment is read as the Y-axis. As a result, the robot controller 2 moves the robot 1 in the minus Y direction when the automatic correction process is started. When the insertion component 501 and the mating component 502 come into contact with each other due to the displacement of the axis of the component, the robot 1 starts rotating. When the operating angle of the robot 1 exceeds the allowable rotation angle, the arithmetic unit 3 controls the robot 1 via the robot controller 2 so as to stop the robot 1 and then rotate it in the opposite direction, as in the first embodiment. To do.

これにより、挿入部品501の挿入方向が水平方向であっても、実施の形態1と同様に、部品の面取り処理の有無にかかわらず部品の軸芯のズレを補正することができる。 As a result, even if the insertion direction of the insertion component 501 is the horizontal direction, the deviation of the axis of the component can be corrected regardless of the presence or absence of the chamfering process of the component, as in the first embodiment.

以上の実施の形態に示した構成は、本発明の内容の一例を示すものであり、別の公知の技術と組み合わせることも可能であるし、本発明の要旨を逸脱しない範囲で、構成の一部を省略、変更することも可能である。 The configuration shown in the above-described embodiment shows an example of the content of the present invention, can be combined with another known technique, and is one of the configurations without departing from the gist of the present invention. It is also possible to omit or change the part.

1 ロボット、2 ロボットコントローラ、3 演算器、11−1〜11−6 サーボモータ、21 動作制御部、22,31 送受信部、23 設定受付部、32 動作角度判定部、33 回転制御部、100 ロボット装置、101 力覚センサ、102 チャック駆動部、103 チャック、104 把持部、301〜303 接続ケーブル、501 挿入部品、502 相手部品、503 相手部品取付台。 1 Robot, 2 Robot controller, 3 Computer, 11-1 to 11-6 Servo motor, 21 Motion control unit, 22, 31 Transmission / reception unit, 23 Setting reception unit, 32 Operation angle determination unit, 33 Rotation control unit, 100 Robot Device, 101 force sensor, 102 chuck drive unit, 103 chuck, 104 grip unit, 301-303 connection cable, 501 insertion part, 502 mating part, 503 mating part mounting base.

Claims (3)

ロボットと、
前記ロボットの先端に取り付けられる力覚センサと、
前記力覚センサに取り付けられ、第1部品を把持可能な把持部と、
前記ロボットが前記第1部品を第2部品へ挿入する作業を行うときに、前記力覚センサにより計測された計測結果を用いて、前記第1部品の前記第2部品への挿入方向と逆の方向に前記第1部品に荷重が生じるように前記ロボットを制御するロボットコントローラと、
前記挿入方向に直交する面内の軸を回転軸とする前記ロボットの先端の回転角度である動作角度に基づいて、前記ロボットの動作を制御する演算器と、
を備え、
前記演算器は、第1の方向を回転方向とする前記動作角度が許容回転角度を超えた場合に、前記ロボットを停止させ、前記ロボットを停止させた後に、前記ロボットの先端を第1の方向と逆まわりの方向に回転させるように前記ロボットを制御することを特徴とするロボット装置。
With a robot
A force sensor attached to the tip of the robot and
A grip portion that is attached to the force sensor and can grip the first component,
When the robot inserts the first component into the second component, the measurement result measured by the force sensor is used to reverse the direction in which the first component is inserted into the second component. A robot controller that controls the robot so that a load is generated on the first component in the direction,
An arithmetic unit that controls the operation of the robot based on the operation angle, which is the rotation angle of the tip of the robot, whose rotation axis is an axis in a plane orthogonal to the insertion direction.
With
When the operating angle with the first direction as the rotation direction exceeds the allowable rotation angle, the arithmetic unit stops the robot, stops the robot, and then sets the tip of the robot in the first direction. A robot device characterized in that the robot is controlled so as to rotate in the direction opposite to that of the robot.
前記ロボットコントローラは、前記第1部品の第2部品への挿入方向と逆の方向に前記第1部品に荷重が生じかつ前記第1部品にモーメントが生じないように前記ロボットを制御することを特徴とする請求項1に記載のロボット装置。 The robot controller is characterized in that the robot is controlled so that a load is generated on the first component and a moment is not generated on the first component in a direction opposite to the direction in which the first component is inserted into the second component. The robot device according to claim 1. ロボットと、前記ロボットの先端に取り付けられる力覚センサと、前記力覚センサに取り付けられ、第1部品を把持可能な把持部と、を備えるロボット装置における前記第1部品の軸芯と前記第1部品が挿入される第2部品の軸芯とのズレを補正する自動補正方法であって、
前記ロボットが前記第1部品を第2部品へ挿入する作業を行うときに、前記力覚センサにより計測された計測結果を用いて、前記第1部品の前記第2部品への挿入方向と逆の方向に前記第1部品に荷重が生じるように前記ロボットを制御する第1のステップと、
前記挿入方向に直交する面内の軸を回転軸とする前記ロボットの先端の回転角度である動作角度に基づいて、前記ロボットの動作を制御する第2のステップと、
を含み、
前記第2のステップでは、第1の方向を回転方向とする前記動作角度が許容回転角度を超えた場合に、前記ロボットを停止させ、前記ロボットを停止させた後に、前記ロボットの先端を第1の方向と逆まわりの方向に回転させるように前記ロボットを制御することを特徴とする自動補正方法。
The axis and the first of the first component in a robot device including a robot, a force sensor attached to the tip of the robot, and a grip portion attached to the force sensor and capable of gripping the first component. It is an automatic correction method that corrects the deviation from the axis of the second part into which the part is inserted.
When the robot inserts the first component into the second component, the measurement result measured by the force sensor is used to reverse the direction in which the first component is inserted into the second component. A first step of controlling the robot so that a load is generated on the first component in the direction,
A second step of controlling the operation of the robot based on an operation angle which is a rotation angle of the tip of the robot whose rotation axis is an axis in a plane orthogonal to the insertion direction.
Including
In the second step, when the operating angle with the first direction as the rotation direction exceeds the allowable rotation angle, the robot is stopped, the robot is stopped, and then the tip of the robot is first. An automatic correction method characterized in that the robot is controlled so as to rotate in a direction opposite to that of.
JP2019040678A 2019-03-06 2019-03-06 Robot device and automatic correction method Pending JP2020142324A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2019040678A JP2020142324A (en) 2019-03-06 2019-03-06 Robot device and automatic correction method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2019040678A JP2020142324A (en) 2019-03-06 2019-03-06 Robot device and automatic correction method

Publications (1)

Publication Number Publication Date
JP2020142324A true JP2020142324A (en) 2020-09-10

Family

ID=72355283

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2019040678A Pending JP2020142324A (en) 2019-03-06 2019-03-06 Robot device and automatic correction method

Country Status (1)

Country Link
JP (1) JP2020142324A (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2021030435A (en) * 2019-08-15 2021-03-01 株式会社日立製作所 Hole search method and hole search device
CN114749887A (en) * 2021-10-12 2022-07-15 精进百思特电动(上海)有限公司 Gear assembling method and device

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2021030435A (en) * 2019-08-15 2021-03-01 株式会社日立製作所 Hole search method and hole search device
JP7026176B2 (en) 2019-08-15 2022-02-25 株式会社日立製作所 Hole search method and hole search device
CN114749887A (en) * 2021-10-12 2022-07-15 精进百思特电动(上海)有限公司 Gear assembling method and device

Similar Documents

Publication Publication Date Title
CN108942917B (en) Robot hand, robot device, method for controlling robot hand, and storage medium
US10363661B2 (en) Control device, robot, and robot system
US11465288B2 (en) Method of controlling robot
EP2547490B1 (en) Calibration of a base coordinate system for an industrial robot
US20190275678A1 (en) Robot control device, robot, robot system, and robot control method
US10864632B2 (en) Direct teaching method of robot
US20140277722A1 (en) Robot system, calibration method, and method for producing to-be-processed material
JP5321532B2 (en) Robot calibration apparatus and calibration method
US20150127141A1 (en) Robot, control device, robot system and robot control method
JPH11502776A (en) Apparatus and method for calibration of multi-axis industrial robot
JP2006318419A (en) Calibration method of parallel mechanism machine
US11679508B2 (en) Robot device controller for controlling position of robot
JP3326175B2 (en) Method and apparatus for calibrating the motion axis of an industrial robot
US11141855B2 (en) Robot system, method of controlling robot arm, recording medium, and method of manufacturing an article
JP6542629B2 (en) Positioning device and method for machining tool
JP6924563B2 (en) Positioning control device control method and positioning control device
WO2010004635A1 (en) Robot and its teaching method
JP2020142324A (en) Robot device and automatic correction method
US20240139935A1 (en) Robotic arm calibration method
US20200189102A1 (en) Robot apparatus, robot system, control method of robot apparatus, product manufacturing method using robot apparatus, and storage medium
KR102083555B1 (en) A welding robot and a welding method using the same
JP3580562B2 (en) robot
JP6896824B2 (en) Robot devices, robot systems, control methods for robot devices, manufacturing methods for articles using robot devices, information processing devices, information processing methods, control programs and recording media
JP7384653B2 (en) Control device for robot equipment that controls the position of the robot
WO2024190883A1 (en) Processing device, placement member, and program