TW200523702A - Control calculation device - Google Patents
Control calculation device Download PDFInfo
- Publication number
- TW200523702A TW200523702A TW093133873A TW93133873A TW200523702A TW 200523702 A TW200523702 A TW 200523702A TW 093133873 A TW093133873 A TW 093133873A TW 93133873 A TW93133873 A TW 93133873A TW 200523702 A TW200523702 A TW 200523702A
- Authority
- TW
- Taiwan
- Prior art keywords
- error
- signal
- control
- err
- aforementioned
- Prior art date
Links
- 238000004364 calculation method Methods 0.000 title claims abstract description 78
- 238000001514 detection method Methods 0.000 claims abstract description 29
- 238000011156 evaluation Methods 0.000 claims description 2
- 238000005259 measurement Methods 0.000 claims 1
- 238000010586 diagram Methods 0.000 description 15
- 230000000694 effects Effects 0.000 description 12
- 230000005540 biological transmission Effects 0.000 description 10
- 101001038335 Homo sapiens Serine/threonine-protein kinase LMTK2 Proteins 0.000 description 1
- 241000282376 Panthera tigris Species 0.000 description 1
- 102100040292 Serine/threonine-protein kinase LMTK2 Human genes 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000000034 method Methods 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 229920006395 saturated elastomer Polymers 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 238000004904 shortening Methods 0.000 description 1
- 230000001629 suppression Effects 0.000 description 1
- 210000002105 tongue Anatomy 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B11/00—Automatic controllers
- G05B11/01—Automatic controllers electric
- G05B11/36—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential
- G05B11/42—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential for obtaining a characteristic which is both proportional and time-dependent, e.g. P. I., P. I. D.
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/0205—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric not using a model or a simulator of the controlled system
- G05B13/024—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric not using a model or a simulator of the controlled system in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Evolutionary Computation (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Feedback Control In General (AREA)
- Control Of Position Or Direction (AREA)
- Control Of Electric Motors In General (AREA)
Description
200523702 (1) 九、發明說明 【發明所屬之技術領域】 本發明,係關於一種依據指令作動控制對象的位置之 控制演算裝置。換句話說,係關於一種藉著根據輸入的位 置指令與檢測出的電動機的位置.速度檢測値來產生對應 電動機的電流(扭力)指令,控制結合電動機的負載機械 的定位之伺服控制裝置的控制演算裝置。 【先前技術】 使用先前的前饋信號的控制演算裝置,係執行PID控 制使位置前饋信號與位置檢測値一致,且執行PID控制使 速度前饋信號與速度檢測値一致(例如,請參閱文獻1 ) 〇 第7圖,係表示控制馬達的位置等之先前的馬達控制 系統的構成之方塊圖。在於圖中,1係驅動屬於負載的機 械類的電動機,2係連接到此一電動機的扭力傳達機構, 3係藉由連接到傳達機構2之電動機1驅動的負載機械, 1 9係檢測出電動機1的實際速度及實際位置後輸出實際 速度信號ω μ及實際位置信號0 μ的位置速度檢測器,5 係扭力控制電路。 減算器2 4,係從位置指令信號0 μ *減去第1模擬位 置信號0 A i後,將所得到的偏差信號(β μ * - θ A】)輸出 到第1的位置控制電路2 5。第1的位置控制電路2 5爲了 使該偏差信號(θ Μ* - θ A1 )減少予以控制成將第1速度 -4- 200523702 (2) ί§ 5虎6J 1 輸出到減算器2 6來(9 a !追縱(9 μ 。減算器2 6 ,係從屬於第1的位置控制電路2 5的出力之第1速度信 號ω /減去第1模擬速度信號ω Α!後,將所得到的偏差 信號(ω ω A1 )輸出到第1速度控制電路1 6。第1速 度控制電路1 6的控制係輸入偏差信號(ω& A !)來使 其偏差信號(ω i+ - ω a !)減少後,將第1扭力信號τ/ 輸出到減算器1 5。減算器1 5,係從該第1扭力信號丁/ 減去補償扭力演算電路1 4的出力Tc後,將所得到的第3 φ 扭力信號T/輸出到加算器6與減算器1 8。減算器18, 係從第3扭力信號T 3 *減去屬於扭力傳達機構模擬電路 1 〇的出力之模擬傳達扭力信號TF後,將所得到的偏差信 號(T3 # - T F )輸出到電動機模擬電路2 7。電動機模擬電 路2 7 ’係模擬電動機1的傳達函數的同時輸入(τ 3 * - T f )來將第1模擬位置信號0 A!輸出到減算器2 0與減算器 24,此外,將第1模擬速度信號a i輸出到減算器1 1與 減算器1 2、減算器2 2。減算器1 1 ’係從第1模擬速度信 鲁 號ω a i減去第2模擬速度信號ω A2後,將所得到的偏差 信號(ω a ! - ω Μ )輸出到扭力傳達機構模擬電路1 〇。扭 力傳達機構模擬電路1 0,係模擬扭力傳達機構2的傳達 函數的同時’輸入偏差信號(ω · ω Α2 )後將模擬傳達 扭力ig號T F輸出到負載機械模擬電路9與減算器1 8。負 載機械模擬電路9,係除了模擬負載機械3的傳達函數的 同時,輸入扭力信號T F後將第2模擬速度信號ω A 2輸出 到減算器1 1與減算器丨2。減算器1 2,係從第1模擬速度 -5- 200523702 (3) 信號ω a !減去第2模擬速度信號ω A 2後,將所得到的偏 差信號(ω a ! - ω A2 )輸出到補償扭力演算電路1 4。補償 扭力演算電路1 4,係輸入偏差信號(ω a ^ - ω A2 )後將補 償扭力信號Tc輸出到減算器1 5來使負載機械追蹤速度指 令信號ω n/ 。減算器2 0,係從第1位置信號0 A!減去實 際位置信號0 μ後,將所得到的偏差信號(0 A i - 0 M )輸 出到第2位置控制電路2 1。第2位置控制電路2 1,係爲 使偏差信號(Θ a 1 - 0 Μ )減少而控制成將第2速度信號 鲁 ω2*輸出到加算器22後由0Μ追蹤ΘΑ1。加算器22,係 合算第1速度信號ω a i與第2速度信號ω 2 +予以輸出到 減算器23。減算器23,係從加算器22的出力減去實際速 度信號ω μ後,將所得到的偏差信號(2 + + ω Α , _ ω Μ ) 輸出到第2速度控制電路8。第2速度控制電路8係爲了 使速度偏差(ω a i - ω μ )減少而控制成將第2扭力信號 Τ/輸出到加算器6後使實際速度信號ω Μ追蹤第1模擬 速度信號ω a 1。加算器6,係合算第3扭力信號Τ 3 *與第 2扭力信號T/後,將所得到的扭力指令信號τΜ*輸出 到扭力控制電路5。扭力控制電路5,係輸入扭力指令信 號Tn/來驅動電動機1。電動機1,係介隔著扭力傳達機 構2來驅動負載機械3。此外’在於電動機1搭載速度檢 測器1 9,且檢測出電動機1的實際速度與實際位置後輸 出實際速度信號ω μ與實際位置信號β M。 第8圖,係說明第2速度控制電路8的方塊圖。在圖 中,速度控制電路8,係由比例增益KV2的係數器1 〇 8與 -6- 200523702 (4) 積分增益KI2的係數器1 09所構成,當輸入速度偏差信號 (ω A ! - ω Μ )時會形成比例積分控制後輸出扭力信號Τ2 + 的緣故,因此即使發生擾亂的情形也可以予以控制使電動 機1的速度ω Μ追蹤第1模擬速度信號ω Α,。由於利用前 述第1速度控制電路1 6控制ω A i成追蹤ω μ +的緣故,因 此最後被控制成電動機1的速度ω μ追蹤速度指令信號 0ΰ Μ 0 第9圖,係說明第2位置控制電路2 1的方塊圖。在 φ 於同中,增益的ΚΡ2係數器202比例放大位置偏差(0 A1 -0 μ )後輸出第2速度信號ω / 。由於0 A i被控制成追 蹤0 μ *的緣故,因此最後被控制成電動機1的速度0 Μ 追縱速度指令信號(9 Μ 。 如此,先前的控制演算裝置,係根據前饋信號β A !及 ω A1與檢測値0 Μ及ω Μ的偏差信號執行PID控制,可以 抑制前饋模型的誤差或無法預知的擾亂扭力所造成的影響 專利文獻1 :日本專利第3 2 1 4 2 7 〇號公報(第1 0頁 ,圖9 ) 【發明內容】 〔發明所欲解決的課題〕 由於先前的控制演算裝置係屬於PID控制,只有利用 回饋位置迴路的比例增益Κρ (先前例中爲ΚΡ2 )與速度迴 路的比例增益Κν (先前例中爲KV2 )與積分增益Ki (先 200523702 (5) 前例中爲Ki 2 )的三種控制參數來做調整的緣故,會形成 無法細微調整抑制模型化誤差或擾亂的影響成很小時的擾 亂特性之問題。 此外,爲了提昇擾亂特性,使用依據例如預測控制等 的前饋控制與回饋控制的平衡來發揮其效果的控制法則的 情形下,反而會造成控制性的惡化。 本發明有鑑於這些問題所提出,即使當前饋模型針對 實際的控制對象物會發生實際的誤差的情形、或是發生模 φ 型未考慮到未預知的擾亂的情形等時,也可以細微調整抑 制模型化誤差或擾亂的影響成很小時的擾亂特性,此外, 爲了提昇擾亂特性,做成以提昇預測控制等的指令追蹤性 爲目的,且提供一種可以適用以回饋控制的平衡來發揮效 果的控制法則的控制演算裝置爲目的。 〔解決課題的手段〕 因此,本發明係一種控制演算裝置,係屬於輸入位置 Φ 前饋信號xff與扭力前饋信號tff與控制對象的位置檢測 値xfb後,以使前述位置檢測値xfb與前述位置前饋信號 X ff爲一致的方式而計算出操作量並予以輸出的控制演算 裝置,其特徵爲,具備誤差信號算出部與誤差補償演算部 ,前述誤差信號算出部,係將從前饋信號xff減去前述位 置檢測値xfb而得的偏差err,乘以增益α之後所得的信 號當作誤差回饋値err_ref輸出,而且,將改變前述偏差 err的符號再乘上增益/3而得到之信號當作誤差回饋値 200523702 (6) err_fb輸出,在於前述誤差補償演算部,進行控制以使得 前述誤差指令値err_ref與前述誤差回饋値err_fb成一致 而將誤差扭力指令値err_tref輸出,加算前述扭力回饋信 號tff與前述誤差扭力指令値err_tref來當作前述操作量 t r e f ° 〔發明的效果〕 根據申請專利範圍第1項至第4項所記載的發明,當 φ 前饋模型針對實際的控制對象物有發生誤差的情形、或是 發生模型未考慮到的這類未預知的擾亂的情形等時,除了 先前的控制演算裝置所調整之三種控制參數値外,藉由調 整增益α與增益/3形成可以發揮細部微調擾亂特性的效果 。此外,爲了提昇擾亂特性’即使在例如以提昇預測控制 等這類指令追蹤性爲目的,而利用以回饋控制的平衡來發 揮效果的控制法則的情形下,也可以良好地保有控制性, 結果可以得到提昇整體控制性能的效果。 φ 此外,根據申請專利範圍第5項所記載的發明,除了 原來的前饋控制外,爲了降低誤差用,可以有效地適用擁 有前饋的控制,結果可以得到提昇控制性能的效果。 此外’根據申請專利範圍第6項所記載的發明,除了 原來的前饋控制外’爲了降低誤差用,可以有效地適用預 測控制,結果可以得到提昇控制性能的效果。 此外,根據申請專利範圍第7項所記載的發明,由於 先行決定兩個相關的參數之函數的緣故,因此可以得到將 -9- 200523702 (7) 調整用的參數形成一個來縮短調整時間的效果。 [實施方式】 以下’佐以附圖說明本發明的最佳實施方式。此外, 以下說明的本發明之控制演算裝置,係在於第7圖所示的 先前的控制系統中屬於改良點線所示的(A )部份。 實施例1 第1圖,係本發明之控制演算裝置的第1實施例的構 成之方塊圖。在於圖中,1 0 0係本發明的控制演算裝置, 101爲加算器’160爲演算器。第2圖,係表示演算器 1 6 0的構成之方塊圖。在於圖中,丨2 〇爲誤差信號算出部 ,1 3 0爲算出部誤差補償演算部,且1 2 1爲減算器,1 2 2 爲符號反轉器,1 2 3是係數爲α的係數器,1 2 4是係數爲 冷的係數器。 在於這種控制演算裝置1 0 0的構成中,當輸入扭力前 饋信號tff到加算器1 0 1,且輸入位置前饋信號xff與位 置檢測信號xfb到誤差信號算出部1 20時,加算器1 0 1則 加算被輸入的扭力前饋信號tff與演算器1 60演算的誤差 扭力指令err_tref後,輸出扭力指令tref。當誤差信號算 出部1 2 0的減算器1 2 1減算被輸入的位置前饋信號xff與 位置檢測信號xfb後,求出位置偏差en:,並輸出到符號 反轉器1 2 2與係數爲α的係數器1 2 3。符號反轉器1 2 2, 係反轉輸入的位置偏差err的符號後輸出到係數爲yS的係 -10- 200523702 (8) 數器1 24。接著,計數器1 23輸出演算結果的誤差指令 err_ref到誤差補償演算部後,計數器I24將演算結 果的誤差回饋値err —fb輸出到誤差補償演算部1 3 〇。將此 誤差信號算出部1 2 0的輸入輸出的關係以算式表示的5舌則 形成如下。
Err — ref=a - (xff-xfb) (1) err_fb=/3 (xfb-xff) ( 2) 在式子中,兩個係數α、β爲增益,可以被任意設定 · 。此時,若將a與卢的和做爲固定値1時(a + /3 = 1 ) ’ 由於只要調整——方的參數的話就可以決定另一方的緣故’ 可以簡單地調整。a與/3的關係,係並不被限定成此一公 式,可以任意地被設定。 此時,當誤差補償演算部130輸入誤差指令ei:r_i*ef 與誤差回饋値eri二fb時,爲了使這些一致將誤差補正演算 後求出誤差扭力指令err_tref後,輸出到加算器101。 第3圖,係表示誤差補償演算部1 3 0的構成。在於圖 鲁 中,1 3 1、1 3 4係爲減算器,1 3 8爲減算器。此外,1 5 1、 1 3 3係爲微分器,1 3 6爲積分器,S係表示拉普拉斯演算 子。此外,1 3 2、1 3 5、1 3 7、1 5 2,係分別爲係數KP、K v 、K i、K f的係數器,由微分器1 5 1與係數器1 5 2形成F F 控制部1 50。只要是執行這裡所指示的誤差指令err_ref 與誤差回饋値err — fb成爲一致的控制的話,並非限定在如 圖所示的構成’也可以使用例如P I D控制,或者使用控制 對象的模型之2自由度控制等的前饋控制與回饋控制所形 -11 - 200523702 (9) 成的控制亦可。此外,也可以使用控制對象的模型之反傳 達函數補償的控制亦可。 在於本實施例中,說明第3圖所示的前饋控制與回饋 控制所形成的控制的情形。在於圖中,1 5 0是屬於回饋控 制部,誤差補償演算部1 3 0的出力係由式子(3 )算出。 〇 ut = Kv (l=Ki/s){Kp · (err_ref-err_fb) + Kf · s · err_ref-s · e rr_ fb } ( 3 ) 由於這種構成的緣故,當調整擾亂特性時,由於除了 φ 增益 κρ、Kv、Ki、Kf以外,也可以調整增益α與增益/5 的緣故,可以細微地調整擾亂特性,結果可以提昇控制性 tb 。 第4圖,係表示第2實施例的構成。與第1圖及第2 圖相同,符號元件都一樣。在於第2實施例中,不僅位置 與扭力的回饋信號連同輸入的速度前饋信號 v f f、與追加 速度控制部1 4 0的部份也是與第1實施方式不同。在於速 度控制部1 4 0,一般而言使用比例積分控制比較多。 φ 這種情形下,輸入速速前饋信號v fb與速度檢測値 v fb的偏差v e 1· 1·到速度控制部1 4 〇後,將速度控制部丨4 〇 輸出的回饋指令tfb與扭力前饋信號tff與由演算器160 的誤差補償演算部130輸出的誤差扭力指令err__tref三個 加起後的數値當作屬於操作量的扭力指令値t r e f。 如此,爲了使用位置偏差eri:來補償誤差的緣故,除 了用誤差補償演算部130所計算的誤差扭力指令err_uef 以外,做成擁有補償速度前饋信號vff與速度檢測値vfb -12- 200523702 (10) 的誤差之通常的速度控制部1 4 0之構成的緣故,可以更加 地提昇對擾亂的特性。 第5圖,係表示第3實施例的構成。第3實施例係與 第4圖之第2實施例有相同的構成,但是針對演算器1 60 中的誤差補償演算部 130 的出力屬於誤差扭力指令 err_tref而言,第5圖中的演算器160中的誤差補償演算 部130的出力爲誤差速度指令err_verf的部份係爲不一樣 的部份。 這種情形下,加算速度前饋 Vff與誤差速度指令 err_vref後,將減去速度檢測値vfb的信號當作速度偏差 v err來輸入到速度控制部 1 40,形成將加算速度控制部 140的出力之回饋指令tfb與扭力前饋信號tff的數値當作 屬於操作量的扭力指令tref後予以輸出。 在於本發明的誤差補償演算部1 3 0特別是表示預測控 制的情形。 在於預測控制中,例如日本特開平 7 - 0 2 8 5 0 8號公報 所記載的「預見控制裝置」或日本特開平5-82CM89號公 報所記載的「預見控制裝置」等的裝置爲大家所習知。當 使用日本特開平7 -0 2 8 5 0 8號公報所記載的發明的情形時 ,將這次的取樣設爲第i項時,將預測區間設爲Μ後,將 由檢測延遲爲Κ、重量係數 wm、重量係數α、與重量係 數c、與重量係數c d、與這次的位置偏差e ( i - Κ )、與m 個之前的偏差預測値〆(1 + m )所形成的式子(5 )的評 價函數〗做成最小的控制入力U ( i )可由式子(6 )求出 -13- 200523702 (11) 〔數1〕 r(z) == err _ref{i), y{i)二 err u{i) = vref __err(i.) ( 4 ) J - {e\i + m)+ a ' e(7 ~ ^)} + c{w(;)}" + cd{^uQ-)y ( 5) /77 = 1 M Na~\ Nb+K-\ u(i) = ^vmAr(i + w) - ^pnAy(i - K-n)- ^]gnu(i Ee{i - K) ( 6) /;; =—A" + 1 /7=0 /7=1
在此,△ r ( i ),係表示每一指令r ( i )的控制周期 的增量,△ y ( i ),係表示每一控制對象的出力y ( i )的 控制周期的增量。Na與Nb,係分別以脈衝傳達函數表示 從控制入力u到△ y的傳達函數所表示的分母的次數與分 子的次數。 式子(6 )中的參數vm、pn、gn、E,係由控制對象的 模型與各個重量的値所計算出的數値,計算方法詳細地被 記載在日本特開平7 - 02 8 5 0 8號公報所記載的「預見控制 裝置」,在此予以省略。
如此,只要將先前的裝置之位置控制部的部份更換成 本發明的方式,形成以往無法適用的預測控制也毫無問題 的可以適用,結果可以提昇控制性能。 第6圖,係第4實施例的構成圖。第4實施例,係與 第5圖所示的第3實施例幾乎相同,唯一不同的是未輸入 扭力前饋信號tff的部份。這種構成,係使用例如扭力前 饋信號時,會對響應振動時或扭力發生飽和時等有效。可 以發揮本發明的效果。 -14- 200523702 (12) 〔產業上的利用可能性〕 當前饋所考慮的模型與實機的誤差發生時,在於降低 模型誤差的目的上可以毫無疑問地適用擁有預測控制一般 的前饋之控制,而且,只要調整α與的參數,可以微細 地調整實機的響應’也可以適用在被要求需要高速響應、 高精度的定位之半導體製造裝置或電子部品實裝裝置、機 器人、工作機械等的用途。 【圖式簡單說明】 第1圖’係表示本發明之控制演算裝置的構成之第1 實施例的方塊圖。 第2圖’係表示演算器的構成之方塊圖。 第3圖,係表示誤差補償演算部的構成之方塊圖。 第4圖,係第2實施例之方塊圖。 第5圖,係第3實施例之方塊圖。 第6圖,係第4實施例之方塊圖。。 φ 第7圖,係表示先前的控制演算裝置的構成之方塊圖 〇 第8圖,係表示第2速度控制電路的構成之方塊圖。 第9圖,係表示第2位置控制電路的構成之方塊圖。 【主要元件符號說明】 100,100B,100C,100D·.·控制演算裝置 1 015 1 02; 1 21:131,13 4 …減算器 -15- 200523702 (13) 120···誤差信號算出部 130···誤差補償演算部 133,151…微分器 1 3 6…積分器 1 2 2,1 2 3, 1 2 4, 1 3 2, 1 3 5, 1 3 7, 1 5 2.·.係數器 140···速度控制部 150···前饋控制部 160···演算器
Claims (1)
- 200523702 (1) 十、申請專利範圍 1 . 一種控制演算裝置,係屬於輸入位置前饋信號X f f 與扭力前饋信號tff與控制對象的位置檢測値xfb後,以 使前述位置檢測値xfb與前述位置前饋信號xff爲一致的 方式而計算出操作量並予以輸出的控制演算裝置,其特徵 爲, 具備誤差信號算出部與誤差補償演算部,前述誤差信 號算出部,係將從前饋信號xff減去前述位置檢測値xfb φ 而得的偏差err,乘以增益α之後所得的信號當作誤差回 饋値err^ref輸出, 而且,將改變前述偏差err的符號再乘上增益/3而得 到之信號當作誤差回饋値err_fb輸出’ 在於前述誤差補償演算部,進行控制以使得前述誤差 指令値err_ref與前述誤差回饋値err_f.b成一致而將誤差 扭力指令値err-tref輸出, 加算前述扭力回饋信號tff與前述誤差扭力指令値 馨 err_tref來當作前述操作量tref。 2 . —種控制演算裝置,係屬於擁有一速度控制部之控 制演算裝置,該速度控制部係輸入位置前饋信號xff與速 度前饋信號v f f與扭力前饋丨§號t f f與控制對象的位置檢 測値X fb與前述控制對象的速度檢測値V fb後,以使得前 述控制對象的位置檢測値x fb與前述位置前饋信號X ff爲 一致的方式而計算出操作量並予以輸出,其特徵爲, 具備誤差信號算出部與誤差補償演算部,前述誤差信 -17 - 200523702 (2) 號算出部,係將從前述位置前饋信號xff減去前述位置檢 測値X f b而得的偏差e r r,乘以增益α後所得之信號當作 誤差回饋値err_ref輸出, 而且’將改變前述偏差eri:的符號再乘上增益β而得 到的信號當作誤差回饋値err_fb輸出, 在於前述誤差補償演算部,進行控制以使得前述誤差 指令値err_ref與前述誤差回饋値err_fb成一致而將誤差 扭力指令値err_tref輸出, φ 將從前述速度前饋信號v ff減去速度檢測値v fb而得 到之信號verr輸入到前述速度控制部, 將前述扭力前饋信號tff與從前述速度控制部輸出的 回饋扭力指令値tfb與前述誤差扭力指令値err_tref相加 後所得之數値當作前述操作量tref。 3 . —種控制演算裝置,係屬於擁有一速度控制部之控 制演算裝置,該速度控制部係輸入位置前饋信號xff與速 度前饋信號vff與扭力前饋信號tff與控制對象的位置檢 φ 測値xfb與前述控制對象的速度檢測値vfb後,以使得前 述控制對象的位置檢測値xfb與前述位置前饋信號xff爲 一致的方式而計算出操作量並予以輸出,其特徵爲, 具備誤差信號算出部與誤差補償演算部,前述誤差信 號算出部,係將從前述位置前饋信號xff減去前述位置檢 測値xfb而得到的偏差err,乘以增益α所得到之信號當 作誤差回饋値err_ref輸出, 而且,將改變前述偏差err的符號再乘上增益Θ的信 -18- 200523702 (3) 號當作誤差回饋値err_fb輸出, 在於前述誤差補償演算部,係進行控制以使得前述誤 差指令値err —ref與前述誤差回饋値err_fb成一致而將誤 差扭力指令値err_vref輸出, 將前述速度檢測信號 vff與前述誤差速度指令値 予以相加,並減去速度檢測値vfb而得到之信號 輸入到前述速度控制部verr, 將前述扭力前饋信號tff與從前述速度控制部輸出的 回饋扭力指令値t fb相加而成的數値當作前述操作量t r e f ο 4 · 一種控制演算裝置,係屬於具有一速度控制部之控 制演算裝置,該速度控制部係輸入位置前饋信號X ff與速 度則饋信號vff與控制對象的位置檢測値xfb與前述對象 的速度檢測値 vfb,以使得前述控制對象的位置檢測値 X fb與前述位置前饋信號X f f爲一致的方式而計算出操作 量並予以輸出,其特徵爲, 具備誤差信號算出部與誤差補償演算部,前述誤差信 號算出部,係將從前饋信號xff減去前述位置檢測値xfb 而得到的偏差e r 1·,乘以增益α所得到的信號當作誤差回 饋値err__ref輸出, 而且,將改變前述偏差e r r的符號再乘上增益^而得 到之信號當作誤差回饋値en:_fb輸出, 在於前述誤差補償演算部,係進行控制以使得前述誤 差指令値err_ref與前述誤差回饋値err__fb成一致而將誤 200523702 (4) 差扭力指令値err_ref輸出, 將前述速度前饋信號 vff與前述誤差速度指令値 err_vref相加’並減去速度檢測値vfb而得到之信號,輸 入到前述速度控制部verr, 將從前述速度控制部輸出的信號當作前述操作量tref 〇 5 ·如申請專利範圍第1項至第4項之任一項所記載之 控制演算裝置,其中在於前述誤差補償演算部執行前饋控 φ 制與回饋控制。 6 ·如申請專利範圍第1項至第4項之任一項所記載之 控制演算裝置,其中在於前述誤差補償演算部,係進行一 預測控制,是以使得使用控制對象的模型所求出之未來偏 差之預測値,與相關於控制輸入的評價函數爲最小的方式 ,來決定控制輸入;前述未來偏差係前述誤差指令 err_ref與前述誤差回饋値err_fb的差値;且將前述控制 輸入當作誤差補償演算部的輸出。 _ 7 ·如申請專利範圍第1項至第4項之任一項所記載之 控制演算裝置,其中前述增益α與前述增益/3的關係是由 所定的函數來表示,且當決定了任何一方之數値後,就自 動地決定另一方之數値。 -20-
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2003421799A JP2005182427A (ja) | 2003-12-19 | 2003-12-19 | 制御演算装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
TW200523702A true TW200523702A (en) | 2005-07-16 |
Family
ID=34708722
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
TW093133873A TW200523702A (en) | 2003-12-19 | 2004-11-05 | Control calculation device |
Country Status (4)
Country | Link |
---|---|
US (1) | US7463938B2 (zh) |
JP (1) | JP2005182427A (zh) |
TW (1) | TW200523702A (zh) |
WO (1) | WO2005062138A1 (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
TWI407279B (zh) * | 2010-03-08 | 2013-09-01 | Univ Ishou | Positioning controller |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4540727B2 (ja) * | 2008-07-31 | 2010-09-08 | 山洋電気株式会社 | モータ制御装置 |
JP6366563B2 (ja) * | 2014-12-19 | 2018-08-01 | オークマ株式会社 | 工作機械における送り軸の位置制御装置 |
JP6497408B2 (ja) * | 2017-04-14 | 2019-04-10 | 株式会社明電舎 | 電気慣性制御装置 |
Family Cites Families (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4727303A (en) * | 1986-05-22 | 1988-02-23 | Gmf Robotics Corporation | Positional control method and system utilizing same |
US4908747A (en) * | 1988-03-21 | 1990-03-13 | The Babcock & Wilcox Company | Advanced proportional plus integral plus derivative controller |
JP3084928B2 (ja) | 1992-05-29 | 2000-09-04 | 三菱電機株式会社 | 電動機の位置制御装置 |
US5223778A (en) * | 1992-09-16 | 1993-06-29 | Allen-Bradley Company, Inc. | Automatic tuning apparatus for PID controllers |
US5504672A (en) * | 1993-09-10 | 1996-04-02 | Hardiman; Ted L. | Industrial process controller and method of process control |
JP3214270B2 (ja) | 1994-12-08 | 2001-10-02 | 三菱電機株式会社 | 電動機の速度制御装置並びに速度及び位置制御装置 |
KR19990033511A (ko) * | 1997-10-24 | 1999-05-15 | 전주범 | 가상 현실 운동 재현기의 구동 제어 장치 |
US6424873B1 (en) * | 1999-12-30 | 2002-07-23 | Honeywell Inc. | Systems and methods for limiting integral calculation components in PID controllers |
JP4452367B2 (ja) | 2000-03-08 | 2010-04-21 | 三菱電機株式会社 | 位置制御装置 |
US6970750B2 (en) * | 2001-07-13 | 2005-11-29 | Fisher-Rosemount Systems, Inc. | Model-free adaptation of a process controller |
-
2003
- 2003-12-19 JP JP2003421799A patent/JP2005182427A/ja active Pending
-
2004
- 2004-10-21 WO PCT/JP2004/015622 patent/WO2005062138A1/ja active Application Filing
- 2004-10-21 US US10/583,271 patent/US7463938B2/en not_active Expired - Fee Related
- 2004-11-05 TW TW093133873A patent/TW200523702A/zh unknown
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
TWI407279B (zh) * | 2010-03-08 | 2013-09-01 | Univ Ishou | Positioning controller |
Also Published As
Publication number | Publication date |
---|---|
US7463938B2 (en) | 2008-12-09 |
US20070219648A1 (en) | 2007-09-20 |
JP2005182427A (ja) | 2005-07-07 |
WO2005062138A1 (ja) | 2005-07-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Yao et al. | Adaptive robust motion control of linear motors for precision manufacturing | |
Chung et al. | Motion control | |
US8040098B2 (en) | Position controller | |
Kolhe et al. | Robust control of robot manipulators based on uncertainty and disturbance estimation | |
Yao et al. | Adaptive robust precision motion control of a high-speed industrial gantry with cogging force compensations | |
JP2004213472A (ja) | 制御装置 | |
JP3506157B2 (ja) | 電動機の位置制御装置 | |
US20030097193A1 (en) | Position control system and velocity control system for stage driving mechanism | |
US10126734B2 (en) | Servo control apparatus for driving plurality of motors | |
US20160056736A1 (en) | Position control apparatus | |
JP2016164697A (ja) | 位置制御システム | |
JP2008299573A (ja) | ディジタル制御装置 | |
CN114063662B (zh) | 基于动力学转矩补偿的控制方法及控制装置 | |
JP2006215626A (ja) | 位置制御装置 | |
TW200523702A (en) | Control calculation device | |
Lim et al. | An output feedback controller for trajectory tracking of RLED robots using an observed backstepping approach | |
JPH06282305A (ja) | コントローラ | |
JP2005215842A (ja) | サーボ制御装置 | |
JP2013240264A (ja) | モータ制御装置 | |
JP3892824B2 (ja) | モータの位置制御装置 | |
JP2002354857A (ja) | 電動機制御装置 | |
JP2014119903A (ja) | 制御装置、制御プログラムおよび制御方法 | |
JP4038659B2 (ja) | サーボ制御装置 | |
JP2838578B2 (ja) | モータ制御装置、外乱負荷トルク推定装置 | |
JP5037065B2 (ja) | 機械制御装置 |