JP5817428B2 - 数値制御装置及び摩擦補償方法 - Google Patents
数値制御装置及び摩擦補償方法 Download PDFInfo
- Publication number
- JP5817428B2 JP5817428B2 JP2011231584A JP2011231584A JP5817428B2 JP 5817428 B2 JP5817428 B2 JP 5817428B2 JP 2011231584 A JP2011231584 A JP 2011231584A JP 2011231584 A JP2011231584 A JP 2011231584A JP 5817428 B2 JP5817428 B2 JP 5817428B2
- Authority
- JP
- Japan
- Prior art keywords
- friction
- torque
- moving body
- moving direction
- moving
- 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.)
- Active
Links
Images
Description
・f(x')=総摩擦トルク〔N・m〕
・f1(x')=テーブル反転後から増加する摩擦トルク〔N・m〕
・f2(x')=テーブルが反転後、所定量移動した後に増加する摩擦トルク〔N・m〕
・fc0=テーブル反転後から変化する摩擦トルクを反転後の移動量に対して二種類の傾き成分に分解し、第一の傾き成分の反転からの立ち上がり摩擦トルク〔N・m〕
・a0=上記第一の傾き成分の立ち上がり距離定数[mm]
・a1=前記第二の傾き成分の立ち上がり距離定数〔mm〕
・fc1=テーブル反転後から変化する動摩擦トルクの総和値〔N・m〕
・fc2=テーブル反転後、前記所定量移動した後に増加するボール螺子軸と一対のボールナットに起因する動摩擦トルク(ボール螺子軸とナットの定常時(三点接触)の動摩擦トルク)〔N・m〕
・a2=テーブルが反転後、所定量移動した後に増加する摩擦トルクの立ち上がり距離定数〔mm〕
・b=テーブルが反転した後にf2(x')が増加し始めるまでの距離〔mm〕
・x'=テーブルの運動方向反転位置からの変位〔mm〕
・sgn=符号関数
sgnはdx'/dt>0の時は+1、dx'/dt=0の時は0、dx'/dt<0の時は−1とする。a1、a2、fc1、fc2、bは、図16に示すダブルナット方式で円弧補間運動を行った時のヒステリシス曲線において示した。第一の傾き成分は第二の傾き成分より傾きが急である。
・f1(x')=fc0{tanh(|x'|/a0)−1/2}sgn(dx'/dt)+(fc1+fc2/2−fc0/2){2tanh(|x'|/a1)−1}sgn(dx'/dt)・・・(1)
・f2(x')=fc2{tanh((|x'|−b)/a2)−1/2}sgn(dx'/dt)・・・(2)
|x'|−b<0の場合、f2(x')=−fc2/2・sgn(dx'/dt)とする。(2)式はダブルナット予圧方式の摩擦に対応する。ダブルナット予圧方式の摩擦はナットが反転して所定量移動した後増加する。
・f(x')=f1(x')+f2(x')・・・(3)
・f1(x')=fc0{1/2−exp(−|x'|/a0)}sgn(dx'/dt)+(fc1+fc2/2−fc0/2){1−2exp(−|x'|/a1)}sgn(dx'/dt)・・・(4)
・f2(x')=fc2{1/2−exp{−(|x'|−b)}/a2}sgn(dx'/dt)・・・(5)
|x'|−b<0の場合、f2(x')=−fc2/2・sgn(dx'/dt)とする。
・f2(x')=−fc2/2cos{{(|x'|−b)/a2}π}sgn(dx'/dt)・・・(6)
|x'|−b<0、又は|x'|−b−a2>0の場合、f2(x')=−fc2/2・sgn(dx'/dt)とする。
・ df1/dx'=2fc0/a0{1−tanh2(|x'|/a0)}+1/a1(2fc1+fc2−fc0){1−tanh2(|x'|/a1)}・・・(7)
・df2/dx'=fc2/a2{1−tanh2{(|x'|−b)/a2}}・・・(8)
|x'|−b<0の場合、df2/dx'=0とする。
12 速度制御器
13 摩擦補償器
21 実位置推定部
24 積分器
29 応答遅れ補償部
26 第一摩擦特性推定部
27 第二摩擦特性推定部
Claims (9)
- ボール螺子軸と該ボール螺子軸に外嵌するボールナットとを有し該ボールナットに固定した移動体を移動する送り機構と、前記ボール螺子軸を回転駆動するモータと、前記モータで移動した移動体の位置を検出する位置検出機構と、該位置検出機構によって検出した移動体の位置と制御部が生成する位置指令とが一致するように速度指令を生成する速度生成部と、前記モータの速度を検出する速度検出機構と、前記速度検出機構が検出した速度と前記速度生成部が生成した速度指令とが一致するようにトルク指令を生成するトルク生成部と、前記モータの回転方向が反転後に発生する摩擦力又は摩擦トルクを推定する摩擦推定部と、前記摩擦推定部で推定した摩擦力又は摩擦トルクに基づいて前記トルク指令を補正する補正部とを備えた数値制御装置において、
前記ボールナットは一対のボールナットで構成し、
前記移動体の移動方向が反転後から増加する前記送り機構に起因する摩擦力又は摩擦トルクを推定する第一摩擦推定部と、
前記移動体の移動方向が反転後に所定量移動した後、前記ボール螺子軸と一対のボールナットに起因して増加する摩擦力又は摩擦トルクを推定する第二摩擦推定部を備え、
前記摩擦推定部は前記第一摩擦推定部と前記第二摩擦推定部の夫々で推定した摩擦力又は摩擦トルクを加算することを特徴とする数値制御装置。 - 前記一対のボールナットは複数の球を有し、
前記所定量は前記移動体の移動方向が反転後に前記複数の球の内少なくとも一個が前記一対のボールナットと前記ボール螺子軸に対して三点で接触するまで、前記移動体が移動する距離であることを特徴とする請求項1に記載の数値制御装置。 - 前記位置指令に対応する前記移動体の実位置を推定する実位置推定部と、
前記実位置推定部で推定した実位置に基づいて前記移動体の移動方向が反転した後の変位を算出する算出部とを更に備え、
前記第一摩擦推定部と前記第二摩擦推定部は前記算出部によって算出した変位を変数とした近似式であることを特徴とする請求項1又は2に記載の数値制御装置。 - 前記第一摩擦推定部の前記近似式f1(x')、前記第二摩擦推定部の前記近似式f2(x')は、前記移動体の移動方向の反転後から変化する摩擦力又は摩擦トルクを反転後の移動量に対して第一の傾きの成分と該第一の傾き成分より傾きが緩い第二の傾き成分とに分解し、前記移動体の移動方向反転位置からの変位をx'、前記第一の傾き成分の反転からの立ち上がり摩擦力又は摩擦トルクをfc0、前記第一の傾き成分の立ち上がり距離定数をa0、前記第二の傾き成分の立ち上がり距離定数をa1、前記移動体の移動方向の反転後から変化する動摩擦力又は動摩擦トルクの総和値をfc1、前記移動体の移動方向が反転後、前記所定量移動した後に増加するボール螺子軸と一対のボールナットに起因する動摩擦力又は動摩擦トルクをfc2、前記所定量をb、前記移動体の移動方向の反転後から前記所定量b移動した後に増加する摩擦力又は摩擦トルクの立ち上がり距離定数をa2、符号関数をsgnとして、
であることを特徴とする請求項3に記載の数値制御装置。 - 前記第一摩擦推定部の前記近似式f1(x')、前記第二摩擦推定部の前記近似式f2(x')は、前記移動体の移動方向の反転後から変化する摩擦力又は摩擦トルクを反転後の移動量に対して第一の傾き成分と該第一の傾き成分より傾きが緩い第二の傾き成分とに分解し、前記移動体の移動方向反転位置からの変位をx'、前記第一の傾き成分の反転からの立ち上がり摩擦力又は摩擦トルクをfc0、前記第一の傾き成分の立ち上がり距離定数をa0、前記第二の傾き成分の立ち上がり距離定数をa1、前記移動体の移動方向の反転後から変化する動摩擦力又は動摩擦トルクの総和値をfc1、前記移動体の移動方向が反転後、前記所定量移動した後に増加するボール螺子軸と一対のボールナットに起因する動摩擦力又は動摩擦トルクをfc2、前記所定量をb、前記移動体の移動方向の反転後から前記所定量b移動した後に増加する摩擦力又は摩擦トルクの立ち上がり距離定数をa2、符号関数をsgnとして、
であることを特徴とする請求項3に記載の数値制御装置。 - 前記第一摩擦推定部の前記近似式f1(x')、前記第二摩擦推定部の前記近似式f2(x')は、前記移動体の移動方向の反転後から変化する摩擦力又は摩擦トルクを反転後の移動量に対して第一の傾き成分と該第一の傾き成分よりも傾きが緩い第二の傾き成分とに分解し、前記移動体の移動方向反転位置からの変位をx'、前記第一の傾き成分の反転からの立ち上がり摩擦力又は摩擦トルクをfc0、前記第一の傾き成分の立ち上がり距離定数をa0、前記第二の傾き成分の立ち上がり距離定数をa1、前記移動体の移動方向の反転後から変化する動摩擦力又は動摩擦トルクの総和値をfc1、前記移動体の移動方向が反転後、前記所定量移動した後に増加するボール螺子軸と一対のボールナットに起因する動摩擦力又は動摩擦トルクをfc2、前記所定量をb、前記移動体の移動方向の反転後から前記所定量b移動した後に増加する摩擦力又は摩擦トルクの立ち上がり距離定数をa2、符号関数をsgnとして、
であることを特徴とする請求項3に記載の数値制御装置。 - 前記第一摩擦推定部の前記近似式f1(x')、前記第二摩擦推定部の前記近似式f2(x')は、前記移動体の移動方向の反転後から変化する摩擦力又は摩擦トルクを反転後の移動量に対して第一の傾き成分と該第一の傾き成分よりも傾きが緩い第二の傾き成分とに分解し、前記移動体の移動方向反転位置からの変位をx'、前記第一の傾き成分の反転からの立ち上がり摩擦力又は摩擦トルクをfc0、前記第一の傾き成分の立ち上がり距離定数をa0、前記第二の傾き成分の立ち上がり距離定数をa1、前記移動体の移動方向の反転後から変化する動摩擦力又は動摩擦トルクの総和値をfc1、前記移動体の移動方向が反転後、前記所定量移動した後に増加するボール螺子軸と一対のボールナットに起因する動摩擦力又は動摩擦トルクをfc2、前記所定量をb、前記移動体の移動方向の反転後から前記所定量b移動した後に増加する摩擦力又は摩擦トルクの立ち上がり距離定数をa2、符号関数をsgnとして、
であることを特徴とする請求項3に記載の数値制御装置。 - ボール螺子軸と該ボール螺子軸に外嵌するボールナットとを有し該ボールナットに固定した移動体を移動する送り機構と、前記ボール螺子軸を回転駆動するモータと、前記モータで移動した移動体の位置を検出する位置検出機構とを備えた数値制御装置が行い、前記位置検出機構が検出した移動体の位置と制御部が生成する位置指令とが一致するように速度指令を生成する速度生成工程と、前記モータの速度を検出する速度検出工程と、前記速度検出工程が検出した速度と前記速度生成工程が生成した速度指令とが一致するようにトルク指令を生成するトルク生成工程と、前記モータの回転方向を反転後に発生する摩擦力又は摩擦トルクを推定する摩擦推定工程と、前記摩擦推定工程で推定した摩擦力又は摩擦トルクに基づいて前記トルク指令を補正する補正工程とを備えた摩擦補償方法において、
前記ボールナットは一対のボールナットで構成し、
前記移動体の移動方向が反転後から増加する前記送り機構に起因する摩擦力又は摩擦トルクを推定する第一摩擦推定工程と、
前記移動体の移動方向が反転後に所定量移動した後、前記ボール螺子軸と一対のボールナットに起因して増加する摩擦力又は摩擦トルクを推定する第二摩擦推定工程とを備え、
前記摩擦推定工程は、前記第一摩擦推定工程と前記第二摩擦推定工程の夫々で推定した摩擦力又は摩擦トルクを加算することを特徴とする摩擦補償方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2011231584A JP5817428B2 (ja) | 2010-10-22 | 2011-10-21 | 数値制御装置及び摩擦補償方法 |
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2010237836 | 2010-10-22 | ||
JP2010237836 | 2010-10-22 | ||
JP2011231584A JP5817428B2 (ja) | 2010-10-22 | 2011-10-21 | 数値制御装置及び摩擦補償方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2012108892A JP2012108892A (ja) | 2012-06-07 |
JP5817428B2 true JP5817428B2 (ja) | 2015-11-18 |
Family
ID=46038963
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2011231584A Active JP5817428B2 (ja) | 2010-10-22 | 2011-10-21 | 数値制御装置及び摩擦補償方法 |
Country Status (2)
Country | Link |
---|---|
JP (1) | JP5817428B2 (ja) |
CN (1) | CN102455683B (ja) |
Families Citing this family (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5657633B2 (ja) | 2012-12-14 | 2015-01-21 | ファナック株式会社 | 移動体が反転するときの位置誤差を補正するサーボ制御装置 |
JP6048174B2 (ja) * | 2013-01-31 | 2016-12-21 | ブラザー工業株式会社 | 数値制御装置とロストモーション補償方法 |
JP6051970B2 (ja) * | 2013-03-12 | 2016-12-27 | ブラザー工業株式会社 | 数値制御装置と摩擦補償方法 |
WO2014141515A1 (ja) | 2013-03-14 | 2014-09-18 | 三菱電機株式会社 | サーボ制御装置 |
JP5991249B2 (ja) * | 2013-03-27 | 2016-09-14 | ブラザー工業株式会社 | 数値制御装置 |
CN105700470B (zh) * | 2016-02-01 | 2017-12-29 | 华中科技大学 | 一种用于减小机床伺服进给系统跟踪误差的方法 |
JP6834528B2 (ja) | 2017-01-25 | 2021-02-24 | オムロン株式会社 | 制御装置、制御プログラムおよび制御システム |
JP6719678B2 (ja) * | 2017-08-28 | 2020-07-08 | 三菱電機株式会社 | 数値制御装置 |
CN108984831B (zh) * | 2018-06-07 | 2022-11-15 | 武汉理工大学 | 一种双丝杠驱动系统传动链刚度建模方法 |
CN112114559B (zh) * | 2020-09-11 | 2021-09-03 | 苏州浩智工业控制技术有限公司 | 基于现场总线的扭矩前馈的过象限补偿方法及装置 |
TWI778729B (zh) * | 2021-07-30 | 2022-09-21 | 新代科技股份有限公司 | 傳動裝置及其控制方法 |
CN113586692B (zh) * | 2021-07-30 | 2023-09-01 | 新代科技(苏州)有限公司 | 传动装置及其控制方法 |
JP2023109649A (ja) * | 2022-01-27 | 2023-08-08 | 国立大学法人 東京大学 | 工作機械、工作機械用制御装置および工作機械制御方法 |
Family Cites Families (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR0179763B1 (ko) * | 1995-11-23 | 1999-04-01 | 이종수 | 공작 기계의 위치 제어 장치 |
JP3351990B2 (ja) * | 1997-05-27 | 2002-12-03 | オークマ株式会社 | ボールネジ駆動系の位置制御装置 |
WO2002039574A1 (en) * | 2000-11-01 | 2002-05-16 | Mitsubishi Denki Kabushiki Kaisha | Servo controller and method |
JP3840429B2 (ja) * | 2002-04-30 | 2006-11-01 | オークマ株式会社 | 位置制御装置 |
JP2004362204A (ja) * | 2003-06-04 | 2004-12-24 | Toshiba Mach Co Ltd | 工作機械における摩擦力測定方法及び同方法により得られた測定値を用いる数値制御装置 |
JP2006121806A (ja) * | 2004-10-20 | 2006-05-11 | Yaskawa Electric Corp | モータ制御装置における摩擦補償方法およびモータ制御装置 |
JP2007257515A (ja) * | 2006-03-24 | 2007-10-04 | Toshiba Mach Co Ltd | サーボモータの制御方法 |
JP4581096B2 (ja) * | 2007-02-27 | 2010-11-17 | 国立大学法人東京農工大学 | 摩擦補償方法、摩擦補償器及びモータ制御装置 |
JP5139164B2 (ja) * | 2008-06-10 | 2013-02-06 | オークマ株式会社 | 位置制御装置 |
-
2011
- 2011-10-21 JP JP2011231584A patent/JP5817428B2/ja active Active
- 2011-10-21 CN CN201110325809.8A patent/CN102455683B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
JP2012108892A (ja) | 2012-06-07 |
CN102455683A (zh) | 2012-05-16 |
CN102455683B (zh) | 2014-08-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5817428B2 (ja) | 数値制御装置及び摩擦補償方法 | |
JP6051970B2 (ja) | 数値制御装置と摩擦補償方法 | |
JP4581096B2 (ja) | 摩擦補償方法、摩擦補償器及びモータ制御装置 | |
JP5885883B2 (ja) | サーボ制御装置 | |
JP4510723B2 (ja) | ロストモーション補正機能を有する位置制御装置 | |
JP5096019B2 (ja) | サーボモータ制御装置 | |
JP6214948B2 (ja) | 摩擦補償装置及び摩擦補償方法並びにサーボ制御装置 | |
JP4014162B2 (ja) | 工作機械の位置制御装置及び工作機械の位置制御方法 | |
JP5739400B2 (ja) | 被駆動体の位置補正機能を有するサーボ制御装置 | |
JP5875714B2 (ja) | サーボ制御装置およびサーボ制御方法 | |
JP2010049599A (ja) | 工作機械 | |
US10175676B2 (en) | Servomotor controller, servomotor control method, and computer-readable recording medium | |
JP6185374B2 (ja) | 制御装置及び制御方法 | |
JP4361285B2 (ja) | 数値制御装置 | |
JP4448219B2 (ja) | モーションコントローラにおける動的たわみ補正方法およびモーションコントローラ | |
JP5834885B2 (ja) | 数値制御装置及び摩擦補償方法 | |
JP3765710B2 (ja) | 工作機械のサーボモータの制御装置 | |
CN108073188B (zh) | 伺服电动机控制装置 | |
JP2003076425A (ja) | 送り駆動系の制御装置 | |
JP6048174B2 (ja) | 数値制御装置とロストモーション補償方法 | |
WO2018142868A1 (ja) | 位置制御装置及び方法 | |
WO2020203876A1 (ja) | 産業機械、制御装置、制御補正装置、および制御方法 | |
JP2018092357A (ja) | サーボモータ制御装置、サーボモータ制御方法及びコンピュータプログラム | |
JP2005266932A (ja) | 駆動制御方法および駆動制御装置 | |
JP4750496B2 (ja) | 数値制御工作機械のロストモーション補正方法及び数値制御工作機械 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20140603 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20150312 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20150428 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20150522 |
|
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: 20150901 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20150914 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 5817428 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |