JP2019055457A - ロボットの制御装置 - Google Patents
ロボットの制御装置 Download PDFInfo
- Publication number
- JP2019055457A JP2019055457A JP2017181390A JP2017181390A JP2019055457A JP 2019055457 A JP2019055457 A JP 2019055457A JP 2017181390 A JP2017181390 A JP 2017181390A JP 2017181390 A JP2017181390 A JP 2017181390A JP 2019055457 A JP2019055457 A JP 2019055457A
- Authority
- JP
- Japan
- Prior art keywords
- command value
- axis
- spring constant
- hand
- arm
- 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
「アームのイナーシャ」−「アームバネ」−「ワークのイナーシャ」が連結したモデルを想定することができる。この場合、「アームのイナーシャ」と「アームバネ」とは、手先の位置に応じて変化することになる。そして、アームが手先に保持したワークを移動させるため加速する際には、慣性力によってアームの先端側の移動が遅れ、減速する際には、逆に先端側の移動が先に進む。これにより、振動が発生する。
請求項3記載のロボットの制御装置によれば、バネ定数演算部は、第3軸から手先までの距離をL3,第1軸から手先までの距離をLf,第1軸を基準とする第3軸までのバネ定数をK12,第3軸を基準とする手先までのバネ定数をK3とすると、補正量を求めるために使用するバネ定数Kを、次式
1/K={1/K12+L3 2/(K3Lf 2)}
で求める。これにより、アームを一体的にバネとして捉えた際のバネ定数Kを迅速に求めることができる。
以下、第1実施形態について図1から図11を参照しながら説明する。図2に示すように、ロボットシステム1は、垂直多関節型のロボット2、ロボット2を制御するコントローラ3、コントローラ3に接続されたペンダント4を備えている。このロボットシステム1は、一般的な産業用に用いられている。
τ12=Lf×F,τ3=L3×F …(1)
となる。
Δθ12=τ12/K12,Δθ3=τ3/K3 …(2)
となり、Y軸方向への位置変位ΔY12,ΔY3は、
ΔY12=Lf×τ12/K12=Lf 2×F/K12
ΔY3=L3×τ3/K3=L3 2×F/K3 …(3)
となる。
ΔYf=ΔY12+ΔY3=Lf 2×F/K12+L3 2×F/K3
=(Lf 2/K12+L3 2/K3)F …(4)
である。そして、(4)式の括弧内部は、バネ定数Kの逆数であるから、
1/K=(1/K12+1/K3×L3 2/Lf 2) …(5)
である。このようにバネ定数Kは、各軸の剛性,つまりバネ定数K12,K3及び手先距離Lfの逆数に依存した関数となる。バネ定数K12,K3については、第2軸,第3軸に使用されているクロスローラベアリングの剛性値を用いるか、予め実測した値を用いる。本実施形態では、この(5)式で示されるバネ定数Kを制振制御に使用する。
以下、第1実施形態と同一部分には同一符号を付して説明を省略し、異なる部分について説明する。図12に示す第2実施形態の制御では、ステップS4を実行すると、指令値補正部22は、目標位置Pから、x,y,zの各軸方向のバネ定数Kx,Ky,Kzと、質量Mx,My,Mzとを求める(S12)。バネ定数Kx,Ky,Kzについては、各軸に(5)式を適用することで計算する。更に、それらに基づき、各軸の補正係数Mx/Kx,My/Ky,Mz/Kzを求めると(S13)、それらのうち値が最大となる補正係数をMaxAとして選択する(S14)。続いて、ステップS6を実行すると、補正係数MaxAを用いて補正量Adj=MaxA・aを計算し(S15)、位置指令値Pに補正量Adjを加えて修正する(S16)。
ステップS9,S17におけるローパスフィルタ処理は、必要に応じて行えば良い。
第1実施形態におけるバネ定数Kは、(5)式以外の式によって求めても良い。
Claims (6)
- 設置面に対し垂直となる第1軸と、この第1軸に対して垂直となる第2軸と、この第2軸以降に連結される複数の軸のうち、少なくとも1つが前記第2軸に対して平行となる軸を備える4軸以上のアームと、
このアームをサーボ機構を介して駆動制御するロボットの制御装置であって、
前記アームの手先を移動させる最終目標位置が与えられると、前記手先を前記最終目標位置に移動させる速度パターンを生成する速度パターン生成部と、
前記手先を、制御周期毎の通過目標位置に移動させるように、前記サーボ機構に与える角度指令値を算出する指令値算出部と、
前記角度指令値を位置指令値に変換する指令値変換部と、
前記位置指令値に応じて、前記アームのバネ定数を演算するバネ定数演算部と、
前記位置指令値が前記制御周期毎に変化する際の加速度を算出する加速度算出部と、
前記バネ定数、前記アーム及び前記手先に保持されるワークの質量並びに前記加速度から、前記位置指令値の補正量を演算する補正量演算部と、
前記位置指令値を前記補正量に基づき補正すると、補正した位置指令値を角度指令値に逆変換して前記サーボ機構に出力する指令値補正部とを備えるロボットの制御装置。 - 前記バネ定数演算部は、前記アーム全体のバネ定数を演算する請求項1記載のロボットの制御装置。
- 前記バネ定数演算部は、前記第3軸から前記手先までの距離をL3,
前記第1軸から前記手先までの距離をLf,
前記第1軸を基準とする前記第3軸までのバネ定数をK12,
前記第3軸を基準とする前記手先までのバネ定数をK3とすると、
前記補正量を求めるために使用するバネ定数Kを、次式
1/K={1/K12+L3 2/(K3Lf 2)}
で求める請求項2記載のロボットの制御装置。 - 前記バネ定数演算部は、前記通過目標位置におけるx,y,zの各軸方向のバネ定数を演算し、
前記補正量演算部は、前記質量についてもx,y,zの各軸方向の質量を求め、各軸に対応する質量を各軸に対応するバネ定数で除すことで、各軸に対応する補正係数を求め、前記補正係数のうち最大値を示したものを用いて各軸に適用する補正量を決定する請求項1記載のロボットの制御装置。 - 前記指令値補正部は、補正した指令値に対しローパスフィルタ処理を行う請求項1から4の何れか一項に記載のロボットの制御装置。
- 前記指令値補正部は、前記質量を前記バネ定数で除した補正係数に応じて、前記ローパスフィルタの遮断周波数を可変設定する請求項5記載のロボットの制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2017181390A JP6926882B2 (ja) | 2017-09-21 | 2017-09-21 | ロボットの制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2017181390A JP6926882B2 (ja) | 2017-09-21 | 2017-09-21 | ロボットの制御装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2019055457A true JP2019055457A (ja) | 2019-04-11 |
JP6926882B2 JP6926882B2 (ja) | 2021-08-25 |
Family
ID=66106836
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2017181390A Active JP6926882B2 (ja) | 2017-09-21 | 2017-09-21 | ロボットの制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP6926882B2 (ja) |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH07261853A (ja) * | 1994-03-23 | 1995-10-13 | Komatsu Ltd | ロボットの振動低減装置 |
JPH09123075A (ja) * | 1995-11-02 | 1997-05-13 | Kobe Steel Ltd | リンク機構を有する機械の制御方法及びその装置 |
JP2004348250A (ja) * | 2003-05-20 | 2004-12-09 | Yaskawa Electric Corp | ロボット制御装置 |
JP2006272529A (ja) * | 2005-03-30 | 2006-10-12 | Daihen Corp | 産業用ロボット制御装置 |
JP2010058256A (ja) * | 2008-09-08 | 2010-03-18 | Yaskawa Electric Corp | アーム位置調整方法及び装置並びにロボットシステム |
US20100109594A1 (en) * | 2008-10-31 | 2010-05-06 | Okuma Corporation | Position control apparatus for numerically controlled machine |
US20100198405A1 (en) * | 2007-05-24 | 2010-08-05 | Jens Hacker | Movement controller for elastic robot structures |
-
2017
- 2017-09-21 JP JP2017181390A patent/JP6926882B2/ja active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH07261853A (ja) * | 1994-03-23 | 1995-10-13 | Komatsu Ltd | ロボットの振動低減装置 |
JPH09123075A (ja) * | 1995-11-02 | 1997-05-13 | Kobe Steel Ltd | リンク機構を有する機械の制御方法及びその装置 |
JP2004348250A (ja) * | 2003-05-20 | 2004-12-09 | Yaskawa Electric Corp | ロボット制御装置 |
JP2006272529A (ja) * | 2005-03-30 | 2006-10-12 | Daihen Corp | 産業用ロボット制御装置 |
US20100198405A1 (en) * | 2007-05-24 | 2010-08-05 | Jens Hacker | Movement controller for elastic robot structures |
JP2010058256A (ja) * | 2008-09-08 | 2010-03-18 | Yaskawa Electric Corp | アーム位置調整方法及び装置並びにロボットシステム |
US20100109594A1 (en) * | 2008-10-31 | 2010-05-06 | Okuma Corporation | Position control apparatus for numerically controlled machine |
JP2010108399A (ja) * | 2008-10-31 | 2010-05-13 | Okuma Corp | 数値制御機械の位置制御装置 |
Also Published As
Publication number | Publication date |
---|---|
JP6926882B2 (ja) | 2021-08-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11090805B2 (en) | Robot | |
JP5327722B2 (ja) | ロボットの負荷推定装置及び負荷推定方法 | |
KR101864062B1 (ko) | 로봇의 제어 장치 | |
JP5916583B2 (ja) | 多関節ロボットのウィービング制御装置 | |
US20140067119A1 (en) | Robot | |
JP2014046402A (ja) | ロボット | |
JP2014046401A (ja) | ロボット | |
JP5919346B2 (ja) | 軸間干渉を補正するモータ制御装置 | |
JP2015202535A (ja) | 作用された力に応じて移動されるロボットを制御するロボット制御装置 | |
JP2017209762A (ja) | ロボット装置、ロボット制御方法、プログラム、記録媒体及び物品の製造方法 | |
JP2004364396A (ja) | モータの制御装置および制御方法 | |
JP5371882B2 (ja) | 力制御装置 | |
US10350754B2 (en) | Control device for robot | |
JP6661676B2 (ja) | ロボット制御装置 | |
JP6926882B2 (ja) | ロボットの制御装置 | |
JP6915470B2 (ja) | ロボットの制御装置 | |
WO2019012942A1 (ja) | ロボット制御装置 | |
JP2016005296A (ja) | モータ駆動装置の制御方法、モータ駆動装置及びロボット装置 | |
JP6790668B2 (ja) | ロボットの制御装置 | |
JP5633268B2 (ja) | ロボットの制御装置 | |
JP2021003781A (ja) | オーバーシュート量検出方法、オーバーシュート量検出システム、ロボットシステムおよびオーバーシュート量調整方法 | |
JP5870801B2 (ja) | ロボットの制御方法、およびロボットの制御装置 | |
JP6790669B2 (ja) | ロボットの制御装置 | |
JP6252272B2 (ja) | 垂直多関節型ロボットの位置誤差抑制方法 | |
JPH03104576A (ja) | 力制御型ロボット |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20200820 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20210414 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20210420 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20210510 |
|
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: 20210706 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20210719 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 6926882 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |