JPS61201304A - ロボツトの位置制御法 - Google Patents

ロボツトの位置制御法

Info

Publication number
JPS61201304A
JPS61201304A JP4222485A JP4222485A JPS61201304A JP S61201304 A JPS61201304 A JP S61201304A JP 4222485 A JP4222485 A JP 4222485A JP 4222485 A JP4222485 A JP 4222485A JP S61201304 A JPS61201304 A JP S61201304A
Authority
JP
Japan
Prior art keywords
command value
joint
position command
robot
mechanical
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
JP4222485A
Other languages
English (en)
Inventor
Susumu Nakagawa
享 中川
Takashi Ichiyanagi
一柳 高畤
Yasuo Sakurai
康雄 桜井
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.)
Panasonic Holdings Corp
Original Assignee
Matsushita Electric Industrial Co Ltd
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 Matsushita Electric Industrial Co Ltd filed Critical Matsushita Electric Industrial Co Ltd
Priority to JP4222485A priority Critical patent/JPS61201304A/ja
Publication of JPS61201304A publication Critical patent/JPS61201304A/ja
Pending legal-status Critical Current

Links

Abstract

(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。

Description

【発明の詳細な説明】 産業上の利用分野 本発明は、ロボットの位置制御法に関するものである。
従来の技術 従来のロボットの位置制御法は、第3図のような方法で
あった。
すなわち、位置指令値1とモータ位置フィードバック信
号2の偏差に比例ゲイン3を乗じることによって速度指
令値4とし、この速度指令値4と速度フィードバック信
号6の偏差を直列補償手段6によって補償し、この補償
した信号と電流フィードバック信号7の偏差をDCモー
タ駆動用アンプ8の入力とし、前記DCモータ駆動用ア
ンプ8の出力でDCモータ9を駆動し、減速機1oを介
してロボットアーム11を動作させるものである。
モータ位置フィードバック信号2はDCモータ9の回転
位置を位置検出手段12によって検出した信号であり、
速度フィードバック信号6はDCモータ9の回転速度を
速度検出手段13によって検出したものであり、電流フ
ィードバック信号7はDCモータ9の電流を電流検出手
段14によって検出したものである。
従来のロボットの位置制御法は、DCモータ9の回転位
置を位置指令値1に追従させるため、位置フィードバッ
ク信号2と、速度フィードバック信号6と、電流フィー
ドバック信号7とを負帰還し、それぞれ位置制御、速度
制御、電流制御を行うものであり、位置指令値1に対し
てDCモータ9を良好な精度で追従させ、減速機10を
介してロボットアーム11に所望の位置制御を施こすも
のである。
発明が解決しようとする問題点 しかしながら、このような従来の構成では、減速機1o
の剛性が低い場合、位置指令値1にDCモータ9の回転
位置が良好な精度で追従しても減速機10がロボットア
ーム11の影響を受けてたわむので、その結果位置指令
室1に対してロボットアーム11が良好な精度で位置制
御を施こされないものであった。
そこで、本発明は減速機等の関節部の機械的な剛性が低
い場合でも、位置指令値に対してロボットアームを高精
度に位置制御する方法を提供するものである。
問題点を解決するための手段 そして上記問題点を解決する本発明の技術的な手段は、
ロボットの各アームの位置指令値あるいはモータ回転位
置と、それから算出した各アームの速度および加速度と
を、関節の機械的剛性を考慮したロボットアームの運動
方程式に代入することにより各関節に加わるトルクを算
出し、求めたトルクを各関節の機械的ばね剛性で除する
ことによって各関節の機械的剛性に因るたわみ角を求め
、求めたたわみ角を各関節のたわみを打ち消すように位
置指令値と和して新たな位置指令値とするものである。
作用 この技術的手段による作用は次のようになる。
すなわち、ロボットの動作時に時々刻々、各関節の機械
的たわみ角を予測演算し、予測演算したたわみ角を各関
節のたわみを打消すように位置指令値と和して新たな位
置指令値とするので、アーム駆動用モータは関節の機械
的たわみを打ち消すように位置制御される。
この結果、ロボットの各関節の機械的剛性が低い場合に
、従来のようにモータが精度よく位置制御されても関節
が機械的にたわみロボットアームが高精度に位置制御さ
れないという問題が除去され、ロボットアームは関節の
機械的たわみを補償して高精度に位置制御される。
実施例 以下、本発明の一実施例を添付図面にもとづいて説明す
る。
第2図はロボットアーム1軸の力学モデルを示すもので
あり、ラグランジェの運動方程式を導出すると、 人i+(Mh+W/)、jilcosψ=k(Nθ−9
’ )−・・−(1)ここで、k:減速機のばね定数 M:ロボットアーム質量 h:ロボットアーム重心とアーム軸の距離 W:ロボットアーム保持物の質量 l:ロボットアーム保持物とアーム軸の距離 N:減速機の減速比 θ:モータ回転角 ψ:アーム回転角 g:重力加速度 人=J+Mh  +W12 (ここでJはロボットアームの重心まわシの慣性モーメ
ント) 次に、上記運動方程式(1)を用いた本発明の一実施例
を第1図にもとづいて説明する。
位置指令値15と、位置指令値16に2階微分演算手段
16を施こして得た予測加速度値17とを関節トルク演
算手段18に入力し、関節の機械的剛性を考慮したロボ
ットアームの運動方程式0)において位置指令値15を
ψ、予測加速度値17をがとして左辺の演算を行い関節
に加わるトルク19を求め、減速機ばね剛性テーブル2
oによって関節に加わるトルク19に対応する減速機ば
ね剛性21を求め、関節たわみ角演算手段22によって
関節に加わるトルク19を減速機ばね剛性21で除する
ことによって予測たわみ角23を得る。位置指令値16
は予測たわみ角23と和算され折位置指令値24となり
、折位置指令値24とモータ位置フィードバック信号2
5の偏差に比例ゲイン26を乗じることによって速度指
令値27とし、この速度指令値27と速度フィードバッ
ク信号28の偏差を直列補償手段29によって補償し、
この補償した信号と電流フィードバック信号30の偏差
をDQモータ駆動用アンプ31の入力とし、前記DCモ
ータ駆動用アンプ31の出力でDCモータ32を駆動し
減速機33を介してロボットアーム34を動作させる。
モータ位置フィードバック信号25はDCモータ32の
回転位置を位置検出手段36によって検出した信号であ
り、速度フィードバック信号28はDCモータ32の回
転速度を速度検出手段36によって検出したものであり
、電流フィードバック信号3oは前記DCモータ32の
電流を電流検出手段37によって検出したものである。
以上のように、本実施例によれば、関節部の機械的剛性
が低い場合において、位置指令値16と、それから算出
したアームの予測加速度値17とを、運動方程式に代入
することにより関節に加わるトルク19を算出し、求め
たトルク19を減速機のばね剛性21で除することによ
って関節の機械的剛性に因る予測たわみ角23を求め、
求めた予測たわみ角23を位置指令値16と和して折位
置指令値24とするので、DCモータ32は減速機33
のたわみを打ち消すように位置制御され、ロボットアー
ム34は位置指令値15に対して高精度に位置制御され
る。
発明の効果 以上のように本発明は、関節部の機械的剛性が低い場合
において、ロボットの各アームの位置指令値と、それか
ら算出した各アームの速度および加速度とを、関節の機
械的剛性を考慮したロボットアームの運動方程式に代入
することにより各関節に加わるトルクを算出し、求めた
トルクを各関節の機械的ばね剛性で除することによって
各関節の機械的剛性に因るたわみ角を求め、求めたたわ
み角を各関節のたわみを打ち消すように位置指令値と和
して新たに位置指令値とするので、アーム駆動用モータ
は関節の機械的たわみを打ち消すように位置制御され、
その結果ロボットアームは関節の機械的たわみを補償し
て高精度に位置制御される。
【図面の簡単な説明】
第1図は本発明の一実施例におけるロボットの第3図は
従来のロボットの位置制御法を示すブロック図である。 17・・・・・・予測加速度値、19・・・・・・関節
に加わるトルク、21・・・・・・減速機ばね剛性、2
3・・・−・・予測たわみ角、24・・・・・・折位置
指令値、26・・・・・・位置フィードバック信号、2
7・・・・・・速度指令値、28・・・・・・速度フィ
ードバック信号、3o・・・・・・電流フィードバック
信号。

