JP2010076054A - Robot apparatus and control method of robot apparatus - Google Patents
Robot apparatus and control method of robot apparatus Download PDFInfo
- Publication number
- JP2010076054A JP2010076054A JP2008247897A JP2008247897A JP2010076054A JP 2010076054 A JP2010076054 A JP 2010076054A JP 2008247897 A JP2008247897 A JP 2008247897A JP 2008247897 A JP2008247897 A JP 2008247897A JP 2010076054 A JP2010076054 A JP 2010076054A
- Authority
- JP
- Japan
- Prior art keywords
- plane
- manipulator
- marker
- robot apparatus
- inclination
- 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.)
- Granted
Links
Images
Abstract
Description
本発明は、マニピュレータの先端にカメラを備えたロボット装置において、カメラにより取得した画像に基づいて教示を行うロボット装置及びロボット装置の制御方法に関する。 The present invention relates to a robot apparatus that includes a camera at the tip of a manipulator and that performs teaching based on an image acquired by the camera, and a method for controlling the robot apparatus.
従来、マニピュレータを備えたロボット装置が提案されている。このようなロボット装置においては、生産ラインの改造や移設などの理由により、一旦稼動させた後に設置位置の変更、あるいは、周辺の作業対象の変更が行なわれることがある。また、ロボット装置の設置位置の変更を容易にするために、マニピュレータを備えた台座を運搬可能、あるいは、自走可能としたロボット装置が提案されている。 Conventionally, a robot apparatus provided with a manipulator has been proposed. In such a robotic device, the installation position may be changed or the surrounding work target may be changed after it is once operated due to modification or relocation of the production line. Further, in order to facilitate the change of the installation position of the robot apparatus, a robot apparatus that can carry a pedestal equipped with a manipulator or can be self-propelled has been proposed.
このようなロボット装置の設置位置や周辺の作業対象を変更するには、ロボット装置や作業対象を所定の位置に設置した後、教示ペンダント等を用いて、操作者が手動によりロボット装置の位置を微調整して、ロボット装置と作業対象との位置補正を行う必要がある。このような、設置位置の変更などによる位置補正は、移動式のロボット装置(台座を運搬可能、あるいは、自走可能としたロボット装置)に限らず必要である。 In order to change the installation position of the robot device and the surrounding work target, the robot device or work target is installed at a predetermined position, and then the operator manually moves the position of the robot device using a teaching pendant or the like. It is necessary to finely adjust the position of the robot apparatus and the work target. Such position correction by changing the installation position or the like is not limited to a mobile robot apparatus (a robot apparatus capable of carrying a pedestal or capable of self-propelling).
従来、このような教示プロセスを自動化するため、特許文献1及び特許文献2には、ロボット装置に取り付けたカメラにより作業対象に設けたマーカを撮像し、画像計測によりロボット装置の位置を補正する技術が記載されている。 Conventionally, in order to automate such a teaching process, Patent Document 1 and Patent Document 2 describe a technique in which a marker provided on a work target is captured by a camera attached to a robot apparatus, and the position of the robot apparatus is corrected by image measurement. Is described.
また、特許文献3には、作業対象に対して所定の位置に設置されたキャリブレーション治具とマニピュレータの手先とが一致するように、コンプアイランス制御を用いてマニピュレータを移動制御し、このときのマニピュレータの位置に基づいてロボット装置の位置を補正する技術が記載されている。
Further, in
ところで、従来のロボット装置を設置するにあたっての位置補正において、これを手動により行う場合には、補正の精度が操作者の技量に左右されてしまい、正確な位置補正を行うには、操作者の熟練を要し、困難である。 By the way, in the position correction when installing the conventional robot apparatus, when this is performed manually, the accuracy of the correction depends on the skill of the operator. It requires skill and is difficult.
また、カメラにより作業対象に設けたマーカを撮像し、画像計測によりロボット装置の位置を補正する場合には、カメラの光軸方向(奥行き)と計測面の傾きに対する計測精度が低く、カメラとマーカとの距離と傾きを正確に計測することができないため、ロボット装置の位置を正確に補正できない虞がある。 In addition, when a marker provided on a work target is imaged by a camera and the position of the robot apparatus is corrected by image measurement, the measurement accuracy with respect to the optical axis direction (depth) of the camera and the tilt of the measurement surface is low. Since the distance and inclination cannot be measured accurately, the position of the robot apparatus may not be accurately corrected.
また、コンプアイランス制御を用いてマニピュレータを移動制御してキャリブレーション治具とマニピュレータの手先とを一致させることによりロボット装置の位置を補正する場合には、キャリブレーション治具と手先とを接触させることが必要であるため、キャリブレーション治具の大きさにより、補正可能なずれの大きさが決定される。そのため、ロボット装置の設置位置が所定の位置から大きくずれているときには、キャリブレーション治具と手先とが接触できなくなり、位置の補正が不可能となる。 In addition, when correcting the position of the robot apparatus by moving the manipulator using the compliance control to match the calibration jig and the hand of the manipulator, the calibration jig and the hand are brought into contact with each other. Therefore, the size of the shift that can be corrected is determined by the size of the calibration jig. Therefore, when the installation position of the robot apparatus is greatly deviated from a predetermined position, the calibration jig and the hand cannot be contacted, and the position cannot be corrected.
そこで、本発明は、前記の実情に鑑みてなされたものであり、その目的は、所定の位置に設置した後の位置補正(微調整)を自動的に行うことができるロボット装置であって、操作者の熟練を要せず、作業対象との距離や作業対象の傾きについても正確に補正することができ、また、ロボット装置の設置位置の所定の位置からのずれが、コンプアイランス制御を用いる手法に比べて大きいときにも位置補正を行うことができるロボット装置及びロボット装置の制御方法を提供することにある。 Therefore, the present invention has been made in view of the above circumstances, the purpose of which is a robot apparatus that can automatically perform position correction (fine adjustment) after installation at a predetermined position, The operator's skill is not required, the distance to the work target and the tilt of the work target can be accurately corrected, and the deviation of the installation position of the robot apparatus from the predetermined position can be controlled by the compliance control. It is an object of the present invention to provide a robot apparatus and a robot apparatus control method capable of performing position correction even when the method is larger than the technique used.
前述の課題を解決し、前記目的を達成するため、本発明に係るロボット装置は、以下の構成を有するものである。 In order to solve the above-described problems and achieve the above object, a robot apparatus according to the present invention has the following configuration.
〔構成1〕
6自由度以上のマニピュレータを有しマニピュレータの手先位置に撮像手段を有するロボット装置であって、マニピュレータの動作を制御する制御手段を備え、制御手段は、初期動作として、作業対象が設置される平面と同一平面上にあり、かつ、一直線上にない少なくとも3箇所の接触点に対してマニピュレータの手先を接触させ3箇所以上の接触点の位置を検出し、3箇所以上の接触点の位置に基づいて平面の傾き及び高さ位置を計測し、撮像手段の光軸を平面に対して垂直として撮像手段により平面上に設けられたマーカを撮像し、撮像手段により撮像されたマーカの画像を画像処理してマーカの平面上における位置及び回転方向を計測しておき、次に、制御手段は、平面の傾き及び高さ位置と平面上におけるマーカの位置及び回転方向に基づいて、マニピュレータを制御することを特徴とするものである。
[Configuration 1]
A robot apparatus having a manipulator having six degrees of freedom or more and having an imaging means at a hand position of the manipulator, comprising a control means for controlling the operation of the manipulator, and the control means is a plane on which a work target is installed as an initial action. Is based on the positions of the three or more contact points by detecting the positions of the three or more contact points by bringing the hand of the manipulator into contact with at least three contact points that are on the same plane and not on a straight line. Measuring the inclination and height position of the plane, imaging the marker provided on the plane by the imaging means with the optical axis of the imaging means perpendicular to the plane, and processing the image of the marker imaged by the imaging means Then, the position and direction of rotation of the marker on the plane are measured, and then the control means determines the inclination and height position of the plane and the position and rotation method of the marker on the plane. Based on, it is characterized in that for controlling the manipulator.
また、本発明に係るロボット装置の制御方法は、以下の構成を有するものである。 The robot apparatus control method according to the present invention has the following configuration.
〔構成2〕
6自由度以上のマニピュレータを有しマニピュレータの手先位置に撮像手段を有するロボット装置の制御方法であって、作業対象が設置される平面と同一平面上にあり、かつ、一直線上にない少なくとも3箇所の接触点に対してマニピュレータの手先を接触させ3箇所以上の接触点の位置を検出し、3箇所以上の接触点の位置に基づいて平面の傾き及び高さ位置を計測し、撮像手段の光軸を平面に対して垂直としてこの撮像手段により平面上に設けられたマーカを撮像し、撮像手段により撮像されたマーカの画像を画像処理してマーカの平面上における位置及び回転方向を計測しておき、次に、平面の傾き及び高さ位置と平面上におけるマーカの位置及び回転方向に基づいて、マニピュレータを制御することを特徴とするものである。
[Configuration 2]
A control method of a robot apparatus having a manipulator having 6 degrees of freedom or more and having an imaging means at a hand position of the manipulator, wherein the control object is on the same plane as the work target is installed and is not in a straight line The position of three or more contact points is detected by touching the contact point of the manipulator, and the inclination and height position of the plane are measured based on the positions of the three or more contact points, and the light of the imaging means A marker provided on the plane is imaged by this imaging means with the axis perpendicular to the plane, the marker image imaged by the imaging means is image-processed, and the position and rotation direction of the marker on the plane are measured. Next, the manipulator is controlled on the basis of the inclination and height position of the plane and the position and rotation direction of the marker on the plane.
本発明に係るロボット装置において、制御手段は、初期動作として、作業対象が設置される平面と同一平面上にあり、かつ、一直線上にない少なくとも3箇所の接触点に対してマニピュレータの手先を接触させ3箇所以上の接触点の位置を検出し、3箇所以上の接触点の位置に基づいて平面の傾き及び高さ位置を計測し、マニピュレータの手先位置の撮像手段の光軸を平面に対して垂直として撮像手段により平面上に設けられたマーカを撮像し、撮像手段により撮像されたマーカの画像を画像処理してマーカの平面上における位置及び回転方向を計測しておき、次に、制御手段は、平面の傾き及び高さ位置と平面上におけるマーカの位置及び回転方向に基づいて、マニピュレータを制御する。 In the robot apparatus according to the present invention, as an initial operation, the control means contacts the hand of the manipulator with at least three contact points that are on the same plane as the work target and are not in a straight line. The position of three or more contact points is detected, the inclination and height position of the plane are measured based on the positions of the three or more contact points, and the optical axis of the imaging means at the hand position of the manipulator with respect to the plane The marker provided on the plane is imaged vertically by the imaging unit, the marker image captured by the imaging unit is image-processed to measure the position and rotation direction of the marker on the plane, and then the control unit Controls the manipulator based on the inclination and height position of the plane and the position and rotation direction of the marker on the plane.
したがって、本発明に係るロボット装置においては、マニピュレータの手先と作業対象が設置される平面と同一平面上にある接触点との接触を検知し、撮像手段により平面状に設けられたマーカを撮影するとこにより、ロボット装置の位置の補正を自動的に行うことができる。 Therefore, in the robot apparatus according to the present invention, the contact between the hand of the manipulator and the contact point on the same plane as the plane on which the work target is installed is detected, and the marker provided in a planar shape is photographed by the imaging means. Thus, the position of the robot apparatus can be automatically corrected.
作業対象が設置される平面の傾き及び高さの計測については、十分な面積を有する平面上の任意の接触点に手先を接触させればよいため、従来のようにキャリブレーション治具に手先を接触させる場合に比較して、ロボット装置の設置位置の所定位置からのずれ量が大きい場合でも、位置の補正が可能である。 For measuring the inclination and height of the plane on which the work target is installed, it is only necessary to bring the hand into contact with an arbitrary contact point on a plane having a sufficient area. The position can be corrected even when the amount of deviation of the installation position of the robot apparatus from the predetermined position is larger than in the case of contact.
また、このロボット装置においては、撮像手段によるマーカの撮像は、撮像手段の光軸を平面に対して垂直として行うため、2次元画像処理を適用できるため、マーカの平面上における位置及び回転方向の計測を、高速、かつ、高精度に行うことが可能である。 In this robot apparatus, since the imaging of the marker by the imaging unit is performed with the optical axis of the imaging unit being perpendicular to the plane, two-dimensional image processing can be applied, so the position and rotational direction of the marker on the plane can be applied. Measurement can be performed at high speed and with high accuracy.
さらに、このロボット装置においては、平面の傾きの計測プロセスと、マーカの平面上における位置及び回転方向の計測プロセスとを分離して行うことができるので、それぞれを高速、かつ、高精度に行うことが可能である。 Furthermore, in this robot apparatus, the measurement process of the inclination of the plane and the measurement process of the position and rotation direction of the marker on the plane can be performed separately, so that each is performed at high speed and with high accuracy. Is possible.
すなわち、本発明は、所定の位置に設置した後の位置補正(微調整)を自動的に行うことができるロボット装置であって、操作者の熟練を要せず、作業対象との距離や作業対象の傾きについても正確に補正することができ、また、ロボット装置の設置位置の所定の位置からのずれが、コンプアイランス制御を用いる手法に比べて大きいときにも位置補正を行うことができるロボット装置及びロボット装置の制御方法を提供することができるものである。 That is, the present invention is a robot apparatus capable of automatically performing position correction (fine adjustment) after being installed at a predetermined position, and does not require operator skill, and is a distance to a work target or work The tilt of the object can be corrected accurately, and the position correction can be performed even when the deviation of the installation position of the robot apparatus from the predetermined position is larger than the method using the compliance control. A robot apparatus and a control method of the robot apparatus can be provided.
以下、本発明を実施するための最良の形態について図面を参照して説明する。 The best mode for carrying out the present invention will be described below with reference to the drawings.
〔ロボット装置の構成〕
図1は、本発明に係るロボット装置の構成を示す模式的な側面図である。
[Robot device configuration]
FIG. 1 is a schematic side view showing a configuration of a robot apparatus according to the present invention.
本発明に係るロボット装置は、図1に示すように、ロボット基台部4と、このロボット基台部4上に設置されたマニピュレータ1とを有し、このマニピュレータ1により、作業対象101の把持、運搬、加工及び他の部材への組立などの操作が可能となされているものである。
As shown in FIG. 1, the robot apparatus according to the present invention includes a robot base portion 4 and a manipulator 1 installed on the robot base portion 4, and the manipulator 1 holds a
作業対象101は、作業台104、または、周辺装置(工作機械など)上の平面102に載置されている。この平面102は、マニピュレータ1のロボット基台部4とは独立している。
The
マニピュレータ1は、複数のアクチュエータ(駆動装置)とリンク(剛体の構造物)とによって構成されており、6自由度を有している。すなわち、各リンク間は、回動(屈曲)、または、旋回可能な関節2a,2b,2c,2d,2e,2fを介して接続されており、それぞれアクチュエータによって相対駆動されるようになっている。各アクチュエータは、制御手段となるコンピュータ3によって制御される。
The manipulator 1 is composed of a plurality of actuators (driving devices) and links (rigid structures), and has six degrees of freedom. That is, the links are connected via
このマニピュレータ1において、第1のリンク(基端部のリンク)1aは、ロボット基台部4に対し、基端側を第1の関節2aを介して接続されて設置されている。第1の関節2aは、鉛直軸(z軸)回りに旋回可能な関節である。この第1のリンク1aの先端側には、第2の関節2bを介して、第2のリンク1bの基端側が接続されている。第2の関節2bは、水平な軸回りに第2のリンク1bを回動可能とする関節である。第2のリンク1bの先端側には、第3の関節2cを介して、第3のリンク1cの基端側が接続されている。第3の関節2cは、水平な軸回りに第3のリンク1cを回動可能とする関節である。
In the manipulator 1, the first link (link at the base end) 1 a is installed with the base end side connected to the robot base portion 4 via the
そして、第3のリンク1cの先端側には、第4の関節2dを介して、第4のリンク1dの基端側が接続されている。第4の関節2dは、第3のリンク1cの軸回りに第4のリンク1dを旋回可能とする関節である。第4のリンク1dの先端側には、第5の関節2eを介して、第5のリンク1eの基端側が接続されている。第5の関節2eは、第4のリンク1dの軸に直交する軸回りに第5のリンク1eを回動可能とする関節である。第5のリンク1eの先端側には、第6の関節2fを介して、第6のリンク1fの基端側が接続されている。第6の関節2fは、第5のリンク1eの軸回りに第6のリンク1fを旋回可能とする関節である。
And the base end side of the
このように、マニピュレータ1においては、回動可能な関節と、旋回可能な関節とが、交互に計6個設けられていることにより、6自由度が確保されている。 As described above, in the manipulator 1, a total of six joints that can rotate and pivotable joints are alternately provided, so that six degrees of freedom are secured.
第6のリンク1fの先端側(以下、「手先」という。)には、作業対象101を把持したり加工したりする先端ツール機構5が設けられている。この先端ツール機構5は、コンピュータ3や図示しないその他の制御装置によって制御される。また、手先の近傍には、撮像レンズ及びCCD(固体撮像素子)からなる撮像手段となるカメラ6が取付けられている。
A tip tool mechanism 5 that grips and processes the
また、マニピュレータ1の手先には、接触検出手段7が設けられている。この接触検出手段7としては、タッチセンサやリミットスイッチのような接触検知スイッチが考えられ、また、歪ゲージや力覚センサ等により、手先力を計測して検知する機構であってもよい。 Further, a contact detection means 7 is provided at the hand of the manipulator 1. The contact detection means 7 may be a contact detection switch such as a touch sensor or a limit switch, or may be a mechanism that measures and detects the hand force with a strain gauge, a force sensor, or the like.
コンピュータ3は、画像処理部3aを有しており、カメラ6から送られる画像信号から対象部品101の形状を抽出し、この形状と、予め記憶された画像データ及び数値データとを照合する。また、コンピュータ3は、動作指令生成部3bを有している。この動作指令生成部3bは、画像処理部3aにおけるデータの照合結果に応じて、マニピュレータ1の各アクチュエータに対する動作指令信号を生成し、各アクチュエータに送る。
The
そして、マニピュレータ1においては、第1のリンク1aに対する第2のリンク1bの位置、第2のリンク1bに対する第3のリンク1cの位置、第3のリンク1cに対する第4のリンク1dの位置と、順次先端側のリンクの位置が制御されることにより、手先の位置が制御され、この手先において先端ツール機構5によって把持したワークを所定の位置に搬送することができる。
In the manipulator 1, the position of the
そして、このロボット装置においては、以下に示す本発明に係るロボット装置の制御方法が実行されることにより、カメラ6のレンズの光軸に対して作業対象101の計測面が垂直となるように、マニピュレータ1が自動制御される。
And in this robot apparatus, the measurement surface of the
図2は、本発明に係るロボット装置の構成を示す斜視図である。 FIG. 2 is a perspective view showing the configuration of the robot apparatus according to the present invention.
このロボット装置は、図2に示すように、作業対象101が載置される作業台の近傍などの所定の位置に大まかに設置されると、初期動作として、位置補正を自動的に行う。すなわち、コンピュータ3は、マニピュレータ1を制御して、作業対象101が設置された平面102と同一平面上にあり、かつ、一直線上にない少なくとも3箇所102a,102b,102cの接触点に対して、マニピュレータ1の手先を接触させ、各接触点102a,102b,102cの位置を検出する。この平面102は、実在するひとつながりの平面である必要はなく、作業対象101の載置部及び各接触点102a,102b,102cを通る仮想平面であってもよい。このとき、コンピュータ3は、接触検出手段7により、手先と各接触点102a,102b,102cとの接触を検出し、各接触点102a,102b,102cの位置を検出する。
As shown in FIG. 2, when the robot apparatus is roughly installed at a predetermined position such as the vicinity of a work table on which the
次に、コンピュータ3は、3箇所以上の接触点102a,102b,102cの位置に基づいて、平面102の傾き及び高さ位置を計測する。
Next, the
そして、コンピュータ3は、カメラ6のレンズの光軸を平面102に対して垂直として、このカメラ6により、平面102上に設けられたマーカ103を撮像する。このマーカ103は、平面102に垂直な方向から撮像した場合の形状が予め記憶されており、また、作業対象101に対する相対位置が、予め設定され記憶された所定の位置となっている。なお、このマーカ103は、作業対象101そのものであってもよい。
Then, the
次に、コンピュータ3は、カメラ6により撮像されたマーカ103の画像を画像処理して、マーカ103の平面102上における位置及び回転方向を計測する。コンピュータ3は、ここまでの動作を初期動作として自動的に行い、計測された平面102の傾き及び高さ位置と、この平面102上におけるマーカ103の位置及び回転方向に基づいて、作業対象101の位置を算出できる状態となる。
Next, the
そして、コンピュータ3は、平面102の傾き及び高さ位置と平面102上におけるマーカ103の位置及び回転方向に基づいて、作業対象101の位置を算出し、マニピュレータ1を制御して、作業対象101に対する作業を実行する。
Then, the
図3は、本発明に係るロボット装置の動作を示すフローチャートである。 FIG. 3 is a flowchart showing the operation of the robot apparatus according to the present invention.
すなわち、このロボット装置は、図3のフローチャートに示すように、ステップst1で位置補正を開始すると、ステップst2に進み、平面102上の一つの接触点に向けてマニピュレータ1の手先を移動させる。次に、ステップst3に進み、マニピュレータ1の手先が接触点に接触したことを検出し、ステップst4に進む。ステップst4では、接触点に接触した手先の位置(座標)を接触点の位置(座標)として記憶する。
That is, as shown in the flowchart of FIG. 3, when starting position correction in step st1, the robot apparatus proceeds to step st2 and moves the hand of the manipulator 1 toward one contact point on the
次に、ステップst5に進み、3箇所以上の接触点の位置(座標)を記憶したか否かを判別し、3箇所以上の接触点の位置(座標)を記憶していればステップst6に進み、3箇所以上の接触点の位置(座標)を記憶していなければステップst2に戻る。 Next, the process proceeds to step st5, and it is determined whether or not the positions (coordinates) of three or more contact points are stored. If the positions (coordinates) of three or more contact points are stored, the process proceeds to step st6. If the positions (coordinates) of three or more contact points are not stored, the process returns to step st2.
ステップst6では、3箇所の接触点の位置(座標)に基づいて、平面102の高さ位置及び傾きを算出し、ステップst7に進む。ステップst7では、カメラ6のレンズの光軸を平面102に対して垂直とし、ステップst8に進む。ステップst8では、カメラ6により、平面102上のマーカ103を撮像し、ステップst9に進む。ステップst9では、撮像されたマーカ103の画像に基づいて、平面102上におけるマーカ103の位置及び回転方向を算出し、ステップst10に進む。
In step st6, the height position and inclination of the
ステップst10では、計測された平面102の傾き及び高さ位置と、この平面102上におけるマーカ103の位置及び回転方向に基づいて、作業対象101の位置を算出すし、ステップst11に進む。ステップst11では、位置補正を終了する。
In step st10, the position of the
このようにして位置補正が完了した状態においては、このロボット装置は、作業対象101の位置を正確に認識しているので、この作業対象101に対するマニピュレータ1による作業を行うことができる。
Since the robot apparatus accurately recognizes the position of the
1 マニピュレータ
3 コンピュータ
4 ロボット基台部
5 先端ツール機構
6 カメラ
7 接触検出手段
101 作業対象
102 平面
102a 接触点
102b 接触点
102c 接触点
103 マーカ
104 作業台
DESCRIPTION OF SYMBOLS 1
Claims (2)
前記マニピュレータの動作を制御する制御手段を備え、
前記制御手段は、初期動作として、作業対象が設置される平面と同一平面上にあり、かつ、一直線上にない少なくとも3箇所の接触点に対して、前記マニピュレータの手先を接触させ、前記3箇所以上の接触点の位置を検出し、
前記3箇所以上の接触点の位置に基づいて、前記平面の傾き及び高さ位置を計測し、
前記撮像手段の光軸を前記平面に対して垂直として、この撮像手段により前記平面上に設けられたマーカを撮像し、
前記撮像手段により撮像された前記マーカの画像を画像処理して、前記マーカの前記平面上における位置及び回転方向を計測しておき、
次に、前記制御手段は、前記平面の傾き及び高さ位置と、この平面上における前記マーカの位置及び回転方向に基づいて、前記マニピュレータを制御する
ことを特徴とするロボット装置。 A robot apparatus having a manipulator having 6 degrees of freedom or more and having an imaging means at a hand position of the manipulator,
Control means for controlling the operation of the manipulator,
The control means, as an initial operation, brings the manipulator hand into contact with at least three contact points that are on the same plane as the work target and are not in a straight line, Detect the position of the contact point above,
Based on the positions of the three or more contact points, measure the inclination and height position of the plane,
The optical axis of the imaging means is perpendicular to the plane, and the marker provided on the plane is imaged by the imaging means,
Image processing of the image of the marker imaged by the imaging means, and measuring the position and rotation direction of the marker on the plane;
Next, the control means controls the manipulator based on the inclination and height position of the plane and the position and rotation direction of the marker on the plane.
作業対象が設置される平面と同一平面上にあり、かつ、一直線上にない少なくとも3箇所の接触点に対して、前記マニピュレータの手先を接触させ、前記3箇所以上の接触点の位置を検出し、
前記3箇所以上の接触点の位置に基づいて、前記平面の傾き及び高さ位置を計測し、
前記撮像手段の光軸を前記平面に対して垂直として、この撮像手段により前記平面上に設けられたマーカを撮像し、
前記撮像手段により撮像された前記マーカの画像を画像処理して、前記マーカの前記平面上における位置及び回転方向を計測しておき、
次に、前記平面の傾き及び高さ位置と、この平面上における前記マーカの位置及び回転方向に基づいて、前記マニピュレータを制御する
ことを特徴とするロボット装置の制御方法。 A control method of a robot apparatus having a manipulator having 6 degrees of freedom or more and having an imaging means at a hand position of the manipulator,
The manipulator hand is brought into contact with at least three contact points that are on the same plane as the work target and are not in a straight line, and the positions of the three or more contact points are detected. ,
Based on the positions of the three or more contact points, measure the inclination and height position of the plane,
The optical axis of the imaging means is perpendicular to the plane, and the marker provided on the plane is imaged by the imaging means,
Image processing of the image of the marker imaged by the imaging means, and measuring the position and rotation direction of the marker on the plane;
Next, the manipulator is controlled based on the inclination and height position of the plane and the position and rotation direction of the marker on the plane.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2008247897A JP5272617B2 (en) | 2008-09-26 | 2008-09-26 | Robot apparatus and control method of robot apparatus |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2008247897A JP5272617B2 (en) | 2008-09-26 | 2008-09-26 | Robot apparatus and control method of robot apparatus |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2010076054A true JP2010076054A (en) | 2010-04-08 |
JP5272617B2 JP5272617B2 (en) | 2013-08-28 |
Family
ID=42207087
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2008247897A Active JP5272617B2 (en) | 2008-09-26 | 2008-09-26 | Robot apparatus and control method of robot apparatus |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5272617B2 (en) |
Cited By (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2015085453A (en) * | 2013-10-31 | 2015-05-07 | セイコーエプソン株式会社 | Robot |
DE102015001527A1 (en) | 2014-02-13 | 2015-08-13 | Fanuc Corporation | Robot system using visual feedback |
CN107255462A (en) * | 2011-07-08 | 2017-10-17 | 卡尔蔡司工业测量技术有限公司 | Measure workpiece coordinate when error correction and/or avoid |
EP3112096A4 (en) * | 2014-02-28 | 2017-11-15 | Sony Corporation | Robot arm apparatus, calibration method, and program |
CN108621125A (en) * | 2017-03-22 | 2018-10-09 | 株式会社东芝 | Object manipulation device and its calibration method |
JP2018202559A (en) * | 2017-06-06 | 2018-12-27 | ファナック株式会社 | Teaching position correction device and teaching position correction method |
CN109311163A (en) * | 2017-05-26 | 2019-02-05 | 深圳配天智能技术研究院有限公司 | Correct the method and its relevant device of the motion control commands of robot |
KR20190013863A (en) * | 2016-09-28 | 2019-02-11 | 카와사키 주코교 카부시키 카이샤 | Diagnostic system for substrate transfer hand |
JP2019042834A (en) * | 2017-08-31 | 2019-03-22 | セイコーエプソン株式会社 | Control device and robot system |
JP2019098409A (en) * | 2017-11-28 | 2019-06-24 | 東芝機械株式会社 | Robot system and calibration method |
CN110352042A (en) * | 2016-10-21 | 2019-10-18 | 医疗技术股份有限公司 | Device and method for being recalibrated automatically to image in 3D art |
DE112021004097T5 (en) | 2020-09-30 | 2023-07-20 | Fanuc Corporation | DEVICE FOR DETECTING A POSITIONAL RELATIONSHIP BETWEEN ROBOT AND WORK MACHINE, CONTROL DEVICE, SYSTEM, METHOD AND COMPUTER PROGRAM |
WO2024048641A1 (en) * | 2022-09-02 | 2024-03-07 | ダイキン工業株式会社 | Robot and robot system |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11478936B2 (en) | 2019-10-09 | 2022-10-25 | Canon Kabushiki Kaisha | Image processing apparatus that processes image picked up by image pickup apparatus attached to robot, control method therefor, and storage medium storing control program therefor |
JP7340069B1 (en) | 2022-06-09 | 2023-09-06 | 株式会社ダイヘン | Marker position registration program, marker position registration device, marker position registration method, and marker used for the method |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH058186A (en) * | 1991-07-04 | 1993-01-19 | Fanuc Ltd | Automatic calibration method |
JP2003311670A (en) * | 2002-04-17 | 2003-11-05 | Denso Wave Inc | Positioning control method of robot arm and robot equipment |
JP2005125478A (en) * | 2003-09-29 | 2005-05-19 | Yaskawa Electric Corp | Relative position measuring method between plurality of robots |
JP2005149299A (en) * | 2003-11-18 | 2005-06-09 | Fanuc Ltd | Teaching position correction apparatus |
JP2006297559A (en) * | 2005-04-22 | 2006-11-02 | Yaskawa Electric Corp | Calibration system and robot's calibration method |
-
2008
- 2008-09-26 JP JP2008247897A patent/JP5272617B2/en active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH058186A (en) * | 1991-07-04 | 1993-01-19 | Fanuc Ltd | Automatic calibration method |
JP2003311670A (en) * | 2002-04-17 | 2003-11-05 | Denso Wave Inc | Positioning control method of robot arm and robot equipment |
JP2005125478A (en) * | 2003-09-29 | 2005-05-19 | Yaskawa Electric Corp | Relative position measuring method between plurality of robots |
JP2005149299A (en) * | 2003-11-18 | 2005-06-09 | Fanuc Ltd | Teaching position correction apparatus |
JP2006297559A (en) * | 2005-04-22 | 2006-11-02 | Yaskawa Electric Corp | Calibration system and robot's calibration method |
Cited By (28)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107255462A (en) * | 2011-07-08 | 2017-10-17 | 卡尔蔡司工业测量技术有限公司 | Measure workpiece coordinate when error correction and/or avoid |
US10429178B2 (en) | 2011-07-08 | 2019-10-01 | Carl Zeiss Industrielle Messtechnik Gmbh | Correcting and/or preventing errors during the measurement of coordinates of a work piece |
CN107255462B (en) * | 2011-07-08 | 2019-07-23 | 卡尔蔡司工业测量技术有限公司 | Measure workpiece coordinate when error correction and/or avoid |
JP2015085453A (en) * | 2013-10-31 | 2015-05-07 | セイコーエプソン株式会社 | Robot |
DE102015001527A1 (en) | 2014-02-13 | 2015-08-13 | Fanuc Corporation | Robot system using visual feedback |
US9517563B2 (en) | 2014-02-13 | 2016-12-13 | Fanuc Corporation | Robot system using visual feedback |
DE102015001527B4 (en) | 2014-02-13 | 2019-02-28 | Fanuc Corporation | Robot system using visual feedback |
EP3112096A4 (en) * | 2014-02-28 | 2017-11-15 | Sony Corporation | Robot arm apparatus, calibration method, and program |
US10556345B2 (en) | 2014-02-28 | 2020-02-11 | Sony Corporation | Robot arm apparatus and calibration method |
US11476138B2 (en) | 2016-09-28 | 2022-10-18 | Kawasaki Jukogyo Kabushiki Kaisha | Diagnostic system of substrate transfer hand |
KR102172266B1 (en) * | 2016-09-28 | 2020-10-30 | 카와사키 주코교 카부시키 카이샤 | Board Transfer Hand Diagnosis System |
KR20190013863A (en) * | 2016-09-28 | 2019-02-11 | 카와사키 주코교 카부시키 카이샤 | Diagnostic system for substrate transfer hand |
CN110352042A (en) * | 2016-10-21 | 2019-10-18 | 医疗技术股份有限公司 | Device and method for being recalibrated automatically to image in 3D art |
US11771519B2 (en) | 2016-10-21 | 2023-10-03 | Medtech S.A. | Device and method for automatic recalibration for 3D intraoperative images |
CN108621125B (en) * | 2017-03-22 | 2021-07-30 | 株式会社东芝 | Object handling device and calibration method thereof |
JP2018158391A (en) * | 2017-03-22 | 2018-10-11 | 株式会社東芝 | Object handling device and calibration method for the same |
US10576635B2 (en) | 2017-03-22 | 2020-03-03 | Kabushiki Kaisha Toshiba | Object handling device and calibration method thereof |
US11318619B2 (en) | 2017-03-22 | 2022-05-03 | Kabushiki Kaisha Toshiba | Object handling device and calibration method thereof |
CN108621125A (en) * | 2017-03-22 | 2018-10-09 | 株式会社东芝 | Object manipulation device and its calibration method |
CN109311163A (en) * | 2017-05-26 | 2019-02-05 | 深圳配天智能技术研究院有限公司 | Correct the method and its relevant device of the motion control commands of robot |
JP2018202559A (en) * | 2017-06-06 | 2018-12-27 | ファナック株式会社 | Teaching position correction device and teaching position correction method |
DE102018112820B4 (en) | 2017-06-06 | 2022-02-03 | Fanuc Corporation | Teach position correction device and teach position correction method |
US10618166B2 (en) | 2017-06-06 | 2020-04-14 | Fanuc Corporation | Teaching position correction device and teaching position correction method |
JP7130927B2 (en) | 2017-08-31 | 2022-09-06 | セイコーエプソン株式会社 | Controller and robot system |
JP2019042834A (en) * | 2017-08-31 | 2019-03-22 | セイコーエプソン株式会社 | Control device and robot system |
JP2019098409A (en) * | 2017-11-28 | 2019-06-24 | 東芝機械株式会社 | Robot system and calibration method |
DE112021004097T5 (en) | 2020-09-30 | 2023-07-20 | Fanuc Corporation | DEVICE FOR DETECTING A POSITIONAL RELATIONSHIP BETWEEN ROBOT AND WORK MACHINE, CONTROL DEVICE, SYSTEM, METHOD AND COMPUTER PROGRAM |
WO2024048641A1 (en) * | 2022-09-02 | 2024-03-07 | ダイキン工業株式会社 | Robot and robot system |
Also Published As
Publication number | Publication date |
---|---|
JP5272617B2 (en) | 2013-08-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5272617B2 (en) | Robot apparatus and control method of robot apparatus | |
JP6490037B2 (en) | Robot system comprising a robot supported by a movable carriage | |
JP5561260B2 (en) | Robot system and imaging method | |
US9517560B2 (en) | Robot system and calibration method of the robot system | |
WO2020121396A1 (en) | Robot calibration system and robot calibration method | |
JP5292998B2 (en) | Robot apparatus control method and robot apparatus | |
JP2011115877A (en) | Double arm robot | |
JP2009269110A (en) | Assembly equipment | |
JP6869159B2 (en) | Robot system | |
JP6900290B2 (en) | Robot system | |
JP2007122705A (en) | Welding teaching point correction system and calibration method | |
JP2008183690A (en) | Robot control device and system | |
JP2005334998A (en) | Self-propelled robot hand, and its camera adjusting method, hand moving amount correcting method and hand adjusting method | |
JP5088186B2 (en) | Robot apparatus and control method of robot apparatus | |
JP2010058235A (en) | Teaching method and teaching tool for robot system | |
JP5446887B2 (en) | Control device, robot, robot system, and robot tracking method | |
JP7281910B2 (en) | robot control system | |
JP5891698B2 (en) | robot | |
JP2006297559A (en) | Calibration system and robot's calibration method | |
JP5296624B2 (en) | Welding method in which branch pipe is arranged on mother pipe and welded and arrangement method in which branch pipe is arranged on mother pipe | |
JP5113623B2 (en) | Robot controller that teaches robot position using a measuring device | |
JP2011143494A (en) | Robot control device and method | |
JP2017050376A (en) | Electronic component mounting device and electronic component mounting method | |
JP2013173191A (en) | Robot apparatus, robot control apparatus, robot control method, and robot control program | |
WO2020129706A1 (en) | Alignment device |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20110809 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20121211 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20130206 |
|
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: 20130416 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20130429 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 5272617 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |