JPH0351557B2 - - Google Patents
Info
- Publication number
- JPH0351557B2 JPH0351557B2 JP60165133A JP16513385A JPH0351557B2 JP H0351557 B2 JPH0351557 B2 JP H0351557B2 JP 60165133 A JP60165133 A JP 60165133A JP 16513385 A JP16513385 A JP 16513385A JP H0351557 B2 JPH0351557 B2 JP H0351557B2
- Authority
- JP
- Japan
- Prior art keywords
- arm
- robot
- value
- control
- speed
- 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.)
- Expired - Lifetime
Links
- 238000001514 detection method Methods 0.000 description 10
- 238000010586 diagram Methods 0.000 description 7
- 238000005259 measurement Methods 0.000 description 7
- 230000000694 effects Effects 0.000 description 4
- 238000000034 method Methods 0.000 description 4
- 238000011017 operating method Methods 0.000 description 4
- 230000000007 visual effect Effects 0.000 description 2
Classifications
-
- 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
- B25J9/00—Programme-controlled manipulators
- B25J9/10—Programme-controlled manipulators characterised by positioning means for manipulator elements
-
- 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)
Description
【発明の詳細な説明】
産業上の利用分野
本発明は、ロボツト自身で対象物の位置検出を
行なう産業用ロボツトに関するものである。
行なう産業用ロボツトに関するものである。
従来の技術
近年、産業用ロボツトにおける作業において、
作業対象物の位置決めが不充分な場合、ロボツト
との相対位置の変化する場合、対象物の大きさ等
が変化する場合、位置決めを行なうとそのための
設備が高価になる場合など、教示で教えられた位
置決めを繰り返すだけでは不充分で、対象物の位
置を検出し、その位置検出値に従つてロボツトに
教示点との位置補正を行なわせ作業をさせる要望
が強くなつてきている。このため、例えば、視覚
認識装置や、超音波検出器等を用い、対象物の位
置を検出し、そのデータをロボツトに送り、ロボ
ツトは、そのデータに基づき、位置を補正する方
式が提案されているが、そのために専用の視覚認
識装置や超音波検出器等が、各ロボツトごとに必
要で、コスト的に不利であること、3次元の位置
認識が困難であることなどの欠点があつた。そこ
で、ロボツトの力制御機能を用い、ロボツト自身
で対象物の位置検出を行なう産業用ロボツトをす
でに特願昭60−12963号等において提案した。
作業対象物の位置決めが不充分な場合、ロボツト
との相対位置の変化する場合、対象物の大きさ等
が変化する場合、位置決めを行なうとそのための
設備が高価になる場合など、教示で教えられた位
置決めを繰り返すだけでは不充分で、対象物の位
置を検出し、その位置検出値に従つてロボツトに
教示点との位置補正を行なわせ作業をさせる要望
が強くなつてきている。このため、例えば、視覚
認識装置や、超音波検出器等を用い、対象物の位
置を検出し、そのデータをロボツトに送り、ロボ
ツトは、そのデータに基づき、位置を補正する方
式が提案されているが、そのために専用の視覚認
識装置や超音波検出器等が、各ロボツトごとに必
要で、コスト的に不利であること、3次元の位置
認識が困難であることなどの欠点があつた。そこ
で、ロボツトの力制御機能を用い、ロボツト自身
で対象物の位置検出を行なう産業用ロボツトをす
でに特願昭60−12963号等において提案した。
これは、第6図に示す構成になつている。すな
わち、モータ1を位置検出器2と速度検出器3と
電流のそれぞれの制御ループによる通常の位置制
御モードと、位置制御ループを切り離し、荷重指
令値と速度検出値の差を電流指令値とする荷重制
御モードを切替える切替部4を有するものであ
る。そして、荷重制御モードの時は、モータ1
は、指令値5に見合つた速度で動き、モータ1に
より駆動されるロボツトアームが対象物に接触す
ると速度は0となり、電流ループの働きで、一定
力を発生するものである。更にこの時、位置検出
器2の値が変化しないことで、アームの接触を確
認し、その値を読み取ることにより対象物の位置
を検出することができ、ロボツト自身で対象物の
位置を検出できる顕著な効果を奏しうるものであ
る。
わち、モータ1を位置検出器2と速度検出器3と
電流のそれぞれの制御ループによる通常の位置制
御モードと、位置制御ループを切り離し、荷重指
令値と速度検出値の差を電流指令値とする荷重制
御モードを切替える切替部4を有するものであ
る。そして、荷重制御モードの時は、モータ1
は、指令値5に見合つた速度で動き、モータ1に
より駆動されるロボツトアームが対象物に接触す
ると速度は0となり、電流ループの働きで、一定
力を発生するものである。更にこの時、位置検出
器2の値が変化しないことで、アームの接触を確
認し、その値を読み取ることにより対象物の位置
を検出することができ、ロボツト自身で対象物の
位置を検出できる顕著な効果を奏しうるものであ
る。
発明が解決しようとする問題点
しかしながら上記のような構成では、対象物の
位置ずれ、寸法のバラツキ等が、一方向の場合
や、作業点が直接検出できる場合は効果が大きい
が、対象物の位置ずれ等が2次元又は3次元的に
ある場合や、作業点が直接検出できない場合には
充分対応できないという問題点を有していた。
位置ずれ、寸法のバラツキ等が、一方向の場合
や、作業点が直接検出できる場合は効果が大きい
が、対象物の位置ずれ等が2次元又は3次元的に
ある場合や、作業点が直接検出できない場合には
充分対応できないという問題点を有していた。
本発明は上記問題点に鑑み、対象物の位置ずれ
等が2次元又は3次元的にある場合や、作業点が
直接検出できない場合にも、ロボツト自身で、対
象物の位置、作業点の位置を検出できる産業用ロ
ボツトを提供しうるものである。
等が2次元又は3次元的にある場合や、作業点が
直接検出できない場合にも、ロボツト自身で、対
象物の位置、作業点の位置を検出できる産業用ロ
ボツトを提供しうるものである。
問題点を解決するための手段
上記問題点を解決するために本発明の産業用ロ
ボツトは、速度制御ループと電流制御ループによ
り力制御を行ない、力制御時のアーム停止位置を
駆動部の位置検出器により検出し読み込む動作を
複数ケ所で行ない標準データと比較し、対象物の
標準位置との変化分の位置・姿勢を演算部におい
て演算し求めるという構成を備えたものである。
ボツトは、速度制御ループと電流制御ループによ
り力制御を行ない、力制御時のアーム停止位置を
駆動部の位置検出器により検出し読み込む動作を
複数ケ所で行ない標準データと比較し、対象物の
標準位置との変化分の位置・姿勢を演算部におい
て演算し求めるという構成を備えたものである。
作 用
本発明は上記した構成によつて力制御を行な
い、接触停止点での位置検出器の値を読み取りを
複数箇所で行ない、標準データとの比較、演算を
行なうことにより、単に一方向の位置検出だけで
なく、2次元又は3次元の位置ずれ等の検出や、
大きさの検出あるいは作業点を直接検出できない
場合において、検出できる点のずれ量より作業点
の位置ずれ量をロボツト自身により検出すること
ができ、更にその値に基づき、ロボツトは、教示
された位置から位置を補正して作業を行なうこと
ができる。
い、接触停止点での位置検出器の値を読み取りを
複数箇所で行ない、標準データとの比較、演算を
行なうことにより、単に一方向の位置検出だけで
なく、2次元又は3次元の位置ずれ等の検出や、
大きさの検出あるいは作業点を直接検出できない
場合において、検出できる点のずれ量より作業点
の位置ずれ量をロボツト自身により検出すること
ができ、更にその値に基づき、ロボツトは、教示
された位置から位置を補正して作業を行なうこと
ができる。
実施例
以下本発明の一実施例の産業用ロボツトについ
て、図面を参照しながら説明する。
て、図面を参照しながら説明する。
第1図は本発明の実施例における産業用ロボツ
トの制御装置の構成を示すものである。第1図に
おいて、モータ6を制御する制御部7と、制御部
7より出力した位置指令信号Pと位置検出器8よ
りの位置検出量を位置計数器9で検知した値との
差を取り、増幅する位置アンプ10と、その出力
と速度検出器11よりの速度検出量の差を取り増
幅する速度アンプ12と、前記速度検出器11の
検出量と前記制御部6からの力指令値Lの差を取
つた信号と前記速度アンプ12の出力とを前記制
御部6からの指令により切り替える切替部13
と、その出力とパワーアンプ14での電流検出値
Ifとの差を取り増幅する電流アンプ15と、その
出力をパルス幅変調(PWM変調)するPWM変
調回路16と、位置検出器8、位置計数器9の値
の値を前記制御部7を介し読み取り記憶し、記憶
した複数の値をあらかじめ与えてある式にもとづ
き演算を行ない、その結果を制御部7に入力する
演算部17から構成されている。
トの制御装置の構成を示すものである。第1図に
おいて、モータ6を制御する制御部7と、制御部
7より出力した位置指令信号Pと位置検出器8よ
りの位置検出量を位置計数器9で検知した値との
差を取り、増幅する位置アンプ10と、その出力
と速度検出器11よりの速度検出量の差を取り増
幅する速度アンプ12と、前記速度検出器11の
検出量と前記制御部6からの力指令値Lの差を取
つた信号と前記速度アンプ12の出力とを前記制
御部6からの指令により切り替える切替部13
と、その出力とパワーアンプ14での電流検出値
Ifとの差を取り増幅する電流アンプ15と、その
出力をパルス幅変調(PWM変調)するPWM変
調回路16と、位置検出器8、位置計数器9の値
の値を前記制御部7を介し読み取り記憶し、記憶
した複数の値をあらかじめ与えてある式にもとづ
き演算を行ない、その結果を制御部7に入力する
演算部17から構成されている。
第2図は、ロボツトの斜視図で、Z軸リニアモ
ータ18、Z軸位置検出器19、X軸リニアモー
タ20、X軸位置検出器21、Y軸リニアモータ
22、Y軸位置検出器23の3ケの駆動部を有
し、支点24をXZ2方向に、支点25をY方向に
駆動し、平行四辺形のリンクで構成されたロボツ
トアーム26を動かす構成になつている。
ータ18、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により、位置フ
イードバツク、速度フイードバツク、電流フイー
ドバツクを介し、PWM変調器16、パワーアン
プ17によりモータ6を位置指令値に合つた点ま
で駆動し位置決めを行なう位置制御モードとして
動作する。切替部13がbの位置にある時は、制
御部7からの力指令値Lにより、速度フイードバ
ツク値との差を取り、その後電流フイードバツク
値との差を取り、電流アンプ15、PWM変調器
16、パワーアンプ17によりモータ6を駆動す
る。この時、モータ6により動作する産業用ロボ
ツトアームが対象物と接触せず移動している時
は、速度フイードバツクにより、一定速度で移動
し、アームが対象物と接触すると、速度は0とな
るため、モータ6には、電流フイードバツクによ
り、荷重指令値Lに見合つた電流が流れることに
なる。モータ6にサーボモータを用いると、モー
タの特性により、電流値と発生力(回転力又は直
進力)が比例するため、一定の発生力を発生させ
ることができ、力制御モードとして動作する。こ
の時に、モータ6の位置は、位置検出器8、位置
計数器9により常に読み取ることができ、アーム
が対象物に接触し、停止したことを位置が変化し
なくなつたことにより検出でき、その時の位置を
読み取ることで、対象物の位置を測定することが
できる。
は、制御部7からの位置指令値Pにより、位置フ
イードバツク、速度フイードバツク、電流フイー
ドバツクを介し、PWM変調器16、パワーアン
プ17によりモータ6を位置指令値に合つた点ま
で駆動し位置決めを行なう位置制御モードとして
動作する。切替部13がbの位置にある時は、制
御部7からの力指令値Lにより、速度フイードバ
ツク値との差を取り、その後電流フイードバツク
値との差を取り、電流アンプ15、PWM変調器
16、パワーアンプ17によりモータ6を駆動す
る。この時、モータ6により動作する産業用ロボ
ツトアームが対象物と接触せず移動している時
は、速度フイードバツクにより、一定速度で移動
し、アームが対象物と接触すると、速度は0とな
るため、モータ6には、電流フイードバツクによ
り、荷重指令値Lに見合つた電流が流れることに
なる。モータ6にサーボモータを用いると、モー
タの特性により、電流値と発生力(回転力又は直
進力)が比例するため、一定の発生力を発生させ
ることができ、力制御モードとして動作する。こ
の時に、モータ6の位置は、位置検出器8、位置
計数器9により常に読み取ることができ、アーム
が対象物に接触し、停止したことを位置が変化し
なくなつたことにより検出でき、その時の位置を
読み取ることで、対象物の位置を測定することが
できる。
第2図においては、リニアモータ18,20,
22を前記位置制御モードで動作することにより
ロボツトアーム先端27の位置決めが行なえると
ともに、3軸中2軸を位置決めしたまま、例えば
Y軸リニアモータ22の制御を力制御モードにす
るとロボツトアームの先端27は、一定速度でY
方向に移動し、対象物に接触すると停止し、その
位置は、Y軸位置検出器23で検出できる。
22を前記位置制御モードで動作することにより
ロボツトアーム先端27の位置決めが行なえると
ともに、3軸中2軸を位置決めしたまま、例えば
Y軸リニアモータ22の制御を力制御モードにす
るとロボツトアームの先端27は、一定速度でY
方向に移動し、対象物に接触すると停止し、その
位置は、Y軸位置検出器23で検出できる。
第3図は、一点測定時の動作手順を示す。まず
位置制御モードであらかじめ教示し測定対象物の
近くのアプローチ点へ移動する。次にアプローチ
点より対象物に接近する方向に、1つの軸を力制
御モードにし、荷重制御モードで対象物に接近移
動させる。この時、力指令値は、対象物が変形、
移動しない大きさに設定する。その後上述したよ
うに、位置検出器の値が変化しないことで停止を
判断し、そのデータを読み取り、測定値とした
後、位置制御モードに切り替え、再び前記アプロ
ーチ点にもどる。このように力制御モードを用い
ることにより位置の測定ができる。
位置制御モードであらかじめ教示し測定対象物の
近くのアプローチ点へ移動する。次にアプローチ
点より対象物に接近する方向に、1つの軸を力制
御モードにし、荷重制御モードで対象物に接近移
動させる。この時、力指令値は、対象物が変形、
移動しない大きさに設定する。その後上述したよ
うに、位置検出器の値が変化しないことで停止を
判断し、そのデータを読み取り、測定値とした
後、位置制御モードに切り替え、再び前記アプロ
ーチ点にもどる。このように力制御モードを用い
ることにより位置の測定ができる。
第4図、第5図は、2次元の位置測定の例であ
る。第4図において、実線が対象物の平面の標準
位置、破線が実際の位置とすると矢印A,B,C
の方向から各々測定を行ない、各々の測定値の、
標準位置での値の差を求めることにより、対象物
の平面の位置と傾きを求めることができ、平面上
での作業点の場所も求めることができる。この手
順をまとめたのが第5図である。各点での測定値
により、演算部17にて、あらかじめ与えた演算
上にもとづき、平面の位置と傾き、平面上での作
業点の位置を求めることができる。
る。第4図において、実線が対象物の平面の標準
位置、破線が実際の位置とすると矢印A,B,C
の方向から各々測定を行ない、各々の測定値の、
標準位置での値の差を求めることにより、対象物
の平面の位置と傾きを求めることができ、平面上
での作業点の場所も求めることができる。この手
順をまとめたのが第5図である。各点での測定値
により、演算部17にて、あらかじめ与えた演算
上にもとづき、平面の位置と傾き、平面上での作
業点の位置を求めることができる。
以上のように本実施例によれば、速度制御ルー
プと電流制御ループにより力制御を行ない、力制
御時のアーム停止を判断し位置決出器により検出
し読み込む動作を複数ケ所で行ない、標準データ
と比較し、対象物の標準位置との変化分の位置・
姿勢を演算する演算部を設けることにより、ロボ
ツト自身により、2次元又は3次元の位置・姿勢
の検出を行なうことができる。
プと電流制御ループにより力制御を行ない、力制
御時のアーム停止を判断し位置決出器により検出
し読み込む動作を複数ケ所で行ない、標準データ
と比較し、対象物の標準位置との変化分の位置・
姿勢を演算する演算部を設けることにより、ロボ
ツト自身により、2次元又は3次元の位置・姿勢
の検出を行なうことができる。
なお、実施例においては、リニアモータ駆動の
リンク機構アームのロボツトで説明したが、回転
型のモータでも同様であり、アームの構成も実施
例に限るものではない。また、ロボツトの関節構
造はどうでもよいが、摩擦が少なく、力制御の精
度が出しやすいこと、ガタ、タワミが少なく位置
検出精度の良いことから、関節を直接モータで駆
動するダイレクト駆動方式が特に適している。な
お実施例において2次元平面での位置検出を説明
したが、3次元の場合にも測定点を増すことで対
応できることは言うまでもない。演算部の計算
は、測定点等の関係で対象物に合つたものを定め
る必要がある。
リンク機構アームのロボツトで説明したが、回転
型のモータでも同様であり、アームの構成も実施
例に限るものではない。また、ロボツトの関節構
造はどうでもよいが、摩擦が少なく、力制御の精
度が出しやすいこと、ガタ、タワミが少なく位置
検出精度の良いことから、関節を直接モータで駆
動するダイレクト駆動方式が特に適している。な
お実施例において2次元平面での位置検出を説明
したが、3次元の場合にも測定点を増すことで対
応できることは言うまでもない。演算部の計算
は、測定点等の関係で対象物に合つたものを定め
る必要がある。
発明の効果
以上のように本発明は、速度制御ループと電流
制御ループにより力制御を行ない、アームが対象
物に接触したことを検知し、位置検出器により位
置を読み込み、複数ケ所での読み込み値を演算を
行ない対象物の位置・姿勢を求める演算部を設け
ることにより、ロボツト自身により2次元、3次
元の位置・大きさ・姿勢の検出を行なうことがで
きる。
制御ループにより力制御を行ない、アームが対象
物に接触したことを検知し、位置検出器により位
置を読み込み、複数ケ所での読み込み値を演算を
行ない対象物の位置・姿勢を求める演算部を設け
ることにより、ロボツト自身により2次元、3次
元の位置・大きさ・姿勢の検出を行なうことがで
きる。
第1図は本発明の一実施例における産業用ロボ
ツトの制御装置のブロツク図、第2図は同ロボツ
トの斜視図、第3図は1点測定の動作手順のブロ
ツク図、第4図は平面2次元測定の説明図、第5
図は同動作手順のブロツク図、第6図は従来の産
業用ロボツトの制御部のブロツク図である。 7……制御部、8……位置検出器、10……位
置アンプ、12……速度アンプ、13……切替
部、15……電流アンププ、17……演算部。
ツトの制御装置のブロツク図、第2図は同ロボツ
トの斜視図、第3図は1点測定の動作手順のブロ
ツク図、第4図は平面2次元測定の説明図、第5
図は同動作手順のブロツク図、第6図は従来の産
業用ロボツトの制御部のブロツク図である。 7……制御部、8……位置検出器、10……位
置アンプ、12……速度アンプ、13……切替
部、15……電流アンププ、17……演算部。
Claims (1)
- 1 複数の自由度を有するアームと、前記アーム
を駆動する複数の駆動部と、アームの位置を検出
する位置検出器と、前記アームの動作を制御する
制御装置とからなる産業用ロボツトにおいて、制
御装置は速度制御ループと電流制御ループとを具
備し、駆動部出力を制御する力制御のできるサー
ボ回路と、力制御時アームの対象物への接触を前
記位置検出器の値の変化を監視することによつて
検知し前記位置検出器の値を読み取る判断部と、
前記力制御での対象物への接触を複数ケ所で行な
い判断部からの各々の箇所での情報により標準値
と比較し対象物の位置又は大きさを演算する演算
部とを有することを特徴とする産業用ロボツト。
Priority Applications (6)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP60165133A JPS6224991A (ja) | 1985-07-26 | 1985-07-26 | 産業用ロボツト |
EP86904380A EP0232424B1 (en) | 1985-07-26 | 1986-07-16 | Industrial robot |
PCT/JP1986/000363 WO1987000478A1 (en) | 1985-07-26 | 1986-07-16 | Industrial robot |
KR1019870700257A KR900006498B1 (ko) | 1985-07-26 | 1986-07-16 | 산업용 로보트 |
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 JPS6224991A (ja) | 1987-02-02 |
JPH0351557B2 true 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) |
Families Citing this family (28)
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 | サーボモータを用いたサーボ系の制御モード切り換え方法 |
JP3996702B2 (ja) * | 1998-05-26 | 2007-10-24 | 松下電工株式会社 | 組立テーブルとこれを用いた組立方法 |
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 | 鴻海精密工業股份有限公司 | 機器人 |
JP2024104305A (ja) * | 2021-06-09 | 2024-08-05 | 東京計器株式会社 | 接触検知装置 |
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 WO PCT/JP1986/000363 patent/WO1987000478A1/ja active IP Right Grant
- 1986-07-16 DE DE86904380T patent/DE3689116T2/de not_active Expired - Fee Related
- 1986-07-16 EP EP86904380A patent/EP0232424B1/en not_active Expired - Lifetime
- 1986-07-16 KR KR1019870700257A patent/KR900006498B1/ko not_active IP Right Cessation
-
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 * |
Also Published As
Publication number | Publication date |
---|---|
EP0232424B1 (en) | 1993-09-29 |
EP0232424A1 (en) | 1987-08-19 |
KR900006498B1 (ko) | 1990-09-03 |
DE3689116T2 (de) | 1994-02-03 |
US4904152A (en) | 1990-02-27 |
JPS6224991A (ja) | 1987-02-02 |
KR870700466A (ko) | 1987-12-29 |
EP0232424A4 (en) | 1989-09-19 |
DE3689116D1 (de) | 1993-11-04 |
WO1987000478A1 (en) | 1987-01-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JPH0351557B2 (ja) | ||
EP0055915B1 (en) | Arm locus control method and apparatus | |
EP0208406B1 (en) | Method of detecting and controlling work start point of robot | |
EP2014405B1 (en) | Positioning method of spot welding 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 | |
US20220134553A1 (en) | Torque control of a motor | |
JP2786874B2 (ja) | 可動位置制御装置 | |
US11141855B2 (en) | Robot system, method of controlling robot arm, recording medium, and method of manufacturing an article | |
US6192298B1 (en) | Method of correcting shift of working position in robot manipulation system | |
EP0359822B1 (en) | Orbit controlling method of robot | |
JPS60127987A (ja) | ならい制御方法および装置 | |
JP2709001B2 (ja) | 力制御ロボットにおける作業対象物の位置検出装置 | |
GB2112961A (en) | Corner angle portion detecting apparatus | |
JPS62199383A (ja) | ロボツトの制御方式 | |
JPS63162179A (ja) | 精密嵌合方法 | |
JP3855629B2 (ja) | ロボットの干渉検出装置 | |
JPS61159390A (ja) | 産業用ロボツトの制御方法 | |
JPH0146275B2 (ja) | ||
JPS609680A (ja) | 産業用ロボツトの制御基準位置設定方法 | |
JPS62187574A (ja) | センサ付溶接ロボツト | |
JP2505394B2 (ja) | 産業用ロボットの加速度変化を利用した制御方法 | |
JP2734258B2 (ja) | ロボットの軌跡補正装置 | |
JPH09141582A (ja) | 力制御ロボットの接触位置検出装置 | |
JPH10303281A (ja) | XYθテーブル |