Claims (3)

    【特許請求の範囲】
  1. (1)ロボットを構成する各アームの位置指令値と、そ
    れを1階微分して得た速度と、2階微分して得た加速度
    とを、前記各アーム間の関節の機械的剛性を考慮したロ
    ボットアームの運動方程式に代入することにより各関節
    に加わるトルクを算出し、求めたトルクを定数あるいは
    関数あるいは制御装置内のテーブルとして与えられた各
    関節の機械的ばね剛性で除することによって各関節の機
    械的剛性に因るたわみ角を求め、求めたたわみ角を各関
    節のたわみを打ち消すように位置指令値と和して新たな
    位置指令値とするロボットの位置制御法。
  2. (2)ロボット動作時のモータ回転角と、モータ回転速
    度と、モータ回転速度を1階微分して得たモータ回転加
    速度とを減速比倍することによって近似的に求めたアー
    ム回転角と、アーム回転速度と、アーム回転加速度とを
    、関節の機械的剛性を考慮したロボットの運動方程式に
    代入することにより各関節に加わるトルクを算出し、求
    めたトルクを定数あるいは関数あるいは制御装置内のテ
    ーブルとして与えられた各関節の機械的ばね剛性で除す
    ることによって各関節の機械的剛性に因るたわみ角を求
    め、求めたたわみ角を各関節のたわみを打ち消すように
    位置指令値と和して新たな位置指令値とする特許請求の
    範囲第1項記載のロボットの位置制御法。
  3. (3)関節の機械的剛性を考慮したロボットの運動方程
    式を用いて得た各関節の機械的ばね剛性に因るたわみ角
    に対して、比例動作あるいは比例・積分動作あるいは比
    例・積分・微分動作の直列補償を施こし、直列補償を施
    こされたたわみ角を各関節のたわみを打ち消すように位
    置指令値と和して新たな位置指令値とする特許請求の範
    囲第1項または第2項記載のロボットの位置制御法。
