JPS6224991A - 産業用ロボツト - Google Patents
産業用ロボツトInfo
- Publication number
- JPS6224991A JPS6224991A JP60165133A JP16513385A JPS6224991A JP S6224991 A JPS6224991 A JP S6224991A JP 60165133 A JP60165133 A JP 60165133A JP 16513385 A JP16513385 A JP 16513385A JP S6224991 A JPS6224991 A JP S6224991A
- Authority
- JP
- Japan
- Prior art keywords
- arm
- value
- robot
- speed
- position detector
- 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
- 238000001514 detection method Methods 0.000 description 7
- 238000010586 diagram Methods 0.000 description 7
- 238000005259 measurement Methods 0.000 description 5
- 238000011017 operating method Methods 0.000 description 4
- 238000000034 method Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 2
- 230000000007 visual effect Effects 0.000 description 2
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/10—Programme-controlled manipulators characterised by positioning means for manipulator elements
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/19—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path
- G05B19/39—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using a combination of the means covered by at least two of the preceding groups G05B19/21, G05B19/27 and G05B19/33
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
- B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/02—Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type
- B25J9/04—Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type by rotating at least one arm, excluding the head movement itself, e.g. cylindrical coordinate type or polar coordinate type
- B25J9/046—Revolute coordinate type
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1633—Programme controls characterised by the control loop compliant, force, torque control, e.g. combined with position control
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/36—Nc in input of data, input key till input tape
- G05B2219/36417—Programmed coarse position, fine position by alignment, follow line, path adaptive
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/36—Nc in input of data, input key till input tape
- G05B2219/36503—Adapt program to real coordinates, software orientation
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/37—Measurements
- G05B2219/37207—Verify, probe, workpiece
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/37—Measurements
- G05B2219/37405—Contact detection between workpiece and tool, probe, feeler
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/42—Servomotor, servo controller kind till VSS
- G05B2219/42104—Loop switch, speed loop then position loop, mode switch
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/42—Servomotor, servo controller kind till VSS
- G05B2219/42123—Position loop then force, current loop
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/42—Servomotor, servo controller kind till VSS
- G05B2219/42237—Pwm pulse width modulation, pulse to position modulation ppm
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/49—Nc machine tool, till multiple
- G05B2219/49362—Tool, probe at constant height to surface during machining
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/50—Machine tool, machine tool null till machine tool work handling
- G05B2219/50198—Emergency stop
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y10—TECHNICAL SUBJECTS COVERED BY FORMER USPC
- Y10S—TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y10S414/00—Material or article handling
- Y10S414/13—Handlers utilizing parallel links
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
- Control Of Position Or Direction (AREA)
Abstract
(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。
め要約のデータは記録されません。
Description
【発明の詳細な説明】
産業上の利用分野
本発明は、ロボット自身で対象物の位置検出を行なう産
業用ロボットに関するものである。
業用ロボットに関するものである。
従来の技術
近年、産業用ロボットにおける作業において、作業対象
物の位置決めが不充分な場合、ロボットとの相対位置の
変化する場合、対象物の大きさ等を繰り返すだけでは不
充分で、対象物の位置を検出し、その位置検出値に従っ
てロボットに教示点との位置補正を行なわせ作業をさせ
る要望が強くなってきている。このため、例えば、視覚
認識装置や、超音波検出器等を用い、対象物の位置を検
出し、そのデータをロボットに送り、ロボットは、その
データに基づき、位置を補正する方式が提案されている
が、そのために専用の視覚認識装置や超音波検出器等が
、各ロボットごとに必要で、コスト的に不利であること
、3次元の位置認識が困難であることなどの欠点があっ
た。そこで、ロボットの力制御機能を用い、ロボット自
身で対象物の位置検出を行なう産業用ロボットをすでに
特願昭6O−129fS3号等において提案した。
物の位置決めが不充分な場合、ロボットとの相対位置の
変化する場合、対象物の大きさ等を繰り返すだけでは不
充分で、対象物の位置を検出し、その位置検出値に従っ
てロボットに教示点との位置補正を行なわせ作業をさせ
る要望が強くなってきている。このため、例えば、視覚
認識装置や、超音波検出器等を用い、対象物の位置を検
出し、そのデータをロボットに送り、ロボットは、その
データに基づき、位置を補正する方式が提案されている
が、そのために専用の視覚認識装置や超音波検出器等が
、各ロボットごとに必要で、コスト的に不利であること
、3次元の位置認識が困難であることなどの欠点があっ
た。そこで、ロボットの力制御機能を用い、ロボット自
身で対象物の位置検出を行なう産業用ロボットをすでに
特願昭6O−129fS3号等において提案した。
これは、第6図に示す構成になっている。すなわち、モ
ータ1を位置検出器2と速度検出器3と電流のそれぞれ
の制御ループによる通常の位置制御モードと、位置制御
ループを切り離し、荷重指令値と速度検出値の差を電流
指令値とする荷重制御モードを切替える切替部4を有す
るものである。
ータ1を位置検出器2と速度検出器3と電流のそれぞれ
の制御ループによる通常の位置制御モードと、位置制御
ループを切り離し、荷重指令値と速度検出値の差を電流
指令値とする荷重制御モードを切替える切替部4を有す
るものである。
そして、荷重制御モードの時は、モータ1は、指令値5
に見合った速度で動き、モータ1により駆動されるロボ
ットアームが対象物に接触すると速度は0となり、電流
ループの働きで、一定力を発生するものである。更にこ
の時、位置検出器2の値が変化しないことで、アームの
接触を確認し、その値を読み取ることにより対象物の位
置を検出することができ、ロボット自身で対象物の位置
を検出できる顕著な効果を奏しうるものである。
に見合った速度で動き、モータ1により駆動されるロボ
ットアームが対象物に接触すると速度は0となり、電流
ループの働きで、一定力を発生するものである。更にこ
の時、位置検出器2の値が変化しないことで、アームの
接触を確認し、その値を読み取ることにより対象物の位
置を検出することができ、ロボット自身で対象物の位置
を検出できる顕著な効果を奏しうるものである。
発明が解決しようとする問題点
しかしながら上記のような構成では、対象物の位置ずれ
9寸法のバラツキ等が、一方向の場合や、作業点が直接
検出できる場合は効果が大きいが、対象物の位置ずれ等
が2次元又は3次元的にある場合や、作業点が直接検出
できない場合には充分対応できないという問題点を有し
ていた。
9寸法のバラツキ等が、一方向の場合や、作業点が直接
検出できる場合は効果が大きいが、対象物の位置ずれ等
が2次元又は3次元的にある場合や、作業点が直接検出
できない場合には充分対応できないという問題点を有し
ていた。
本発明は上記問題点に鑑み、対象物の位置ずれ等が2次
元又は3次元的にある場合や、作業点が直接検出できな
い場合にも、ロボット自身で、対象物の位置9作業点の
位置を検出できる産業用ロボットを提供しうるものであ
る。
元又は3次元的にある場合や、作業点が直接検出できな
い場合にも、ロボット自身で、対象物の位置9作業点の
位置を検出できる産業用ロボットを提供しうるものであ
る。
問題点を解決するだめの手段
上記問題点を解決するために本発明の産業用ロボットは
、速度制御ループと電流制御ループにより力制御を行な
い、力制御時のアーム停止位置を駆動部の位置検出器に
より検出し読み込む動作を複数ケ所で行ない標準データ
と比較し、対象物の標準位置との変化分の位置・姿勢を
演算部において演算し求めるという構成を備えだもので
ある。
、速度制御ループと電流制御ループにより力制御を行な
い、力制御時のアーム停止位置を駆動部の位置検出器に
より検出し読み込む動作を複数ケ所で行ない標準データ
と比較し、対象物の標準位置との変化分の位置・姿勢を
演算部において演算し求めるという構成を備えだもので
ある。
作 用
本発明は上記した構成によって力制御を行ない、接触停
止点での位置検出器の値を読み取りを複数箇所で行ない
、標準データとの比較、演算を行なうことにより、単に
一方向の位置検出だけでなく、2次元又は3次元の位置
ずれ等の検出や、大きさの検出あるいは作業点を直接検
出できない場合において、検出できる点のずれ量より作
業点の位置ずれ量をロボット自身により検出することが
でき、更にその値に基づき、ロボットは、教示された位
置から位置を補正して作業を行なうことができる。
止点での位置検出器の値を読み取りを複数箇所で行ない
、標準データとの比較、演算を行なうことにより、単に
一方向の位置検出だけでなく、2次元又は3次元の位置
ずれ等の検出や、大きさの検出あるいは作業点を直接検
出できない場合において、検出できる点のずれ量より作
業点の位置ずれ量をロボット自身により検出することが
でき、更にその値に基づき、ロボットは、教示された位
置から位置を補正して作業を行なうことができる。
実施例
以下本発明の一実施例の産業用ロボットについて、図面
を参照しながら説明する。
を参照しながら説明する。
第1図は本発明の実施例における産業用ロボットの制御
装置の構成を示すものである。第1図において、モータ
6を制御する制御部7と、制御部7より出力した位置指
令信号Pと位置検出器8よりの位置検出量を位置計数器
9で検知した値との差を取り、増幅する位置アンプ10
と、その出力と速度検出器11よシの速度検出量の差を
取9増幅する速度アンプ12と、前記速度検出器11の
検出量と前記制御部6からの力指令値りの差を取った信
号と前記速度アンプ12の出力とを前記制御部6からの
指令により切り替える切替部13と、その出力とパワー
アンプ14での電流検出値Ifとの差を取り増幅する電
流アンプ15と、その出力をパルス幅変調(PWM変調
)するPWM変調回路16と、位置検出器82位置計数
器9の値の値を前記制御部7を介し読み取り記憶し、記
憶した複数の値をあらかじめ与えである式にもとづき演
算を行ない、その結果を制御部7に入力する演算部17
から構成されている。
装置の構成を示すものである。第1図において、モータ
6を制御する制御部7と、制御部7より出力した位置指
令信号Pと位置検出器8よりの位置検出量を位置計数器
9で検知した値との差を取り、増幅する位置アンプ10
と、その出力と速度検出器11よシの速度検出量の差を
取9増幅する速度アンプ12と、前記速度検出器11の
検出量と前記制御部6からの力指令値りの差を取った信
号と前記速度アンプ12の出力とを前記制御部6からの
指令により切り替える切替部13と、その出力とパワー
アンプ14での電流検出値Ifとの差を取り増幅する電
流アンプ15と、その出力をパルス幅変調(PWM変調
)するPWM変調回路16と、位置検出器82位置計数
器9の値の値を前記制御部7を介し読み取り記憶し、記
憶した複数の値をあらかじめ与えである式にもとづき演
算を行ない、その結果を制御部7に入力する演算部17
から構成されている。
第2図は、ロボットの斜視図で、Z軸すニアモータ18
.Z軸位置検出器19.x軸すニアモータ20.x軸位
置検出器21.Y軸すニアモータ22、Y軸位置検出器
23の3ケの駆動部を有し、支点24をXZ2方向に、
支点25をY方向に駆動し、平行四辺形のリンクで構成
されたロボットアーム26を動かす構成になっている。
.Z軸位置検出器19.x軸すニアモータ20.x軸位
置検出器21.Y軸すニアモータ22、Y軸位置検出器
23の3ケの駆動部を有し、支点24をXZ2方向に、
支点25をY方向に駆動し、平行四辺形のリンクで構成
されたロボットアーム26を動かす構成になっている。
第3図は、一点測定時の動作手順を示すブロック図、第
4図、第5図は、2次元位置測定時の説明図である。
4図、第5図は、2次元位置測定時の説明図である。
以上のように構成された産業用ロボットについて以下第
1図〜第5図を用いてその動作を説明する。
1図〜第5図を用いてその動作を説明する。
第1図において切替部13がaの位置にある時は、制御
部7からの位置指令値Pにより、位置フィードバック、
速度フィードバック、電流フィードバックを介し、PW
M変調器16.パワーアンプ17によりモータ6を位置
指令値に合った点まで駆動し位置決めを行なう位置制御
モードとして動作する。切替部13がbの位置にある時
は、制御部7からの力指令値りにより、速度フィードバ
ック値との差を取り、その後電流フィードバック値との
差を取り、電流アンプ1s、PWM変調器16 パワー
アンプ17によりモータeを駆動する。この時、モータ
6により動作する産業用ロボットアームが対象物と接触
せず移動している時は、速度フィードバックにより、一
定速度で移動し、アームが対象物と接触すると、速度は
0となるため、モータ6には、電流フィードバックによ
り、荷重指令値りに見合った電流が流れるこ七になる。
部7からの位置指令値Pにより、位置フィードバック、
速度フィードバック、電流フィードバックを介し、PW
M変調器16.パワーアンプ17によりモータ6を位置
指令値に合った点まで駆動し位置決めを行なう位置制御
モードとして動作する。切替部13がbの位置にある時
は、制御部7からの力指令値りにより、速度フィードバ
ック値との差を取り、その後電流フィードバック値との
差を取り、電流アンプ1s、PWM変調器16 パワー
アンプ17によりモータeを駆動する。この時、モータ
6により動作する産業用ロボットアームが対象物と接触
せず移動している時は、速度フィードバックにより、一
定速度で移動し、アームが対象物と接触すると、速度は
0となるため、モータ6には、電流フィードバックによ
り、荷重指令値りに見合った電流が流れるこ七になる。
モータ6にサーボモータを用いると、モータの特性によ
り、電流値と発生力(回転力又は直進力)が比例するた
め、一定の発生力を発生させることができ、力制御モー
ドとして動作する。この時に、モータ6の位置は、位置
検出器82位置計数器9により常に読み取ることができ
、アームが対象物に接触し、停止したことを位置が変化
しなくなったことにより検知でき、その時の位置を読み
取ることで、対象物の位置を測定することができる。
り、電流値と発生力(回転力又は直進力)が比例するた
め、一定の発生力を発生させることができ、力制御モー
ドとして動作する。この時に、モータ6の位置は、位置
検出器82位置計数器9により常に読み取ることができ
、アームが対象物に接触し、停止したことを位置が変化
しなくなったことにより検知でき、その時の位置を読み
取ることで、対象物の位置を測定することができる。
第2図においては、リニアモータ18,20゜22を前
記位置制御モードで動作することによりロボットアーム
先端27の位置決めが行なえるとともに、3軸中2軸を
位置決めしたまま、例えばY軸すニアモータ22の制御
を力制御モードにするとロボットアームの先端27は、
一定速度でY方向に移動し、対象物に接触すると停止し
、その位置は、Y軸位置検出器23で検出できる。
記位置制御モードで動作することによりロボットアーム
先端27の位置決めが行なえるとともに、3軸中2軸を
位置決めしたまま、例えばY軸すニアモータ22の制御
を力制御モードにするとロボットアームの先端27は、
一定速度でY方向に移動し、対象物に接触すると停止し
、その位置は、Y軸位置検出器23で検出できる。
第3図は、一点測定時の動作手順を示す。まず位置制御
モードであらかじめ教示し測定対象物の近くのアプロー
チ点へ移動する。次にアプローチ点より対象物に接近す
る方向に、1つの軸を力制御モードにし、荷重制御モー
ドで対象物に接近移動させる。この時、力指令値は、対
象物が変形。
モードであらかじめ教示し測定対象物の近くのアプロー
チ点へ移動する。次にアプローチ点より対象物に接近す
る方向に、1つの軸を力制御モードにし、荷重制御モー
ドで対象物に接近移動させる。この時、力指令値は、対
象物が変形。
移動しない大きさに設定する。その後上述したように、
位置検出器の値が変化しないことで停止を判断し、その
データを読み取り、測定値とした後、位置制御モードに
切り替え、再び前記アプローチ点にもどる。このように
力制御モードを用いることにより位置の測定ができる。
位置検出器の値が変化しないことで停止を判断し、その
データを読み取り、測定値とした後、位置制御モードに
切り替え、再び前記アプローチ点にもどる。このように
力制御モードを用いることにより位置の測定ができる。
第4図、第6図は、2次元の位置測定の例である。第4
図において、実線が対象物の平面の標準位置、破線が実
際の位置とすると矢印A、 B、 Cの方向から各
々測定を行ない、各々の測定値の、標準位置での値の差
を求めることにより、対象物の平面の位置と傾きを求め
ることができ、平面上での作業点の場所も求めることが
できる。この手順をまとめたのが第5図である。各点で
の測定値により、演算部17にて、あらかじめ与えた演
算上にもとづき、平面の位置と傾き、平面上での作業点
の位置を求めることができる。
図において、実線が対象物の平面の標準位置、破線が実
際の位置とすると矢印A、 B、 Cの方向から各
々測定を行ない、各々の測定値の、標準位置での値の差
を求めることにより、対象物の平面の位置と傾きを求め
ることができ、平面上での作業点の場所も求めることが
できる。この手順をまとめたのが第5図である。各点で
の測定値により、演算部17にて、あらかじめ与えた演
算上にもとづき、平面の位置と傾き、平面上での作業点
の位置を求めることができる。
以上のように本実施例によれば、速度制御ループと電流
制御ループにより力制御を行ない、力制御時のアーム停
止を判断し位置決用器により検出し読み込む動作を複数
ケ所で行ない、標準データと比較し、対象物の標準位置
との変化分の位置・姿勢を演算する演算部を設けること
により、ロボット自身により、2次元又は3次元の位置
・姿勢の検出を行なうことができる。
制御ループにより力制御を行ない、力制御時のアーム停
止を判断し位置決用器により検出し読み込む動作を複数
ケ所で行ない、標準データと比較し、対象物の標準位置
との変化分の位置・姿勢を演算する演算部を設けること
により、ロボット自身により、2次元又は3次元の位置
・姿勢の検出を行なうことができる。
なお、実施例においては、リニアモータ駆動のリンク機
構アームのロボットで説明したが、回転型のモータでも
同様であり、アームの構成も実施例に限るものではない
。また、ロボットの関節構造はどうでもよいが、摩擦が
少なく、力制御の精度が出しやすいこと、ガタ、タワミ
が少なく位置検出精度の良いことから、関節を直接モー
タで駆動するダイレクト駆動方式が特に適している。な
お実施例において2次元子面での位置検出を説明したが
、3次元の場合にも測定点を増すことで対応できること
は言うまでもない。演算部の計算は、測定点等の関係で
対象物に合ったものを定める必要がある。
構アームのロボットで説明したが、回転型のモータでも
同様であり、アームの構成も実施例に限るものではない
。また、ロボットの関節構造はどうでもよいが、摩擦が
少なく、力制御の精度が出しやすいこと、ガタ、タワミ
が少なく位置検出精度の良いことから、関節を直接モー
タで駆動するダイレクト駆動方式が特に適している。な
お実施例において2次元子面での位置検出を説明したが
、3次元の場合にも測定点を増すことで対応できること
は言うまでもない。演算部の計算は、測定点等の関係で
対象物に合ったものを定める必要がある。
発明の効果
に接触したことを検知し、位置検出器により位置を読み
込み、複数ケ所での読み込み値を演算を行ない対象物の
位置・姿勢を求める演算部を設けることにより、ロボッ
ト自身により2次元、3次元の位置・大きさ・姿勢の検
出を行なうことができる。
込み、複数ケ所での読み込み値を演算を行ない対象物の
位置・姿勢を求める演算部を設けることにより、ロボッ
ト自身により2次元、3次元の位置・大きさ・姿勢の検
出を行なうことができる。
第1図は本発明の一実施例における産業用ロボットの制
御装置のブロック図、第2図は同ロボットの斜視図、第
3図は1点測定の動作手順のブロック図、第4図は平面
2次元測定の説明図、第c図は同動作手順のプシツク図
、第6図は従来の産業用ロボットの制御部のブロック図
である。 7・・・・・・制御部、8・・・・・・位置検出器、1
0・・・・・・位置アンプ、12・・・・・・速度アン
プ、13・・・・・・切替部、15・・・・・・電流ア
ンプ、17・・・・・・演算部。 代理人の氏名 弁理士 中 尾 敏 男 ほか1名法
− 第2図 第3図
御装置のブロック図、第2図は同ロボットの斜視図、第
3図は1点測定の動作手順のブロック図、第4図は平面
2次元測定の説明図、第c図は同動作手順のプシツク図
、第6図は従来の産業用ロボットの制御部のブロック図
である。 7・・・・・・制御部、8・・・・・・位置検出器、1
0・・・・・・位置アンプ、12・・・・・・速度アン
プ、13・・・・・・切替部、15・・・・・・電流ア
ンプ、17・・・・・・演算部。 代理人の氏名 弁理士 中 尾 敏 男 ほか1名法
− 第2図 第3図
Claims (1)
- 複数の自由度を有するアームと、前記アームを駆動する
複数の駆動部と、アームの位置を検出する位置検出器と
、前記アームの動作を制御する制御装置とからなる産業
用ロボットにおいて、制御装置は速度制御ループと電流
制御ループとを具備し、駆動部出力を制御する力制御の
できるサーボ回路と、力制御時アームの対象物への接触
を前記位置検出器の値の変化を監視することによって検
知し前記位置検出器の値を読み取る判断部と、前記力制
御での対象物への接触を複数ケ所で行ない判断部からの
各々の箇所での情報により標準値と比較し対象物の位置
又は大きさを演算する演算部とを有することを特徴とす
る産業用ロボット。
Priority Applications (6)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP60165133A JPS6224991A (ja) | 1985-07-26 | 1985-07-26 | 産業用ロボツト |
KR1019870700257A KR900006498B1 (ko) | 1985-07-26 | 1986-07-16 | 산업용 로보트 |
PCT/JP1986/000363 WO1987000478A1 (en) | 1985-07-26 | 1986-07-16 | Industrial robot |
EP86904380A EP0232424B1 (en) | 1985-07-26 | 1986-07-16 | Industrial robot |
DE86904380T DE3689116T2 (de) | 1985-07-26 | 1986-07-16 | Industrieller roboter. |
US07/315,253 US4904152A (en) | 1985-07-26 | 1989-02-23 | Industrial robot |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP60165133A JPS6224991A (ja) | 1985-07-26 | 1985-07-26 | 産業用ロボツト |
Publications (2)
Publication Number | Publication Date |
---|---|
JPS6224991A true JPS6224991A (ja) | 1987-02-02 |
JPH0351557B2 JPH0351557B2 (ja) | 1991-08-07 |
Family
ID=15806525
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP60165133A Granted JPS6224991A (ja) | 1985-07-26 | 1985-07-26 | 産業用ロボツト |
Country Status (6)
Country | Link |
---|---|
US (1) | US4904152A (ja) |
EP (1) | EP0232424B1 (ja) |
JP (1) | JPS6224991A (ja) |
KR (1) | KR900006498B1 (ja) |
DE (1) | DE3689116T2 (ja) |
WO (1) | WO1987000478A1 (ja) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH11333647A (ja) * | 1998-05-26 | 1999-12-07 | Matsushita Electric Works Ltd | 組立テーブルとこれを用いた組立方法 |
WO2022259706A1 (ja) * | 2021-06-09 | 2022-12-15 | 東京計器株式会社 | 接触検知装置 |
Families Citing this family (26)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4925312A (en) * | 1988-03-21 | 1990-05-15 | Staubli International Ag | Robot control system having adaptive feedforward torque control for improved accuracy |
US4817848A (en) * | 1988-05-12 | 1989-04-04 | Hughes Aircraft Company | Compliant motion servo |
SE8804305L (sv) * | 1988-11-28 | 1990-05-29 | Fredrik Bror Bengt Lagercrantz | Anordning foer att kunna inreglera en robotbalks fria aende mot ett paa foerhand bestaemt positionslaege |
US5144211A (en) * | 1989-01-31 | 1992-09-01 | Staubli International Ag | Multiaxis robot controller having workpoint torque control |
US5126645A (en) * | 1989-09-30 | 1992-06-30 | Kabushiki Kaisha Toshiba | Grinder robot |
US5107719A (en) * | 1990-08-28 | 1992-04-28 | The University Of Michigan | Adjustable robotic mechanism |
US5180955A (en) * | 1990-10-11 | 1993-01-19 | International Business Machines Corporation | Positioning apparatus |
JPH05235077A (ja) * | 1991-04-26 | 1993-09-10 | Texas Instr Inc <Ti> | 半導体デバイスボンディング用の極座標運動ボンディングヘッド |
DE4202922A1 (de) * | 1992-02-01 | 1993-08-05 | Zeiss Carl Fa | Motorisches stativ |
FR2716400B1 (fr) * | 1994-02-22 | 1996-04-26 | Onera (Off Nat Aerospatiale) | Dispositif manipulateur, à structure parallèle, pour déplacer un objet dans un espace de travail cylindrique. |
JPH0969013A (ja) * | 1995-08-31 | 1997-03-11 | Fanuc Ltd | サーボモータを用いたサーボ系の制御モード切り換え方法 |
GB9815830D0 (en) * | 1998-07-22 | 1998-09-16 | Renishaw Plc | Method of and apparatus for reducing vibrations on probes carried by coordinate measuring machines |
JP3442340B2 (ja) * | 2000-03-29 | 2003-09-02 | ファナック株式会社 | モータ制御装置 |
DE10139759A1 (de) * | 2001-08-13 | 2003-03-27 | Siemens Ag | Diagnose von Robotergetrieben |
DE10236078B4 (de) * | 2002-08-07 | 2013-08-29 | Robert Bosch Gmbh | Verfahren, Computerprogramm, und Steuer- und Regelgerät zum Prüfen der Bewegung eines gegen mindestens einen mechanischen Anschlag beweglichen Elements, sowie Brennkraftmaschine |
JP2006122944A (ja) * | 2004-10-28 | 2006-05-18 | Fanuc Ltd | ダイクッション制御装置 |
DE102005014651B4 (de) | 2005-03-31 | 2009-01-02 | Homag Holzbearbeitungssysteme Ag | Verfahren und Vorrichtung zum Bearbeiten von plattenförmigen Werkstücken |
JP4041508B2 (ja) * | 2005-07-11 | 2008-01-30 | ファナック株式会社 | サーボダイクッションの制御装置 |
DE102006022817B4 (de) * | 2006-05-13 | 2011-09-15 | INGENIEURBüRO CAT M. ZIPPERER GMBH | Vorrichtung zur kostengünstigen Probenhandhabung im Labor |
FR2919515B1 (fr) * | 2007-08-02 | 2009-10-30 | Commissariat Energie Atomique | Dispositif articule a pantographes |
JP2010079814A (ja) * | 2008-09-29 | 2010-04-08 | Sanyo Electric Co Ltd | 搬送制御装置、搬送装置の制御方法、及び観察装置 |
TWI481804B (zh) * | 2012-10-03 | 2015-04-21 | Wei Hua Chaing | 瓶裝藥劑製程之自動化取送料軌道搬運車 |
US9505133B2 (en) | 2013-12-13 | 2016-11-29 | Canon Kabushiki Kaisha | Robot apparatus, robot controlling method, program and recording medium |
CN103878791B (zh) * | 2014-04-12 | 2016-03-09 | 福州大学 | 工业机器人无外部传感器的外力检测方法 |
JP2016028227A (ja) * | 2014-07-08 | 2016-02-25 | ファナック株式会社 | 力覚センサを利用して対象物を検査する検査システム |
TWD172241S (zh) * | 2014-10-10 | 2015-12-01 | 鴻海精密工業股份有限公司 | 機器人 |
Family Cites Families (24)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS5549509B2 (ja) * | 1973-12-28 | 1980-12-12 | ||
JPS536A (en) * | 1976-06-24 | 1978-01-05 | Sony Corp | Different program signal transmission system |
US4200827A (en) * | 1977-06-29 | 1980-04-29 | International Business Machines Corporation | Positioning system employing feedforward and feedback control |
DE2832985A1 (de) * | 1978-07-27 | 1980-03-20 | Stahl Aufzuege Gmbh & Co Kg | Vorrichtung zum bewegen von lasten mittels eines parallelogrammartigen hebelgestaenges |
SU798713A1 (ru) * | 1979-01-17 | 1981-01-23 | Завод-Высшее Техническое Учебноезаведение При Ленинградском Металлическомзаводе Им. Xx11 Съезда Кпсс | Интерактивна система управлени РОбОТОМ |
DE2910399A1 (de) * | 1979-03-16 | 1980-10-02 | Schuler Gmbh L | Schaltungsanordnung fuer eine automatisierte pressenanordnung |
US4367998A (en) * | 1979-09-13 | 1983-01-11 | United Kingdom Atomic Energy Authority | Manipulators |
JPS5669092A (en) * | 1979-11-05 | 1981-06-10 | Mitsubishi Heavy Ind Ltd | Calculating system for starting point of industrial robot |
JPS5745602A (en) * | 1980-09-01 | 1982-03-15 | Fanuc Ltd | Control system for industrial robot |
EP0052273A1 (de) * | 1980-11-06 | 1982-05-26 | Georg Fischer Aktiengesellschaft | Werkstückbearbeitungsvorrichtung |
US4345194A (en) * | 1980-12-01 | 1982-08-17 | The United States Of America As Represented By The United States Department Of Energy | Control system to reduce the effects of friction in drive trains of continuous-path-positioning systems |
US4341986A (en) * | 1981-01-22 | 1982-07-27 | The United States Of America As Represented By The Secretary Of The Navy | Servo control system for the positioning of an apparatus |
GB2095644B (en) * | 1981-03-26 | 1985-04-17 | Atomic Energy Authority Uk | A pantograph linkage |
US4458188A (en) * | 1982-05-13 | 1984-07-03 | Fujitsu Fanuc Limited | Industrial robot having a function for controlling a current of a motor for driving |
JPS59108691A (ja) * | 1982-12-13 | 1984-06-23 | 株式会社日立製作所 | バランサ制御方式 |
JPS59200304A (ja) * | 1983-04-26 | 1984-11-13 | Murata Mach Ltd | 工業用ロボツトの制御方法 |
NL8303209A (nl) * | 1983-09-16 | 1985-04-16 | Munsters B V | Hefwerktuig. |
US4574227A (en) * | 1983-11-14 | 1986-03-04 | Datapoint Corporation | Dual mode servo |
SU1202860A1 (ru) * | 1983-12-15 | 1986-01-07 | Московский станкоинструментальный институт | Манипул тор |
US4603284A (en) * | 1984-06-05 | 1986-07-29 | Unimation, Inc. | Control system for manipulator apparatus with resolved compliant motion control |
JPS6148709A (ja) * | 1984-08-16 | 1986-03-10 | Fanuc Ltd | 接触子の移動制御方法 |
US4710865A (en) * | 1984-11-14 | 1987-12-01 | Canon Kabushiki Kaisha | Control system for positioning an object using switching from a speed control mode to a position control mode with adjustable brain |
US4714400A (en) * | 1986-04-14 | 1987-12-22 | Ibm Corporation | Plural robotic drive |
JPH05288964A (ja) * | 1992-04-07 | 1993-11-05 | Fujitsu Ltd | 光学素子と光ファイバの組立方法および組立装置 |
-
1985
- 1985-07-26 JP JP60165133A patent/JPS6224991A/ja active Granted
-
1986
- 1986-07-16 KR KR1019870700257A patent/KR900006498B1/ko not_active IP Right Cessation
- 1986-07-16 EP EP86904380A patent/EP0232424B1/en not_active Expired - Lifetime
- 1986-07-16 WO PCT/JP1986/000363 patent/WO1987000478A1/ja active IP Right Grant
- 1986-07-16 DE DE86904380T patent/DE3689116T2/de not_active Expired - Fee Related
-
1989
- 1989-02-23 US US07/315,253 patent/US4904152A/en not_active Expired - Fee Related
Non-Patent Citations (2)
Title |
---|
CONF.PROC.IEEE SOUTHEASTCON=1982 * |
ROBOTIC RESEARCH THE SECOND INTERNATIONAL SYMPOSIUM=1985 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH11333647A (ja) * | 1998-05-26 | 1999-12-07 | Matsushita Electric Works Ltd | 組立テーブルとこれを用いた組立方法 |
WO2022259706A1 (ja) * | 2021-06-09 | 2022-12-15 | 東京計器株式会社 | 接触検知装置 |
Also Published As
Publication number | Publication date |
---|---|
EP0232424B1 (en) | 1993-09-29 |
EP0232424A1 (en) | 1987-08-19 |
JPH0351557B2 (ja) | 1991-08-07 |
DE3689116D1 (de) | 1993-11-04 |
DE3689116T2 (de) | 1994-02-03 |
KR870700466A (ko) | 1987-12-29 |
EP0232424A4 (en) | 1989-09-19 |
KR900006498B1 (ko) | 1990-09-03 |
WO1987000478A1 (en) | 1987-01-29 |
US4904152A (en) | 1990-02-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JPS6224991A (ja) | 産業用ロボツト | |
EP0055915B1 (en) | Arm locus control method and apparatus | |
EP2383624A2 (en) | Apparatus and method for detecting contact position of robot | |
KR850007038A (ko) | 가동장치 구동시스템 | |
US11660746B2 (en) | Separate moving and positioning modes for a robot, method providing separate moving and positioning modes for the robot, method of manufacturing a product, and a recording medium | |
JP2786874B2 (ja) | 可動位置制御装置 | |
EP0359822B1 (en) | Orbit controlling method of robot | |
JPS60127987A (ja) | ならい制御方法および装置 | |
JPS63162179A (ja) | 精密嵌合方法 | |
JPS62203789A (ja) | 追従制御装置 | |
JPS5997873A (ja) | ロボツトにおけるワ−クの位置ずれ補正方法 | |
GB2112961A (en) | Corner angle portion detecting apparatus | |
JP3855629B2 (ja) | ロボットの干渉検出装置 | |
JPS609680A (ja) | 産業用ロボツトの制御基準位置設定方法 | |
JP2584065B2 (ja) | ロボットのオフライン教示装置 | |
JPS62187574A (ja) | センサ付溶接ロボツト | |
JP2706555B2 (ja) | 多自由度作業機械の位置と力の制御装置 | |
JPH055588B2 (ja) | ||
JPH09141582A (ja) | 力制御ロボットの接触位置検出装置 | |
JP2635776B2 (ja) | マスタ・スレーブ形マニピュレータ | |
JPH0512102B2 (ja) | ||
JPS61270089A (ja) | 産業用ロボツトにおける位置測定装置 | |
JPH0248197A (ja) | 位置認識方法 | |
JP2734258B2 (ja) | ロボットの軌跡補正装置 | |
JPH10303281A (ja) | XYθテーブル |