JP4870647B2 - 回転構造物の位置制御方法 - Google Patents
回転構造物の位置制御方法 Download PDFInfo
- Publication number
- JP4870647B2 JP4870647B2 JP2007274051A JP2007274051A JP4870647B2 JP 4870647 B2 JP4870647 B2 JP 4870647B2 JP 2007274051 A JP2007274051 A JP 2007274051A JP 2007274051 A JP2007274051 A JP 2007274051A JP 4870647 B2 JP4870647 B2 JP 4870647B2
- Authority
- JP
- Japan
- Prior art keywords
- error
- rotating structure
- control
- control method
- angle error
- 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.)
- Expired - Fee Related
Links
Images
Landscapes
- Length Measuring Devices With Unspecified Measuring Means (AREA)
- Numerical Control (AREA)
- Control Of Position Or Direction (AREA)
Description
以下、特許文献1に記載の制御装置及び該制御装置における位置制御方法について説明する。特許文献1に記載の制御装置は、回転軸の近傍に回転速度検出器や回転角度検出器を備えており、回転軸をバネ及び剛体と仮定して、上記回転速度検出器等より得られる制御情報に基づいてねじり変形による回転角度誤差量等を推定し、該推定値に基づいてトルク指令値を補正するようになっている。
請求項2に記載の発明は、請求項1に記載の発明において、角度誤差を算出するにあたり、用いるねじり剛性係数を、制御対象位置の回転軸からの距離に応じて予め設定されたテーブルから選択又は予め設定されている所定の関数にもとづき算出して決定することを特徴とするものである。
また、請求項2に記載の発明によれば、制御対象位置の回転軸からの距離に応じて、角度誤差を算出する際に用いるねじり剛性係数を、予め設定されたテーブルから選択又は予め設定されている所定の関数にもとづき算出して決定するため、極めて精度の高い位置制御を実施することができる。
以下、本発明に係る位置制御方法の第1実施例について説明する。
回転構造物1は、たとえば5軸制御立形マシニングセンタ等の工作機械に設置されるトラニオン構造の二軸ユニットであって、図示しない軸受等に支持された旋回軸部4、4を軸としてX軸と平行なA軸周りで揺動自在(回転動作)なトラニオン2、及びトラニオン2上で回転自在なテーブル3とを備えてなる。
図3に示す如く、制御装置では、トラニオン2のA軸周りでの回転動作の制御に係り、NC装置10から入力されるNC位置指令と、トラニオン2を回転させるモータ(駆動部)11に設けられた角度検出器12からの位置フィードバック信号との偏差が0になるような位置制御ループが組まれている。また、微分器13により位置フィードバック信号を微分して得られる速度フィードバック信号と、位置制御部14からの出力信号とを速度制御部15にて比較するとした速度制御ループが、上記位置制御ループの内側に組まれている。尚、速度制御部15から出力されるトルク指令信号は、トルク/電流制御部16を介してモータ11へ伝達される。
以下、本発明に係る位置制御方法の第2実施例について説明する。図5は、回転構造物を模式的に示した説明図であり、図6は、回転動作に係る制御機構を示したブロック構成図である。尚、第1実施例と同じ構成要素については同じ符号を付している。
第2実施例に係る位置制御方法は、回転構造物を弾性体とみなした場合、回転構造物全体が同様に変形するわけではないことに着目して、回転構造物をより正確に位置決めしようとするものである。そこで、誤差推定装置20のテーブルに、ねじり剛性係数KθRを制御対象位置B毎、すなわち回転軸からの距離R毎に夫々対応させて予め設定しておく。そして、NC位置指令にもとづいて算出される距離Rを誤差推定装置20へ入力させることにより、誤差推定装置20では、距離Rに対応するねじり剛性係数KθRをテーブルから選択し、下式(4)により、角度誤差ΔθRを算出する。それから、位置誤差δRについても、距離Rに対応するたわみ剛性係数KδRをテーブルから選択し、下式(5)及び上式(3)により、位置誤差δR(δRY及びδRZ)を算出して、該位置誤差δRを補正量として出力する。
たとえば、誤差推定装置がねじり剛性係数KθRやたわみ剛性係数KδRを決定する方法として、誤差推定装置が、回転軸からの距離Rを変数とした所定の関数によりねじり剛性係数KθRやたわみ剛性係数KδRを算出し決定するような構成としてもよい。
また、回転構造物の弾性変形による角度誤差及び位置誤差を推定するにあたり、該弾性変形に起因する力の種類(たとえば、重力、回転角加速度、外力や負荷重量等といった集中加重)ごとに、用いるねじり剛性係数Kθ又はたわみ剛性係数をKδを関数又はテーブルにより選択(算出)することにより、推定する角度誤差又は位置誤差の精度を更に高めるようにすることも可能である。
さらに、制御対象となる回転構造物の構成も、上述したようなトラニオンに限定されることはなく、テーブルが旋回しないトラニオン等であっても何ら問題はない。
Claims (2)
- 回転構造物の回転軸における誤差である角度誤差と、前記回転軸以外の軸方向への誤差である位置誤差とを補正する位置制御方法であって、
前記回転構造物を回転動作させる駆動部へ出力するトルク指令をもとに、前記回転構造物のねじり剛性係数を用いて角度誤差を算出する第1工程と、
前記トルク指令をもとに、前記回転構造物のたわみ剛性係数を用いて、前記角度誤差の補正により生じる位置誤差を算出する第2工程と、
前記角度誤差及び位置誤差を補正量として出力する第3工程と
を実行する回転構造物の位置制御方法。 - 角度誤差を算出するにあたり、用いるねじり剛性係数を、制御対象位置の回転軸からの距離に応じて予め設定されたテーブルから選択又は予め設定されている所定の関数にもとづき算出して決定する請求項1に記載の回転構造物の位置制御方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2007274051A JP4870647B2 (ja) | 2007-10-22 | 2007-10-22 | 回転構造物の位置制御方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2007274051A JP4870647B2 (ja) | 2007-10-22 | 2007-10-22 | 回転構造物の位置制御方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2009104315A JP2009104315A (ja) | 2009-05-14 |
JP4870647B2 true JP4870647B2 (ja) | 2012-02-08 |
Family
ID=40705936
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2007274051A Expired - Fee Related JP4870647B2 (ja) | 2007-10-22 | 2007-10-22 | 回転構造物の位置制御方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP4870647B2 (ja) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4908377B2 (ja) * | 2007-10-22 | 2012-04-04 | オークマ株式会社 | 回転構造物の位置制御方法 |
CN103163905B (zh) * | 2013-02-06 | 2015-07-15 | 中国科学院西安光学精密机械研究所 | 正切驱动式微秒级高精度角度调节机构 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0434604A (ja) * | 1990-05-31 | 1992-02-05 | Toshiba Corp | ロボットの位置補正方法及び位置補正装置 |
JP4448219B2 (ja) * | 2000-01-19 | 2010-04-07 | 東芝機械株式会社 | モーションコントローラにおける動的たわみ補正方法およびモーションコントローラ |
-
2007
- 2007-10-22 JP JP2007274051A patent/JP4870647B2/ja not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JP2009104315A (ja) | 2009-05-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5096019B2 (ja) | サーボモータ制御装置 | |
US8838275B2 (en) | Robot and robot control method | |
JP5739400B2 (ja) | 被駆動体の位置補正機能を有するサーボ制御装置 | |
JP6846607B2 (ja) | ロボットの制御方法 | |
KR20070096821A (ko) | 서보모터의 제어방법 | |
JP5657633B2 (ja) | 移動体が反転するときの位置誤差を補正するサーボ制御装置 | |
JP2014013554A (ja) | ボールネジの伸縮量を補正する機能を備えたサーボ制御装置 | |
WO2017047048A1 (ja) | 加工ツールの位置決め装置及び位置決め方法 | |
WO2018212305A1 (ja) | モータ制御システム、モータ制御システムの制御方法、及びロボットシステム | |
JP4299865B2 (ja) | 工作機械の制御装置及び制御方法 | |
JP4908377B2 (ja) | 回転構造物の位置制御方法 | |
JP4361285B2 (ja) | 数値制御装置 | |
JP4870647B2 (ja) | 回転構造物の位置制御方法 | |
US11141855B2 (en) | Robot system, method of controlling robot arm, recording medium, and method of manufacturing an article | |
JP2009104316A (ja) | 回転構造物の位置制御方法 | |
JP2006293624A (ja) | 多軸制御装置 | |
JP6998514B2 (ja) | ロボット制御装置 | |
JPWO2018061283A1 (ja) | ロボットの制御方法及び溶接方法 | |
JP6088601B2 (ja) | 走行軸付きロボットにおけるツール先端の振れを抑制するロボット制御装置 | |
JP6767436B2 (ja) | 自動機械及び制御装置 | |
CN110871456A (zh) | 机器人 | |
JP7194910B2 (ja) | ロボット制御方法及びロボット制御装置 | |
JP5203010B2 (ja) | 部品把持装置とその方法 | |
JP5381039B2 (ja) | 多関節マニピュレータの先端位置制御方法および多関節マニピュレータ | |
JP4842903B2 (ja) | 数値制御装置及び数値制御方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20100729 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20110301 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20110303 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20110426 |
|
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: 20111018 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20111117 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 Ref document number: 4870647 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20141125 Year of fee payment: 3 |
|
LAPS | Cancellation because of no payment of annual fees |