JP4222485A 1985-03-04 1985-03-04 ロボツトの位置制御法 Pending JPS61201304A (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP4222485A JPS61201304A (ja) 1985-03-04 1985-03-04 ロボツトの位置制御法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP4222485A JPS61201304A (ja) 1985-03-04 1985-03-04 ロボツトの位置制御法

Publications (1)

Publication Number Publication Date
JPS61201304A true JPS61201304A (ja) 1986-09-06

Family

ID=12630061

Family Applications (1)

Application Number Title Priority Date Filing Date
JP4222485A Pending JPS61201304A (ja) 1985-03-04 1985-03-04 ロボツトの位置制御法

Country Status (1)

Country Link
JP (1) JPS61201304A (ja)

Cited By (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS63106805A (ja) * 1986-10-24 1988-05-11 Hitachi Ltd 直動形多自由度ロボツトの位置と力のハイブリツド制御装置
JPH01163808A (ja) * 1987-12-21 1989-06-28 Agency Of Ind Science & Technol ロボットの非干渉化制御方法
WO1992012473A1 (en) * 1990-12-28 1992-07-23 Fanuc, Ltd Method of correcting deflection of robot
JPH08110808A (ja) * 1994-10-12 1996-04-30 Makino Milling Mach Co Ltd 数値制御工作機械の制御方法及び装置
US7344664B2 (en) 1991-01-14 2008-03-18 Fanuc Ltd Pressure waveform setting method for injection pressure control and an injection molding machine
WO2013122018A1 (en) 2012-02-16 2013-08-22 Canon Kabushiki Kaisha Control apparatus of robot, robot, and program thereof
WO2013180223A1 (ja) 2012-05-30 2013-12-05 株式会社神戸製鋼所 多関節ロボットの弾性変形補償制御装置および制御方法
WO2014126218A1 (ja) 2013-02-15 2014-08-21 株式会社神戸製鋼所 多関節ロボットの弾性変形補償制御装置
JP2014180726A (ja) * 2013-03-19 2014-09-29 Kobe Steel Ltd 多関節ロボットのバネ定数補正装置
EP3023208A1 (en) 2014-11-21 2016-05-25 Canon Kabushiki Kaisha Control device for motor drive device, control device for multi-axial motor, and control method for motor drive device
CN108311321A (zh) * 2017-12-29 2018-07-24 深圳市英威腾电气股份有限公司 一种涂装升降往复机的变频器及其驱动方法和系统

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS58140813A (ja) * 1982-02-15 1983-08-20 Fanuc Ltd 位置制御方式
JPS59705A (ja) * 1982-06-25 1984-01-05 Kobe Steel Ltd ロボツトの動特性を考慮した高精度位置制御法
JPS59107882A (ja) * 1982-12-09 1984-06-22 三菱電機株式会社 ロボツトの制御装置

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS58140813A (ja) * 1982-02-15 1983-08-20 Fanuc Ltd 位置制御方式
JPS59705A (ja) * 1982-06-25 1984-01-05 Kobe Steel Ltd ロボツトの動特性を考慮した高精度位置制御法
JPS59107882A (ja) * 1982-12-09 1984-06-22 三菱電機株式会社 ロボツトの制御装置

Cited By (21)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS63106805A (ja) * 1986-10-24 1988-05-11 Hitachi Ltd 直動形多自由度ロボツトの位置と力のハイブリツド制御装置
JPH01163808A (ja) * 1987-12-21 1989-06-28 Agency Of Ind Science & Technol ロボットの非干渉化制御方法
WO1992012473A1 (en) * 1990-12-28 1992-07-23 Fanuc, Ltd Method of correcting deflection of robot
US5418441A (en) * 1990-12-28 1995-05-23 Fanuc, Ltd. Deflection correcting method for a robot
US7344664B2 (en) 1991-01-14 2008-03-18 Fanuc Ltd Pressure waveform setting method for injection pressure control and an injection molding machine
JPH08110808A (ja) * 1994-10-12 1996-04-30 Makino Milling Mach Co Ltd 数値制御工作機械の制御方法及び装置
WO2013122018A1 (en) 2012-02-16 2013-08-22 Canon Kabushiki Kaisha Control apparatus of robot, robot, and program thereof
US9676100B2 (en) 2012-02-16 2017-06-13 Canon Kabushiki Kaisha Control apparatus of robot, robot, and program thereof
CN104349873A (zh) * 2012-05-30 2015-02-11 株式会社神户制钢所 多关节机器人的弹性变形补偿控制装置以及控制方法
WO2013180223A1 (ja) 2012-05-30 2013-12-05 株式会社神戸製鋼所 多関節ロボットの弾性変形補償制御装置および制御方法
JP2013248681A (ja) * 2012-05-30 2013-12-12 Kobe Steel Ltd 多関節ロボットの弾性変形補償制御装置および制御方法
US9505131B2 (en) 2012-05-30 2016-11-29 Kobe Steel, Ltd. Elastic-deformation-compensation control device and control method for articulated robot
JP2014155982A (ja) * 2013-02-15 2014-08-28 Kobe Steel Ltd 多関節ロボットの弾性変形補償制御装置
KR20150105447A (ko) 2013-02-15 2015-09-16 가부시키가이샤 고베 세이코쇼 다관절 로봇의 탄성 변형 보상 제어 장치
CN104981326A (zh) * 2013-02-15 2015-10-14 株式会社神户制钢所 多关节机器人的弹性变形补偿控制装置
US9597800B2 (en) 2013-02-15 2017-03-21 Kobe Steel, Ltd. Elastic deformation compensation control device for articulated robot
WO2014126218A1 (ja) 2013-02-15 2014-08-21 株式会社神戸製鋼所 多関節ロボットの弾性変形補償制御装置
JP2014180726A (ja) * 2013-03-19 2014-09-29 Kobe Steel Ltd 多関節ロボットのバネ定数補正装置
EP3023208A1 (en) 2014-11-21 2016-05-25 Canon Kabushiki Kaisha Control device for motor drive device, control device for multi-axial motor, and control method for motor drive device
US10029366B2 (en) 2014-11-21 2018-07-24 Canon Kabushiki Kaisha Control device for motor drive device, control device for multi-axial motor, and control method for motor drive device
CN108311321A (zh) * 2017-12-29 2018-07-24 深圳市英威腾电气股份有限公司 一种涂装升降往复机的变频器及其驱动方法和系统

Similar Documents

Publication Publication Date Title
EP0280324B1 (en) Nonlinear control unit for a multi-degree-of freedom manipulator
JP3324298B2 (ja) マニピュレータの制御装置
US4943759A (en) Multiple-articulated robot control apparatus
JPH0144476B2 (ja)
JPS61201304A (ja) ロボツトの位置制御法
JP3981773B2 (ja) ロボット制御装置
SE516720C2 (sv) Utrustning för styrning av en industrirobot och förfarande för programmering och/eller justering av robotens rörelse
JPH10128688A (ja) ロボットの非干渉化制御方法
JPH02205489A (ja) マニピュレータのインピーダンス制御方式
JPH06332535A (ja) ロボットの制御装置
JPS59189416A (ja) 産業ロボツトの誘導教示方法
JPH06222817A (ja) ロボットのウィービング制御装置
JPH07185817A (ja) 多軸ロボットのウィービング制御方法
JPH0760667A (ja) ロボットのウィービング制御装置
JPS61224012A (ja) マニピユレ−タの駆動方式
JPH04343690A (ja) 多関節マニピュレータの関節摩擦補償方法
JPS63314607A (ja) 多関節ロボットの制御装置
JP2515549B2 (ja) 多軸サ−ボ機構の円弧軌跡制御装置
JPH077307B2 (ja) ロボットの非干渉化制御方法
JPH03240109A (ja) ロボットの制御方法
JPS59100903A (ja) 産業用ロボツトのサ−ボ制御装置
JP4340208B2 (ja) パラレルメカニズム工作機械の位置制御装置
JP2754910B2 (ja) 人工衛星の姿勢制御装置
JPS61264414A (ja) 移動体制御装置
JPS6138076B2 (ja)