JP2007058278A - ロストモーション補正機能を有する位置制御装置 - Google Patents
ロストモーション補正機能を有する位置制御装置 Download PDFInfo
- Publication number
- JP2007058278A JP2007058278A JP2005239544A JP2005239544A JP2007058278A JP 2007058278 A JP2007058278 A JP 2007058278A JP 2005239544 A JP2005239544 A JP 2005239544A JP 2005239544 A JP2005239544 A JP 2005239544A JP 2007058278 A JP2007058278 A JP 2007058278A
- Authority
- JP
- Japan
- Prior art keywords
- correction
- lost motion
- command
- amount
- calculator
- 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
Landscapes
- Automatic Control Of Machine Tools (AREA)
- Numerical Control (AREA)
- Control Of Position Or Direction (AREA)
Abstract
【解決手段】変位量算出器3は、反転検出器2で検出した反転信号と位置指令より反転検出してからの位置指令の変位量Δxを算出する。補正量算出器5は、ロストモーションの加速度成分補正量と摩擦成分補正量と変位量成分補正量を加算し位置指令補正量として出力する。
【選択図】図1
Description
Xc=sign(Δx)×(A+B(1−exp[−|Δx|/C]))
により指令補正量Xcを算出する位置指令補正器を有し、該位置指令補正値Xcを前記位置指令値に加算してロストモーション補正を行うことを特徴とする。
Fμ=sign(Δx)×[h(|v|−v1)3+i(|v|−v2)2
+j(|v|−v3)+μ0] ・・・(1)
ここで、v:速度、v1,v2,v3:任意の速度、h,i,j:係数、μ0:定数、sign(Δx):変位量の符号であり、図2の符号器(sign)28である。
Xcx=sign(Δx)×(A+B(1−exp[−|Δx|/C]))
・・・(2)
Δx≧Δx1のとき、
Xcx=A+B(1−exp[(−|Δx|−Δx1)/C])・・・(3−1)
Δx≦−Δx1のとき、
Xcx=−A−B(1−exp[(−|Δx|+Δx1)/C])・・・(3−2)
0<Δx<Δx1のとき、 Xcx=−A−B・・・(3−3)
−Δx<Δx<0のとき、 Xcx=A+B ・・・(3−4)
ここで、A,B,Cは係数である。前記(3−1)式〜(3−4)式で近似した場合のAをA0とし、係数BをB0とすると、図13に示す様な関数となる。また、反転動作を繰り返した場合の位置指令補正量Xcxの時間との関係は、図14の様になる。
Claims (3)
- 位置検出器が取り付けられたサーボモータと、該サーボモータにより駆動される送り軸の位置を制御し、位置指令と前記位置検出器の位置検出値の差からフィードバック制御する位置制御装置において、
前記位置指令値または前記位置検出値より前記送り軸またはサーボモータの方向反転を検出する方向反転検出器と、
方向反転してからの前記位置指令値または前記位置検出値の変位量を算出する変位量算出器と、
該変位量と送り軸またはモータの加速度と送り軸の速度を入力として指令補正値を算出する補正量算出器と、
を備え、
前記補正量算出器は、
前記速度を入力として一次遅れの摩擦成分算出速度を算出する摩擦速度算出器と、
該摩擦速度に応じてロストモーション量の摩擦成分を出力する摩擦成分算出器と、
前記加速度に応じてロストモーション量の加速度成分を出力する加速度成分算出器と、
前記位置変位量に応じてロストモーション量の変位量補正成分を出力する変位量補正成分算出器と、
を有し、
前記ロストモーション量の摩擦成分と前記加速度成分と変位量補正成分を加算し指令補正値とし、
前記指令補正値を前記位置指令値に加算してロストモーション補正を行うことを特徴とするロストモーション補正機能を有する位置制御装置。 - 位置検出器が取り付けられたサーボモータと、該サーボモータにより駆動される送り軸の位置を制御し、位置指令と前記位置検出器の位置検出値の差からフィードバック制御する位置制御装置において、
前記位置指令値または前記位置検出値より前記送り軸またはサーボモータの方向反転と任意時間の停止の有無を検出する方向反転検出器と、
方向反転してからの前記位置指令値または前記位置検出値の変位量を算出する変位量算出器と、
該変位量と送り軸またはモータの加速度と送り軸の速度を入力として指令補正値を算出する補正量算出器と、
を備え、
前記補正量算出器は、速度により可変する係数をA及びBとし、加速度により可変する係数をCとして、式
Xc=sign(Δx)×(A+B(1−exp[−|Δx|/C]))
により指令補正量Xcを算出する位置指令補正器を有し、
該位置指令補正値Xcを前記位置指令値に加算してロストモーション補正を行うことを特徴とするロストモーション補正機能を有する位置制御装置。 - 前記変位量算出器は、反転してから任意変位量分は変位量=0として、その後の変位量をΔxとして出力することを特徴とする請求項1または2のいずれか1項に記載の位置制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2005239544A JP4510723B2 (ja) | 2005-08-22 | 2005-08-22 | ロストモーション補正機能を有する位置制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2005239544A JP4510723B2 (ja) | 2005-08-22 | 2005-08-22 | ロストモーション補正機能を有する位置制御装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2007058278A true JP2007058278A (ja) | 2007-03-08 |
JP4510723B2 JP4510723B2 (ja) | 2010-07-28 |
Family
ID=37921767
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2005239544A Active JP4510723B2 (ja) | 2005-08-22 | 2005-08-22 | ロストモーション補正機能を有する位置制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP4510723B2 (ja) |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2011175308A (ja) * | 2010-02-23 | 2011-09-08 | Osaka Kiko Co Ltd | 工作機械の送り駆動系の制御方法及び制御装置 |
JP2013035095A (ja) * | 2011-08-08 | 2013-02-21 | Fanuc Ltd | タッピング加工装置 |
JP2013206425A (ja) * | 2012-03-29 | 2013-10-07 | Denso Wave Inc | ロボットの制御装置 |
JP2013210809A (ja) * | 2012-03-30 | 2013-10-10 | Okuma Corp | 位置制御装置 |
US8579563B2 (en) | 2007-07-19 | 2013-11-12 | Toshiba Kikai Kabushiki Kaisha | Microscopic geometry cutting device including an arrival time calculator |
WO2014141515A1 (ja) * | 2013-03-14 | 2014-09-18 | 三菱電機株式会社 | サーボ制御装置 |
CN105058160A (zh) * | 2015-09-02 | 2015-11-18 | 芜湖日升重型机床有限公司 | 一种数控机床控制*** |
JP2016148978A (ja) * | 2015-02-12 | 2016-08-18 | キヤノン株式会社 | 位置制御装置及び位置制御方法 |
WO2018073873A1 (ja) * | 2016-10-17 | 2018-04-26 | 三菱電機株式会社 | サーボ制御装置 |
JP2018092357A (ja) * | 2016-12-02 | 2018-06-14 | ファナック株式会社 | サーボモータ制御装置、サーボモータ制御方法及びコンピュータプログラム |
WO2022091941A1 (ja) * | 2020-10-28 | 2022-05-05 | ファナック株式会社 | サーボ制御装置 |
WO2023020477A1 (zh) * | 2021-08-20 | 2023-02-23 | 北京鹰瞳科技发展股份有限公司 | 眼底相机的镜头的控制方法和控制装置 |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106695458A (zh) * | 2017-02-22 | 2017-05-24 | 华中科技大学 | 一种数控机床进给***的摩擦力建模方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH01222302A (ja) * | 1988-03-01 | 1989-09-05 | Yoshiaki Kakino | 数値制御装置 |
JPH0332550A (ja) * | 1989-06-27 | 1991-02-13 | Okuma Mach Works Ltd | 送り軸の位置制御装置 |
JPH07266190A (ja) * | 1994-03-28 | 1995-10-17 | Okuma Mach Works Ltd | 数値制御装置 |
JPH08152910A (ja) * | 1994-09-30 | 1996-06-11 | Mitsubishi Electric Corp | 位置決め装置および外力推定器 |
JPH08263117A (ja) * | 1995-03-27 | 1996-10-11 | Toshiba Mach Co Ltd | 数値制御工作機械のバックラッシ補正装置 |
JP2002023852A (ja) * | 2000-07-04 | 2002-01-25 | Toshiba Mach Co Ltd | 数値制御工作機械の送り機構の補正装置および数値制御工作機械 |
-
2005
- 2005-08-22 JP JP2005239544A patent/JP4510723B2/ja active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH01222302A (ja) * | 1988-03-01 | 1989-09-05 | Yoshiaki Kakino | 数値制御装置 |
JPH0332550A (ja) * | 1989-06-27 | 1991-02-13 | Okuma Mach Works Ltd | 送り軸の位置制御装置 |
JPH07266190A (ja) * | 1994-03-28 | 1995-10-17 | Okuma Mach Works Ltd | 数値制御装置 |
JPH08152910A (ja) * | 1994-09-30 | 1996-06-11 | Mitsubishi Electric Corp | 位置決め装置および外力推定器 |
JPH08263117A (ja) * | 1995-03-27 | 1996-10-11 | Toshiba Mach Co Ltd | 数値制御工作機械のバックラッシ補正装置 |
JP2002023852A (ja) * | 2000-07-04 | 2002-01-25 | Toshiba Mach Co Ltd | 数値制御工作機械の送り機構の補正装置および数値制御工作機械 |
Cited By (19)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9687991B2 (en) | 2007-07-19 | 2017-06-27 | Toshiba Kikai Kabushiki Kaisha | Microscopic geometry cutting device and microscopic geometry cutting method |
US8579563B2 (en) | 2007-07-19 | 2013-11-12 | Toshiba Kikai Kabushiki Kaisha | Microscopic geometry cutting device including an arrival time calculator |
US9126347B2 (en) | 2007-07-19 | 2015-09-08 | Toshiba Kikai Kabushiki Kaisha | Microscopic geometry cutting device and microscopic geometry cutting method |
JP2011175308A (ja) * | 2010-02-23 | 2011-09-08 | Osaka Kiko Co Ltd | 工作機械の送り駆動系の制御方法及び制御装置 |
JP2013035095A (ja) * | 2011-08-08 | 2013-02-21 | Fanuc Ltd | タッピング加工装置 |
JP2013206425A (ja) * | 2012-03-29 | 2013-10-07 | Denso Wave Inc | ロボットの制御装置 |
JP2013210809A (ja) * | 2012-03-30 | 2013-10-10 | Okuma Corp | 位置制御装置 |
JP5885883B2 (ja) * | 2013-03-14 | 2016-03-16 | 三菱電機株式会社 | サーボ制御装置 |
WO2014141515A1 (ja) * | 2013-03-14 | 2014-09-18 | 三菱電機株式会社 | サーボ制御装置 |
US9658608B2 (en) | 2013-03-14 | 2017-05-23 | Mitsubishi Electric Corporation | Servo control apparatus |
JPWO2014141515A1 (ja) * | 2013-03-14 | 2017-02-16 | 三菱電機株式会社 | サーボ制御装置 |
JP2016148978A (ja) * | 2015-02-12 | 2016-08-18 | キヤノン株式会社 | 位置制御装置及び位置制御方法 |
CN105058160A (zh) * | 2015-09-02 | 2015-11-18 | 芜湖日升重型机床有限公司 | 一种数控机床控制*** |
WO2018073873A1 (ja) * | 2016-10-17 | 2018-04-26 | 三菱電機株式会社 | サーボ制御装置 |
JP6333495B1 (ja) * | 2016-10-17 | 2018-05-30 | 三菱電機株式会社 | サーボ制御装置 |
JP2018092357A (ja) * | 2016-12-02 | 2018-06-14 | ファナック株式会社 | サーボモータ制御装置、サーボモータ制御方法及びコンピュータプログラム |
WO2022091941A1 (ja) * | 2020-10-28 | 2022-05-05 | ファナック株式会社 | サーボ制御装置 |
JP7492024B2 (ja) | 2020-10-28 | 2024-05-28 | ファナック株式会社 | サーボ制御装置 |
WO2023020477A1 (zh) * | 2021-08-20 | 2023-02-23 | 北京鹰瞳科技发展股份有限公司 | 眼底相机的镜头的控制方法和控制装置 |
Also Published As
Publication number | Publication date |
---|---|
JP4510723B2 (ja) | 2010-07-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4510723B2 (ja) | ロストモーション補正機能を有する位置制御装置 | |
KR100914349B1 (ko) | 서보모터의 제어방법 | |
JP5885883B2 (ja) | サーボ制御装置 | |
JP4137386B2 (ja) | 数値制御工作機械の制御方法及び数値制御工作機械 | |
JP3129622B2 (ja) | フルクローズド・ループ方式における象限突起補正方法 | |
JP5096019B2 (ja) | サーボモータ制御装置 | |
JP5817428B2 (ja) | 数値制御装置及び摩擦補償方法 | |
US7982425B2 (en) | Position control apparatus | |
JP5875714B2 (ja) | サーボ制御装置およびサーボ制御方法 | |
JP6051970B2 (ja) | 数値制御装置と摩擦補償方法 | |
JP2010079845A (ja) | 数値制御装置 | |
JPH01222302A (ja) | 数値制御装置 | |
US10175676B2 (en) | Servomotor controller, servomotor control method, and computer-readable recording medium | |
JP5991249B2 (ja) | 数値制御装置 | |
JP4510722B2 (ja) | ロストモーション補正機能を有する位置制御装置 | |
CN109324568B (zh) | 位置控制装置 | |
JP5560068B2 (ja) | 制御方法及び制御装置 | |
JP4838817B2 (ja) | ロストモーション解消制御装置 | |
JP3765710B2 (ja) | 工作機械のサーボモータの制御装置 | |
JP2001202136A (ja) | モーションコントローラにおける動的たわみ補正方法およびモーションコントローラ | |
JP4383934B2 (ja) | 駆動制御方法および駆動制御装置 | |
CN213305297U (zh) | 一种采用双编码器的机械间隙冲击抑制装置 | |
JP2003076425A (ja) | 送り駆動系の制御装置 | |
JPH08263117A (ja) | 数値制御工作機械のバックラッシ補正装置 | |
JP2558580B2 (ja) | サーボシステムにおける加速制御方法及び装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20080707 |
|
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: 20100427 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20100430 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20100430 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130514 Year of fee payment: 3 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 4510723 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20160514 Year of fee payment: 6 |