JP5631787B2 - サーボモータ制御装置及びサーボモータ制御方法 - Google Patents
サーボモータ制御装置及びサーボモータ制御方法 Download PDFInfo
- Publication number
- JP5631787B2 JP5631787B2 JP2011062829A JP2011062829A JP5631787B2 JP 5631787 B2 JP5631787 B2 JP 5631787B2 JP 2011062829 A JP2011062829 A JP 2011062829A JP 2011062829 A JP2011062829 A JP 2011062829A JP 5631787 B2 JP5631787 B2 JP 5631787B2
- Authority
- JP
- Japan
- Prior art keywords
- correction amount
- correction
- servo motor
- reversal
- motor control
- 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
前記検出位置情報に対する補正の開始と終了とを判断する補正動作判定装置と、前記位置指令値と検出位置情報との間の位置誤差を算出する位置誤差算出装置と、
算出された前記位置誤差を記憶する位置誤差記憶部と、記憶した前記位置誤差から補正量を演算する検出位置補正量演算部と、演算した補正量を記憶する検出位置補正量記憶部とからなる補正量演算記憶装置と、
前記検出位置補正量記憶部に記憶された補正量で前記検出位置情報を補正する検出位置補正装置と、を備え、
前記検出位置補正装置は、前記補正動作判定装置による補正の開始判断に伴い、前記検出位置補正量記憶部に記憶された補正量で前記検出位置情報を補正する一方、前記補正量演算記憶装置は、当該補正後の前記移動体の移動制御によって得られる前記検出位置情報と位置指令値との間の位置誤差から新たな補正量を演算して次回の補正時に用いる前記補正量を更新することを特徴とするものである。
請求項2に記載の発明は、請求項1の構成において、前記補正動作判定装置は、前記移動体の移動方向の反転動作を補正の開始と判断することを特徴とするものである。
請求項3に記載の発明は、請求項2の構成において、前記補正量演算記憶装置は、前記位置誤差を反転からの距離との関係で記憶して前記補正量を演算し、前記検出位置補正装置は、前記反転からの距離に応じて補正を行うことを特徴とするものである。
請求項4に記載の発明は、請求項2又は3の構成において、前記補正量演算記憶装置は、反転時の加速度、反転の方向、反転時の座標、反転時のモータトルクのうちの少なくとも1つの情報に基づいて、今回の反転動作が過去の反転動作と同一又は類似か否かを判別し、反転動作が同一又は類似であれば、補正量の演算及び記憶を行うことを特徴とするものである。
請求項5に記載の発明は、請求項4の構成において、前記補正量演算記憶装置は、今回の反転時の座標が過去の反転時の座標を中心として予め設定された範囲内にあれば、反転動作が同一又は類似と判断することを特徴とするものである。
上記目的を達成するために、請求項6に記載の発明は、位置指令値に基づいてサーボモータを駆動制御して移動体の移動を制御すると共に、前記サーボモータに備えた回転検出器と、前記移動体の位置を検出する位置検出器とから得られる検出位置情報に基づいて前記位置指令値の修正を行うサーボモータ制御方法であって、
前記検出位置情報に対する補正の開始を判断する補正開始判定ステップと、
前記位置指令値と検出位置情報との間の位置誤差を算出する位置誤差算出ステップと、
算出された前記位置誤差を記憶する位置誤差記憶ステップと、
記憶した前記位置誤差から補正量を演算する検出位置補正量演算ステップと、
演算した補正量を記憶する検出位置補正量記憶ステップと、
前記検出位置補正量記憶ステップで記憶された補正量で前記検出位置情報を補正する検出位置補正ステップと、
補正後の前記移動体の移動制御によって得られる前記検出位置情報と位置指令値との間の位置誤差から新たな補正量を演算して次回の補正時に用いる前記補正量を更新する補正量更新ステップと、
前記検出位置情報に対する補正の終了を判断する補正終了判定ステップと、
を実行することを特徴とするものである。
請求項2に記載の発明によれば、請求項1の効果に加えて、反転を契機とした補正が可能となる。
請求項3に記載の発明によれば、請求項2の効果に加えて、反転からの距離に応じた補正を行うため、動作中でも適正な補正が可能となる。
請求項4に記載の発明によれば、請求項2又は3の効果に加えて、補正が必要な反転動作を選択して補正可能となる。
請求項5に記載の発明によれば、請求項4の効果に加えて、反転動作の同一又は類似の判断が正確に行える。
図1は、工作機械に用いられるサーボモータ制御装置1の一例を示すブロック図で、位置ループや速度ループ等の基本構成は図7に示したサーボモータ制御装置と同じであるため、重複する説明は省略する。
但し、検出位置補正量演算部29では、反転時情報取得装置22で取得された反転時情報に基づいて、今回の反転動作が過去の反転動作と同一又は類似であるかを判別し、反転動作が同一又は類似の場合にのみ補正量の演算を行うようになっている。
33,33は、減算器14と補正量演算記憶装置23との間及び、検出位置補正装置24における検出位置補正量出力部31と減算器32との間にそれぞれ設けられた開閉器で、反転動作判定装置20における反転開始の判別に伴って閉動作して減算器14からの位置誤差DIFFの入力と補正量の出力とを可能とし、反転終了の判別に伴って開動作する。
まず、S1において、反転動作判定装置20の反転開始判別部25が反転動作の開始を最初に判別すると(補正開始判定ステップ)、S2で反転時情報取得装置22が反転時情報を取得してS3で反転時情報を記憶する。
その後、S4において小さくなった位置誤差DIFF及び反転からの距離ΔLが記憶され、S5で、当該記憶に基づいた補正量の演算、記憶処理とが行われて、補正量の更新がなされる(補正量更新ステップ)。これが次回の補正量となる。
そして、上記形態では、反転動作を契機にして検出位置情報の補正を行っているが、加速動作や減速動作の開始を契機にして当該補正を開始するようにしてもよい。この場合、補正の終了は、加速時点または減速時点からの距離によって判別すればよい。
その他、サーボモータ制御装置の具体的な構成も上記形態に限らず、開閉器をなくしたり、反転時情報として取得するパラメータの増減や変更を行ったり等、適宜変更可能である。
Claims (6)
- 位置指令値に基づいてサーボモータを駆動制御して移動体の移動を制御すると共に、前記サーボモータに備えた回転検出器と、前記移動体の位置を検出する位置検出器とから得られる検出位置情報に基づいて前記位置指令値の修正を行うサーボモータ制御装置であって、
前記検出位置情報に対する補正の開始と終了とを判断する補正動作判定装置と、
前記位置指令値と検出位置情報との間の位置誤差を算出する位置誤差算出装置と、
算出された前記位置誤差を記憶する位置誤差記憶部と、記憶した前記位置誤差から補正量を演算する検出位置補正量演算部と、演算した補正量を記憶する検出位置補正量記憶部とからなる補正量演算記憶装置と、
前記検出位置補正量記憶部に記憶された補正量で前記検出位置情報を補正する検出位置補正装置と、を備え、
前記検出位置補正装置は、前記補正動作判定装置による補正の開始判断に伴い、前記検出位置補正量記憶部に記憶された補正量で前記検出位置情報を補正する一方、前記補正量演算記憶装置は、当該補正後の前記移動体の移動制御によって得られる前記検出位置情報と位置指令値との間の位置誤差から新たな補正量を演算して次回の補正時に用いる前記補正量を更新することを特徴とするサーボモータ制御装置。 - 前記補正動作判定装置は、前記移動体の移動方向の反転動作を補正の開始と判断することを特徴とする請求項1に記載のサーボモータ制御装置。
- 前記補正量演算記憶装置は、前記位置誤差を反転からの距離との関係で記憶して前記補正量を演算し、前記検出位置補正装置は、前記反転からの距離に応じて補正を行うことを特徴とする請求項2に記載のサーボモータ制御装置。
- 前記補正量演算記憶装置は、反転時の加速度、反転の方向、反転時の座標、反転時のモータトルクのうちの少なくとも1つの情報に基づいて、今回の反転動作が過去の反転動作と同一又は類似か否かを判別し、反転動作が同一又は類似であれば、補正量の演算及び記憶を行うことを特徴とする請求項2又は3に記載のサーボモータ制御装置。
- 前記補正量演算記憶装置は、今回の反転時の座標が過去の反転時の座標を中心として予め設定された範囲内にあれば、反転動作が同一又は類似と判断することを特徴とする請求項4に記載のサーボモータ制御装置。
- 位置指令値に基づいてサーボモータを駆動制御して移動体の移動を制御すると共に、前記サーボモータに備えた回転検出器と、前記移動体の位置を検出する位置検出器とから得られる検出位置情報に基づいて前記位置指令値の修正を行うサーボモータ制御方法であって、
前記検出位置情報に対する補正の開始を判断する補正開始判定ステップと、
前記位置指令値と検出位置情報との間の位置誤差を算出する位置誤差算出ステップと、
算出された前記位置誤差を記憶する位置誤差記憶ステップと、
記憶した前記位置誤差から補正量を演算する検出位置補正量演算ステップと、
演算した補正量を記憶する検出位置補正量記憶ステップと、
前記検出位置補正量記憶ステップで記憶された補正量で前記検出位置情報を補正する検出位置補正ステップと、
補正後の前記移動体の移動制御によって得られる前記検出位置情報と位置指令値との間の位置誤差から新たな補正量を演算して次回の補正時に用いる前記補正量を更新する補正量更新ステップと、
前記検出位置情報に対する補正の終了を判断する補正終了判定ステップと、
を実行することを特徴とするサーボモータ制御方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2011062829A JP5631787B2 (ja) | 2011-03-22 | 2011-03-22 | サーボモータ制御装置及びサーボモータ制御方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2011062829A JP5631787B2 (ja) | 2011-03-22 | 2011-03-22 | サーボモータ制御装置及びサーボモータ制御方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2012198785A JP2012198785A (ja) | 2012-10-18 |
JP5631787B2 true JP5631787B2 (ja) | 2014-11-26 |
Family
ID=47180928
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2011062829A Active JP5631787B2 (ja) | 2011-03-22 | 2011-03-22 | サーボモータ制御装置及びサーボモータ制御方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5631787B2 (ja) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6220514B2 (ja) * | 2012-12-13 | 2017-10-25 | 株式会社アマダホールディングス | ロボット制御システムおよびロボット制御方法 |
JP7109490B2 (ja) * | 2020-02-10 | 2022-07-29 | 株式会社牧野フライス製作所 | 数値制御方法及び数値制御装置 |
CN114089694B (zh) * | 2021-11-23 | 2024-03-19 | 广东美的智能科技有限公司 | 位置校正方法与装置、存储介质、伺服驱动器、伺服系统 |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH08118204A (ja) * | 1994-10-24 | 1996-05-14 | Toshiba Mach Co Ltd | 工作機械における位置決め誤差補正方法および位置決め誤差補正装置 |
JP3389417B2 (ja) * | 1996-05-29 | 2003-03-24 | 大阪機工株式会社 | ロストモーションの補正方法 |
JP2003211344A (ja) * | 2002-01-15 | 2003-07-29 | Mori Seiki Co Ltd | Nc旋盤の補正装置 |
JP2006215626A (ja) * | 2005-02-01 | 2006-08-17 | Okuma Corp | 位置制御装置 |
JP2008041011A (ja) * | 2006-08-10 | 2008-02-21 | Okuma Corp | 工作機械における位置補正方法 |
JP4838817B2 (ja) * | 2008-01-09 | 2011-12-14 | 三菱重工業株式会社 | ロストモーション解消制御装置 |
JP4875672B2 (ja) * | 2008-07-24 | 2012-02-15 | 三菱重工業株式会社 | 工作機械 |
JP5168738B2 (ja) * | 2009-03-25 | 2013-03-27 | ブラザー工業株式会社 | 数値制御装置 |
-
2011
- 2011-03-22 JP JP2011062829A patent/JP5631787B2/ja active Active
Also Published As
Publication number | Publication date |
---|---|
JP2012198785A (ja) | 2012-10-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10252418B2 (en) | Load parameter setting method and load parameter setting device | |
KR20150119065A (ko) | 서보 제어 장치 | |
JP5890473B2 (ja) | モータを制御するモータ制御装置 | |
US20010005800A1 (en) | Lost motion correction system and lost motion correction method for numerical control machine tool | |
JP2016140956A (ja) | ロボットハンド制御方法及びロボット装置 | |
US10338563B2 (en) | Numerical control device | |
JP2014135030A (ja) | バックラッシを補正するモータ制御装置 | |
US10031507B2 (en) | Servo control device | |
US20190266296A1 (en) | Machining simulation device of machine tool | |
US11175647B2 (en) | Motor controller | |
WO2010047043A1 (en) | Robot control apparatus | |
US20190061150A1 (en) | Robot system | |
JP5631787B2 (ja) | サーボモータ制御装置及びサーボモータ制御方法 | |
JP2019104097A (ja) | ロボットシステム | |
JP5991249B2 (ja) | 数値制御装置 | |
JPH0371206A (ja) | Nc工作機械の機械誤差補正装置 | |
JP5905521B2 (ja) | 工具先端点制御中に生じるバックラッシを抑制することを特徴とする数値制御装置 | |
JP2020044590A (ja) | ロボット装置 | |
EP3085500B1 (en) | Control method of electric gripper system | |
JP2018069381A (ja) | 把持装置の制御方法、把持装置、ロボット装置、および部品の製造方法 | |
US11559851B2 (en) | Laser machining device and laser machining method | |
JP7003454B2 (ja) | 制御装置、位置制御システム、位置制御方法、および、位置制御プログラム | |
US11003159B2 (en) | Numerical control device | |
WO2022118760A1 (ja) | ロボットを用いた3dプリンタ及びロボットの制御装置 | |
JP2018181029A (ja) | 工作機械送り系の制御装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20130930 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20140617 |
|
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: 20140909 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20141008 |
|
R150 | Certificate of patent (=grant) or registration of utility model |
Ref document number: 5631787 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |