502141 A7 B7 五、發明説明（1) 〔產業上之技術領域〕 (請先閱讀背面之注意事項再填寫本頁) 本發明係屬於一種將控制對象定位之定位伺服控制器 (位置控制裝置），特別是關於將馬達定位之定位伺服控 制器。 〔先前技術〕 第3 0圖係顯示傳統的定位伺服控制器之構造的控制 方塊圖。如第3 0圖所示，傳統的定位伺服控制器係由： 位置控制器1、及速度控制器2、及扭力放大器3、及馬 達4、及微分器5所組成。 此一定位伺服控制器係控制慣量爲J 〔 N · m · s 2〕 之馬達4的位置0〔I· a d〕。 在馬達4具備有編碼器（圖未表示），並利用此編碼 器形成用以檢測馬達4的位置0。自上位裝置（圖未表示 )發出的位置指令0 r與馬達4的位置0之間的偏差値（ β r - Θ )係被輸入到位置控制器1。 經濟部智慧財產局員工消費合作衫邱集 位置控制器1係藉由位置迴路增益K p 〔 1 / s〕， 將該偏差放大K p倍後的數値作爲傳至馬達4之速度指令 ω r 〔 r a d / s〕輸出之比例控制器。 微分器5係將馬達4的位置0〔 r a d〕微分後，將 馬達4的速度ω〔 r a d/s〕輸出。 速度控制器2係輸入速度指令ω r 〔 ：r ad/s〕與 馬達4的速度ω〔 r a d / s〕的速度偏差値後，藉由速 度迴路增益K v〔 N · m · s〕，將該偏差放大K v倍後 本紙張尺度適用中國國家標準（CNS ) Α4規格（210X297公釐） -4 - 502141 A7 B7 五、發明説明（2) 的數値作爲傳送至馬達4之扭力指令T r e f 〔 N · m〕 後輸出之比例控制器。 (請先閲讀背面之注意事項再填寫本頁) 扭力放大器3係將扭力指令T r e f輸入，並產生扭 力T r後驅動馬達4。 換言之，所謂定位伺服控制器係將馬達4的位置0追 隨移動至位置指令0 r的一種控制器，而馬達4的位置0 是位置指令0 r之位置響應。 在這種傳統定位伺服控制器，係使用以被回饋的馬達 4的位置響應0爲基礎進行定位控制之回饋控制方式。 如上所述，通常，定位伺服控制器係在位置迴路處理 之中擁有速度迴路處理當作次迴路。 但是，在這種回饋控制方式的定位伺服控制器，其位 置迴路增益K p、及速度迴路增益K v的數値爲有限値， 有其上限値。 此一緣故，馬達4的位置響應0與位置指令Θ r無法 完全一致，發生所謂的伺服延遲現象。 第3 1圖係顯示傳統的定位伺服控制器的動作之圖表 〇 經濟部智慧財產局員工消費合作社印製 ______—kk 第3 1圖之（a )係顯示位置指令Θ r與位置響應0 的圖表，第3 1圖之（b )係顯示位置指令0 r與位置響 應 0 的微分 d0r/dt、d0/dt。 如第31圖之（a)及第31圖之（b)所示， d 0 r / d t係表示當馬達4以等加速度加速且速度達到 等加速度V〔 r a d / s〕後，限於在一定的時間內以等 本紙張尺度適用中國國家標準（CNS ) A4規格（210X297公釐） -5- 502141 A7 B7 五、發明説明（3) 速度V移動之後、又以等加速度予以減速的指令。 (請先閱讀背面之注意事項再填寫本頁) 在這種情況下’位置偏差爲最大形成爲V/K p，且 當d 0 r / d t的數値變成爲〇之後事實上位置響應（9到 達位置指令0 r値所需要的時間是與1 / K p 〔 s〕成比 例後變得很長。 此外，在第3 1圖顯示··加減速時間=〇 · 1 〔 s〕 、等速度V=100〔rad/s〕、所定的時間= 0.2〔s〕、位置迴路增益Kp=25〔l/s〕、速 度迴路增益Kv = 200〔N.m· s〕、慣量J = 1 〔 Ν·ιη· s2〕的情況下的指令、d0r/dt、以及 響應0、d 0 / d t的變動情形。 在第31圖中，一定偏差V/Kp=l 00/2 5 = 4〔1*3(1〕，00 1*/(11爲〇之後事實上位置響應0 到達位置指令0 r値所需要的時間爲〇 . 1 〔 s〕。 在這樣的定位伺服控制器，爲了消除上述伺服延遲， 同時使用回饋控制方式與前饋控制方式。 經濟部智慧財產局員工消費合作社印製 第3 2圖係顯示同時使用回饋控制方式和前饋控制方 式的定位伺服控制器之構造的控制方塊圖。 在此一'疋位何服控制器’系除了在第2圖中所有的定 位伺服控制器之構造要素以外，尙具備有前饋控制器6、 7 ° 前饋控制器6係輸入位置指令0 r後將位置指令0 r 微分，並藉由第1個前饋增益K f f 1 〔 1/ s〕將該微 分値放大K f f 1倍後的數値輸出。 本紙張尺度適用中國國家標準（CNS ) A4規格（210X297公釐） 一 • 0 - 502141 A7 B7 五、發明説明（4) 此一數値係爲追加到自位置控制器1所輸出的指令速 度指令ω r 〔 1 / s〕之第1前饋控制量。 (請先閲讀背面之注意事項再填寫本頁) 藉此，在第3 2圖所示的定位伺服控制器，可以依據 不包含由位置指令Θ r直接產生的伺服延遲因素之速度指 令處理速度迴路的緣故，因此比只有使用回饋控制的情形 更能夠消除伺服延遲現象。 此外，前饋控制器7係輸入自前饋控制器6所輸出之 第1前饋補償量並予以微分後，藉由第2個前饋增益 K f f 2將該微分値放大K f f 2倍後的數値當作第2前 饋補償量輸出。 此一第2個前饋增益補償量係被加算到自速度控制器 2所輸出的數値後，將該被加算的數値當作扭力指令T r 輸入至扭力放大器3。 藉此，扭力放大3，可以依據不包含伺服延遲因素的 扭力指令T r驅動馬達4。 經濟部智慧財產局員工消費合作社印製 如上所述，在第3 2圖的定位伺服控制器，可以藉由 執行的速度前饋控制和扭力前饋控制補償利用回饋控制所 發生的伺服延遲。 第3 3圖係簡化第3 2圖的定位伺服控制器的各方塊 的控制方塊圖。如第3 3圖所示，此一定位伺服控制器的 控制性能係取決於前饋增益K f f 1、K i f 2的數値。 因此，在第3 2圖的定位伺服控制器，將前饋增益 K f ί 1、K i f 2設定成最佳的數値，並且令伺服延遲 在盡量小的狀態下控制馬達4。 本紙張尺度適用中國國家標準（CNS ) A4規格（210X297公釐） 502141 A7 B7 五、發明説明（5) 此外，令前饋增益K f f 1 = 1的話，此一定位伺服 控制器的控制方塊圖形成如第3 4圖所示。 (請先閲讀背面之注意事項再填寫本頁) 另外，令前饋增益K f f 2 = J的話，從位置指令 Θ r到位置響應0的轉移函數G的數値爲1，最理想的狀 態是使位置指令0 r和位置響應0之間無延遲，且定位伺 服控制器的伺服延遲成爲0。 但是，實際上，由於大部份的場合都無法掌握當作控 制對象的馬達4的慣量J等的物理量，因此很難將前饋增 益Kf ί 1、Kf f 2的數値設定成最佳化。 在這種情況下，當決定馬達4的位置時，會發生超越 量或低越量等的現象。例如：K f f 2 = J的話，雖然定 位伺服控制器的伺服延遲爲0，但是當無法預知J的數値 的情況下，由於無法將前饋增益K f f 2的數値設定成J 的數値，因此發生超越量或低越量的響應。 第3 5圖係顯示前饋增益K f f 2的數値未被設定成 最佳化的情況下的定位伺服控制器位置響應0的微分之速 度響應d0/dt的變動狀態。 經濟部智慧財產局8工消費合作#吖袈 此外，在第35圖中，令Kf f 2 = 0 · 5 = J/ 2 〇 接者’弟3 5圖之（b)係第3 5圖之（a )的Α部 放大圖。 如第3 5圖之（b)所示，在速度響應d0/d t部 分，發生了超越量。 爲了不使超越量發生，雖然採取降低前饋增益 本紙張尺度適用中國國赛標準（CNS ) A4規格（210X ：W公釐） 8- 502141 A7 B7 五、發明説明（6) (請先閱讀背面之注意事項再填寫本頁) K f f 1的數値、或在前饋控制器7的輸出處裝設過濾器 等的手段予以對策，但是對傳統的定位伺服控制器而言， 會因爲該對策導致再度發生伺服延遲的問題。 同時，第3 0圖之傳統的定位伺服控制器係由位置控 制器1、速度控制器2、扭力放大器3、馬達4、微分器 5所構成。此一傳統的定位伺服控制器係用來控制慣量爲 J 〔Ν·πι· s2〕的馬達4的位置0〔rad〕。 爲簡化說明，在此，可以令控制對象爲剛體且將控制 對項與馬達4加起來的慣量當作J ，並且，假設扭力放大 器3的響應速度非常的快以至於達到可以忽略的情形。 經濟部智慧財產局員工消費合作社印製 如上所述，在定位伺服控制器裡，通常在其位置迴路 處理中裝設擁有速度迴路增益K v之速度迴路作爲次迴路 。接著，在速度迴路中設置產生扭力之扭力放大器3。藉 此產生的扭力T I·旋轉慣量J的馬達。又藉著編碼器將該 位置讀入到控制器予以進行控制。在這種傳統的定位伺服 控制器裡，將機器連接到馬達的前端，並因應該機器的特 性與動作要求，確實地調整其K p、K v的値以達到平衡 點係屬非常重要。 輸入步階指令至第3 0圖的控制系統情形下之響應特 性係藉由K p與K v的數値的組合顯示於如第3 6圖示之 各種特性。 於第3 6圖，描述（a )至（c )的3種特性曲線圖 。並顯示 (1) (a)係表示 Κν = 50、Κρ=10 情形 本紙張尺度適用中i國家標準（CNS ) Α4規格（210Χ297公釐) 一 " -9- 502141 A7 B7 五、發明説明（7) (2) (b)係表示Κν=1〇〇、Κρ=25情形 (c)係表示Κν = 50、Κρ = 50情形 {請先閲讀背面之注意事項再填寫本頁} 的各種響應特性。但是，在上述所有情況下設定J = 1 〇 例如：考慮所要求的規格爲：如第3 6圖之（b )特 性圖所示不僅不要發生超越量而且又要有快速的響應，且 最初爲第3 6圖之（a )特性圖的狀態的情形。若要依要 求內容的調整的話，首先，邊確認監視位置回饋的波形， 邊慢慢地調大K p的數値，當其與3 6圖之（c )特性圖 的狀態一樣後，接下來調大K v的數値。如此，可以穫得 如3 6圖之（b )特性圖的狀態。 但是，一般而言，假如由於被忽略的機械系統、及裝 設在速度迴路中的扭力放大器3的延遲，導致Kv過大的 話會使伺服系統發出振動。 因此，當在Κ ν增大的途中發出振動的情形發生時， 必須再次減小Κ ρ的數値以尋求最適當的Κ ν的數値。 經濟部智慧財產局員工消費合作社印製 如此，傳統定位伺服控制器必須邊交替的改變Κ ν、 Κ ρ的數値邊調整最佳的增益。然而，若不充分了解Κ ν 、Κ ρ的關係的話，很難予以調整使其達到平衡。 換言之，如果爲第6圖所示的構造而且控制對象爲剛 體，同時馬達和機械加起來的負載慣量爲J的情況下，對 一個熟練的人而言，知道藉由令Κν=4·Κρ· J便可 以得到如3 6圖之（b )特性圖的狀態，但是對一個缺乏 經驗與知識的人來說，很難使其取得平衡。 本紙張尺度適用中國國家標準（CNS ) A4規格（210X 297公釐） -10- 502141 A7 B7 五、發明説明（8) (請先閲讀背面之注意事項再填寫本頁) 接著，第3 7圖係顯示構造上與第3 0圖之傳統的定 位伺服控制器稍微不相同的另一種傳統的定位伺服控制方 塊圖。如第3 7圖所示，此一傳統的定位伺服控制器係由 位置控制器1、及速度控制器2、及扭力放大器3、及馬 達4、及微分器5所構成。 此一傳統的定位伺服控制器係用來控制慣量爲J 〔 N •111.82〕的馬達4的位置0〔1*3〇1〕。 此外，雖然通常設置輸入被作成的扭力指令並產生扭 力進而形成可以驅動馬達4的扭力放大器，但是由於扭力 放大器的響應相當快以至於達到可以予以忽視的緣故，所 以將其自圖中省略。 同時，爲簡化說明，在此，可以令控制對象爲剛體且 將控制對項與馬達4加起來的慣量當作J。 馬達4系具備有編碼器（圖未表示），並且可以藉由 此編碼器檢測出馬達4的位置0。自上位裝置（圖未表示 )所發出的位置指令Θ r與馬達4的位置0的位置偏差係 被輸入至位置控制器1及微分器5。 經濟部智慧財產局員工消費合作社印製 位置控制器1係屬於一種利用比例增益K p〔 N · m • s 2〕，並藉此輸出其放大K p倍後之偏差的比例控制器 〇 微分器5係用來輸出將位置指令0 r與馬達4的位置 Θ的位置偏差微分過的數値。 速度控制器2係屬於一種利用微分增益K d〔 1 / s 〕，並藉此將藉由微分器5所求出之數値放大K d倍的數 本紙張尺度適用中國國家榡隼（CNS ) A4規格（210X 297公釐） -11 - 502141 A7 B7 五、發明説明（9) (請先閲讀背面之注意事項再填寫本頁) 値輸出之比例控制器。此一傳統的定位伺服控制器係用來 令馬達4的位置0追隨移動至位置指令（9 r的一種定位伺 服控制器，而此一馬達4的位置Θ係位置指令（9 r位置響 應。 接著，在此一傳統的定位伺服控制器裡用來控制馬達 4的扭力，係將分別來自位置控制器1與速度控制器2所 輸出的數値加起來的數値作爲扭力指令，且利用圖未表示 之扭力放大器予以產生。 同時，與之第3 7圖所示之傳統的定位伺服控制器比 較，第3 8圖係作成再加上具備有：積分器6、積分控制 器3之傳統的另一種定位伺服控制器。 積分器6係將位置指令0 r與馬達4的位置0的位置 偏差積分後將該數値輸出。積分控制器3係利用積分增益 K i將藉由積分器6求出的數値放大後予以輸出。 經濟部智慧財產局員工消費合作社印製 接著，在此一傳統的定位伺服控制器裡用來控制馬達 4的扭力，係將分別來自位置控制器1、速度控制器2、 積分控制器3所輸出的數値加起來的數値作爲扭力指令， 且利用圖未表不之扭力放大器予以產生。 在第3 7圖及第3 8圖所示之傳統的定位伺服控制器 中，爲了發揮使0的響應能夠追隨移動到位置指令0 r、 Θ的響應能夠追隨移動到外來干擾之預期的功能，必須調 整增益K p、K d、K i的數値方能得到最佳的數値。 針對此一調整而言，若該控制對象（執行機制與連接 到執行機制的機器的合計）是屬於理想的剛體的話，就可 本紙張尺度適用中國國家標準（CNS ) A4規格(210X29?公釐) — -12- 502141 A7 B7 五、發明説明（1〇 (請先閲讀背面之注意事項再填寫本頁) 以簡單地自控制理論求出來，但是因爲現實的控制對象係 存在著摩擦特性或彈簧元件的緣故，所以一般而言其必須 經過練習與錯誤的累積才能調整出較佳的增益。 此一緣故，調整參數變成非常費時的工作。 第3 9圖與第4 0圖係爲了解決此一問題而被硏究出 之傳統的定位伺服控制器。 第3 9圖係在第3 7圖之傳統的定位伺服控制器內追 加放大器2 7、2 8之傳統的定位伺服控制器，第4 0圖 係在第3 8圖之傳統的定位伺服控制器內追加放大器2 7 、2 8、2 9之傳統的定位伺服控制器。 放大器2 7係藉著調整增益Kg的2次冪的數値Kg2 將自位置控制器1所輸出的數値予以放大輸出。 放大器2 8係藉著調整增益K g將自速度控制器8所 輸出的數値予以放大輸出。 放大器2 9係藉著調整增益K g的3次冪的數値K g 3 將自積分控制器3所輸出的數値予以放大輸出。 經濟部智慧財產局員工消費合作社印製 在這種傳統的定位伺服控制器係導入同時令比例要素 、微分要素、積分要素變化的參數後，一旦比例增益K p 、微分增益K d、積分增益K i決定後，只要變更一個調 整增益的參數K g就可以保持調整增益的平衡度的緣故， 所要求的響應特性可以容易地被實現。 但是，針對此一第3 9圖與第4 0圖所示的傳統的定 位伺服控制器，若考慮其外來干擾時便會面臨問題。 例如：如第4 0圖所示之傳統的定位伺服控制器，若 ^紙張尺度適用中國國家標準（ CNS ) A4規格（210X297公餐1 一 -13- 502141 A7 B7 五、發明説明（1今 (請先閲讀背面之注意事項再填寫本頁) 計算對應位置指令Θ r之位置偏差θ 1的響應之指令響應 :與對應外來干擾T r之位置偏差0 2的響應之外來干擾 響應時會形成如第4 1圖所示之方塊圖。 在這種控制系統中，即使想辦法調整K p、K d、 K i 、K g去減小藉由外來干擾T r的影響所形成的位置 偏差0 2，由於從位置指令0 r到位置偏差0 1的轉移函 數也同樣的只有靠參數來調整，因此對應指令響應的位置 偏差0 1與對應外來干擾的位置偏差0 2都需要同時變化 〇 換言之，由於這種構成係屬於一個自由度的控制系統 的緣故，只有調整回饋側的調整增益K g將礙難獲得好結 果。 同時，如後述之第1圖所示之定位伺服控制器，其具 有可以追加速度前饋控制器6與加速度前饋控制器7、及 依據馬達4的加速度和加速度指令的偏差執行加速度回饋 控制後將扭力指令輸出至扭力放大器3之加速度控制器8 的方法用來作爲消除伺服延遲的方法。 經濟部智慧財產局員工消費合作社印製 此外，如後述之第5圖所示之定位伺服控制器，亦可 以在位置控制器1及速度控制器2的後部具備藉由調整增 益K g將入力增加到K g倍之放大器1 0，用來作爲調整 位置迴路增益K p、速度迴路增益K v等各種控制系統的 參數後予以簡單地調整位置響應0的定位於最佳狀態。 但是，這種定位伺服控制器，由於必須經過練習與錯 誤的累積才能將調整增益與前饋增益調整至最佳的定位狀 本紙張尺度適用中國國家標準（CNS ) A4規格（210X29?公釐） -14- 502141 A7 B7 五、發明説明（1会 態的緣故，在調整上會面臨需要較長時間的問題。 (請先閲讀背面之注意事項再填寫本頁) 如上所述，在於第3 0圖中之傳統的定位伺服控制器 ，在於無法預知影響控制方面的馬達的物理量的情況下， 因爲無法將前饋增益等的控制參數設定在最佳的狀態的緣 故，會使控制響應發生超越量或低越量，以致於產生無法 得到較佳的控制響應的問題。 本發明之第1個目的，係提供一種即使無法預知馬達 的物理量，也可以獲得良好的控制響應之定位伺服控制器 〇 此外，在上述傳統的定位伺服控制器中，有2種非調 整不可的參數的緣故，面臨很難實現所要求的響應特性的 問題。 本發明之第2個目的，係提供一種可以簡單地實現所 要求的響應特性之定位伺服控制器。 經濟部智慧財產局員工消費合作社印製 其次，在上述第3 7圖之傳統的定位伺服控制器中， 由於只有利用一個參數調整回饋控制系統的緣故，因此即 使使用調整增益調整外來干擾響應的情況時也形成面臨很 難實現所要求的響應特性的問題。 本發明之第3個目的，係提供一種即使在調整外來干 擾響應的情形下也可以簡單地實現所要求的響應特性之定 位伺服控制器。 進一步，本發明之第4個目的，係提供一種可以簡單 地將定位調整到最佳狀態之定位伺服控制器。 本紙張尺度適用中國國家標準（CNS ) A4規格（210X297公釐） -15- 502141 A7 B7 五、發明説明（1$ 〔發明的開示〕 爲了達成上述第1個目的，本第1發明的實施形態的 定位伺服控制器，系具備有：藉著位置迴路增益將自上位 裝置所發出的位置指令與控制對象的位置的位置偏差放大 並予以輸出之位置控制裝置；及利用第1前饋增益將前述 位置指令微分過的數値放大所獲得的第1前饋補償量加到 由前述位置控制裝置輸出的數値之數値當作速度指令之速 度前饋控制裝置；及利用速度迴路增益將前述速度指令與 前述控制對象的速度之速度偏差放大輸出之速度控制裝置 :及利用第2前饋增益將前述第1前饋補償量微分過的數 値放大所獲得的第2前饋補償量加到由前述速度控制裝置 輸出的數値之數値當作加速度指令之加速度前饋控制裝置 ;及利用加速度迴路增益將前述加速度指令與前述控制對 象的加速度之加速度偏差放大後的數値當作扭力指令予以 輸出的加速度控制裝置；及依據前述扭力指令驅動前述控 制對象的扭力放大器。 如上所述，上述實施形態的定位伺服控制器，系藉著 具備有利用加速度增益將加速度指令與控制對象的加速度 之加速度偏差放大後的數値當作扭力指令予以輸出的加速 度控制裝置，因此即使不知道包含在以位置指令當作輸入 並且以位置響應當作輸出之轉移函數中之控制對象的物理 量，在該係數中，加速度迴路增益的數値爲控制對象的物 理量的分母，形成可以藉著將加速度迴路增益的數値設定 爲某一適當的數値用以忽略控制對象的物理量的數値對位 本紙張尺度適用中國國家標準（CNS ) A4規格（210X297公釐） -------- (請先閱讀背面之注意事項再填寫本頁) 經濟部智慧財產局員工消費合作社印製
-16- 502141 A7 B7 五、發明説明（Μ) 置響應的影響的緣故，因此可以藉著將加速度迴路增益的 數値設定爲某一適當的數値用以獲得較佳的控制響應。 (請先閲讀背面之注意事項再填寫本頁) 爲了達成上述第2個目的，第2發明的實施形態的定 位伺服控制器，系具備有：藉著位置迴路增益將自上位裝 置所發出的位置指令與控制對象的位置的位置偏差放大並 予以輸出之位置控制裝置；及利用調整增益將自該位置控 制裝置輸出之數値予以放大後當作速度指令輸出之第1放 大裝置；及藉著將前述控制對象之位置微分用以求出前述 控制對象之速度之微分裝置；及藉著速度迴路增益將前述 速度指令與利用微分裝置求出的控制對象的速度之速度偏 差放大後輸出的速度控制裝置；及利用前述調整增益將自 該速度控制裝置輸出的數値放大後作成扭力指令予以輸出 之第2放大裝置；及依據前述扭力指令驅動前述控制對象 之扭力放大器。 如上所述，依據上述實施形態的定位伺服控制器的話 ，一旦設定了速度迴路增益、位置迴路增益進而決定超越 量的量時，由於受調整增益的影響以致於只有時間的方向 經濟部智慧財產局員工消費合作社印製 產生變化的緣故，因此可以很容易實現所要求的響應特性 0 此外，另一實施形態中的另一定位伺服控制器，係具 備有··藉著位置迴路增益將自上位裝置所發出的位置指令 與控制對象的位置的位置偏差放大並予以輸出之位置控制 裝置；及及利用調整增益將自該位置控制裝置輸出之數値 予以放大後當作速度指令輸出之第1放大裝置；及藉著將 ^紙張尺度適用中國國家標準（CNS ) Α4規格{ 21〇><297公釐) -17- 502141 A7 B7 五、發明説明（ (請先閱讀背面之注意事項再填寫本頁) 前述控制對象之位置微分用以求出前述控制對象之速度之 微分裝置；及將前述速度指令與藉著前述微分裝置求出之 控制對象的速度的速度偏差積分後，並將其乘上速度迴路 積分增益的數値予以輸出之積分裝置；及利用前述調整增 益將自前述積分裝置輸出的數値放大後輸出之第2放大裝 置；及利用速度迴路增益將來自前述第2放大裝置輸出的 數値加到前述速度指令與藉著前述微分裝置所求出之控制 對象的速度的速度偏差的數値放大後輸出之速度控制裝置 ;及利用前述調整增益將自該速度控制裝置輸出的數値放 大後當作扭力指令輸出之第3放大裝置；及依據前述扭力 指令驅動前述控制對象之扭力放大器。 此一定位伺服控制器係適用在本發明之藉由位置爲P (比例）控制、速度爲P - I (比例一積分）控制所控制 之定位伺服控制器。 經濟部智慧財產局員工消費合作社印製 進一步，另一實施形態中的的定位伺服控制器，系具 備有：藉著位置迴路增益將自上位裝置所發出的位置指令 與控制對象的位置的位置偏差放大並予以輸出之位置控制 裝置；及及利用調整增益將自該位置控制裝置輸出之數値 予以放大後當作速度指令輸出之第1放大裝置；及藉著將 前述控制對象之位置微分用以求出前述控制對象之速度之 微分裝置；及將前述速度指令與藉著前述微分裝置求出之 控制對象的速度的速度偏差積分後，並將其乘上速度迴路 積分增益的數値予以輸出之積分裝置；及利用前述調整增 益將自前述積分裝置輸出的數値放大後輸出之第2放大裝 本紙張尺度適用中國國家標準（CNS ) A4規格（210X297公釐） -18- 502141 A7 B7 五、發明説明（16) (請先閲讀背面之注意事項再填寫本頁) 置；及利用速度迴路增益將自第2放大裝置輸出的數値與 前述控制對象的速度的偏差放大後輸出之速度控制裝置； 及利用前述調整增益將自該速度控制裝置輸出的數値放大 並且當作扭力指令輸出之第3放大裝置；及依據前述扭力 指令驅動前述控制對象之扭力放大器。 此一定位伺服控制器係適用在本發明之藉由位置爲P (比例）控制、速度爲I 一 P (積分一比例）控制所控制 之定位伺服控制器。 經濟部智慧財產局員工消費合作社印製 爲了達成上述第3個目的，本第3發明的實施形態的 定位伺服控制器，系具備有：藉著比例增益將自上位裝置 所發出的位置指令與控制對象的位置的位置偏差放大並予 以輸出之位置控制裝置；及藉著調整增益的2次冪的數値 將自前述位置控制裝置所輸出的數値放大予以輸出的之第 1放大裝置；及將前述位置指令與控制對象之位置偏差微 分的微分裝置；及藉著微分增益將利用前述微分裝置所求 出的數値放大後予以輸出之速度控制裝置；及藉著前述調 整增益將自該速度控制裝置輸出的數値放大輸出之第2放 大裝置；及藉著把利用第1前饋增益將前述位置指令2次 微分過的數値放大的數値、與利用第2前饋增益及前述調 整增益將前述位置指令微過分的數値放大的數値加起來後 所獲得的數値輸出之前饋控制裝置；及分別將前述第1及 第2放大裝置、與前述前饋控制裝置所輸出之數値加起來 的數値當作扭力指令後，並依據該扭力指令驅動前述控制 對象之ίΐ力放大器。 本紙張尺度適用中國國家標準（CNS ) Α4規格（210 X 297公釐） -19- 502141 A7 B7_ __ 五、發明説明（17) (請先閲讀背面之注意事項再填寫本頁) 如上所述，依據上述第3發明，如果具備前饋控制裝 置的話，由於作成將控制系統設定成2自由度’並且可以 使用一個參數作爲調整增益用來調整前饋控制裝置的增益 與回饋系統的增益的緣故，因此可以將決定被要求的響應 特性的增益調整予以簡單化。 同時，另一實施形態，係除了上述的構造外，亦可以 作成具備有：將位置指令與控制對象的位置偏差積分之積 分裝置；及藉著積分增益將自積分裝置所求得的數値放大 後輸出之積分控制裝置；及藉著前述調整增益的3次冪的 數値將自積分控制裝置所輸出的數値放大後輸出之第3 .放 大裝置。 此外，另一實施形態，係除了上述的構造外，亦可以 作成具備有：將位置指令與控制對象的位置偏差2次微分 之2次微分裝置；及藉著加速度增益將自2次微分裝置所 求得的數値放大後輸出之加速度控制裝置。 經濟部智慧財產局員工消費合作社印製 爲了達成上述第4個目的，本第4發明的實施形態的 定位伺服控制器，系具備有：藉著位置迴路增益將自上位 裝置所發出的位置指令與控制對象的位置的位置偏差放大 並予以輸出之位置控制裝置；及利用調整增益將自該位置 控制裝置輸出之數値予以放大後輸出之第1放大裝置；及 把利用第1前饋增益將前述位置指令微分過的數値放大所 獲得的第1前饋補償量加到由前述第一放大裝置輸出的數 値之數値當作速度指令之速度前饋控制裝置；及利用速度 迴路增益將前述速度指令與前述控制對象的速度之速度偏 本紙張尺度適用中國國家標準（CNS ) A4規格（210Χ297公釐） -20· 502141 A7 B7 五、發明説明（18) (請先閲讀背面之注意事項再填寫本頁) 差放大輸出之速度控制裝置；及利用前述調整增益將自該 速度控制裝置輸出的數値放大後予以輸出之第2放大裝置 :及把利用第2前饋增益將前述第1前饋補償量微分過的 數値放大所獲得的第2前饋補償量加到由前述第2放大裝 置輸出的數値之數値當作加速度指令之加速度前饋控制裝 置；及利用加速度迴路增益將前述加速度指令與前述控制 對象的加速度之加速度偏差放大後當作扭力指令予以輸出 的加速度控制裝置；及依據前述扭力指令驅動前述控制對 象之扭力放大器之一種定位伺服控制器，其特徵爲前述第 1前饋增益與前述第2前饋增益的數値係以調整增益的數 値爲因數的函數値。 如上所述，在上述第4發明之定位伺服控制器中，由 於藉著將第1前饋增益與第2前饋增益的數値爲以調整增 益的數値當作因數的函數値，進而只要調整調整增益便可 以獲得最佳化的定位狀態的緣故，形成可以簡單地調整定 位至最佳狀態。 經濟部智慧財產局員工消費合作社印製 〔圖面之簡單說明〕 第1圖係顯示第1個實施形態的定位伺服控制器的構 造之控制方塊圖。 第2圖係簡化第1圖的控制方塊圖之控制方塊圖。 第3圖係簡化第2圖的控制方塊圖之控制方塊圖。 第4圖係顯示本發明之一實施形態的定位伺服控制器 的動作之圖表。 本紙張尺度適用中國國家標準(CNS ) A4規格（210X297公釐1 -21麵 502141 A7 B7 五、發明説明（19) 第5圖係顯示第2個實施形態之第1定位伺服控制器 的構造之方塊圖。 (請先閲讀背面之注意事項再填寫本頁) 第6圖係說明第5圖之定位伺服控制器的動作用之極 座標圖。 第7圖係顯示改變調整增益K g的數値後響應特性變 化的圖表。 第8圖係顯示第2個實施形態之第2定位伺服控制器 的構造之方塊圖。 第9圖係顯示第3個實施形態之第3定位伺服控制器 的構造之方塊圖。 第1 0圖係顯示第3個實施形態之第1定位伺服控制 器的構造之方塊圖。 第1 1圖係說明第1 0圖之定位伺服控制器的響應用 之圖表。 第1 2圖係說明在第1 0圖之定位伺服控制器中外來 干擾響應的動作用之極座標圖。 經濟部智慧財產局員工消費合作社印製 第1 3圖係說明在第1 0圖之定位伺服控制器中指令 響應的動作用之極座標圖。 第1 4圖係顯示在第1 0圖之定位伺服控制器，當改 變調整增益K g的數値後響應波形變化的圖表。 第1 5圖係顯示令前饋增益K f f 1、K f f 2爲0 的情況下之響應波形變化的圖表。 第1 6圖係顯示令前饋控制器1 0中的調整增益Kg 爲0的情況下之響應波形變化的圖表。 本紙張尺度適用中國國家標準（CNS ) A4規格（210X297公釐） -22- 502141 A7 B7 五、發明説明（20) 第1 7圖係顯示第3個實施形態之第2定位伺服控制 器的構造之方塊圖。 (請先閲讀背面之注意事項再填寫本頁) 第1 8圖係說明第1 7圖之定位伺服控制器的響應用 的圖表。 第1 9圖係顯示第3實施形態之第3定位伺服控制器 的構造之方塊圖。 第2 0圖係說明第1 9圖之定位伺服控制器的響應用 之圖表。 第2 1圖係顯示使用傳統的調整增益後前饋控制方式 的定位伺服控制器的構造之控制方塊圖。 第2 2圖係第2 1圖之控制方塊圖的等價方塊圖。 第2 3圖係顯示包含控制對象爲機械系統之第2 1圖 的定位伺服控制器的構造之方塊圖。 第2 4圖係顯示當機械系統的剛性大的時候之位置指 令及位置響應的變動圖表。 第2 5圖係顯示當機械系統的剛性小的時候之位置指 令及位置響應的變動圖表。 經濟部智慧財產局員工消費合作社印製 第2 6圖係顯示當調整調整增益的數値時位置指令及 位置響應的變動圖表。 第2 7圖係顯示當調整前饋增益時位置指令及位置響 應的變動圖表。 第2 8圖係顯示調整定位至最佳狀態後之位置指令及 位置響.應的變動圖表。 第2 9圖係顯示第4實施形態之定位伺服控制器的構 本紙張尺度適用中國國家標準（CNS ) A4規格（210X297公釐） -23- 502141 A7 B7 五、發明説明（21) 造之控制方塊圖。 (請先閲讀背面之注意事項再填寫本頁) 第3 0圖係顯示傳統的定位伺服控制器的構造之控制 方塊圖。 第3 1圖係顯示傳統的定位伺服控制器的動作之圖表 〇 第3 2圖係顯示同時使用回饋控制方式與前饋控制方 式之定位伺服控制器的構造之控制方塊圖。 第3 3圖係屬於簡化第3 2圖之控制方塊圖之控制方 塊圖。 第3 4圖係屬於簡化第3 3圖之控制方塊圖之控制方 塊圖。 第3 5圖係顯示傳統的定位伺服控制器的動作之圖表 〇 第3 6圖係顯示傳統的定位伺服控制器的響應特性變 化之圖表。 第3 7圖係顯示傳統的定位伺服控制器的構造之方塊 圖。 經濟部智慧財產局員工消費合作社印製 第3 8圖係顯示傳統之其他的定位伺服控制器的構造 之方塊圖。 第3 9圖係針對第3 7圖之傳統的定位伺服控制器， 作成可以利用調整增益K g來調整增益之定位伺服控制器 的構造之方塊圖。 第.4 0圖係針對第3 8圖之傳統的定位伺服控制器， 作成可以利用調整增益K g來調整增益之定位伺服控制器 本紙張尺度適用中國國家標準（CNS ) A4規格（210X297公釐) -24 - 502141 A7 _B7 五、發明説明（22) 的構造之方塊圖。 第4 1圖係說明第4 0圖之定位伺服控制器的響應用 (請先閲讀背面之注意事項再填寫本頁) 之圖表。 〔圖號說明〕 此外，圖中的圖號說明如下： 1 :位置控制器 2 :速度控制器 3 :扭力放大器 4 :馬達 5、 9 :微分器 6、 7、10、11、22、23:前饋控制器 8 :加速度控制器 1 2 2 :次微分器 1 3 :加速度控制器 1 Θ :積分器 1 7 :微分器 經濟部智慧財產局員工消費合作社印製 27、28、29:放大器 3 0 :控制對象 〔發明之最佳實施形態〕 其次，佐以圖面說明各發明的實施形態。 在所有的圖面中，付予同一圖號的構成要素係皆表示 同一構成要素。 ΐ紙張尺度適用中國國家標準（CNS ) A4規格（21〇Χ297公釐) ~ ^ - -25- 502141 A7 B7 _ 五、發明説明（23) (實施形態1 ) (請先閲讀背面之注意事項再填寫本頁) 首先，佐以第1圖至第4圖詳細地說明達成第1個目 的之本發明的實施形態1的定位伺服控制器。 第1圖係顯示此一實施形態的定位伺服控制器的構造 之控制方塊圖。本實施形態的定位伺服控制器具備有：加 速度控制器8、及微分器9，係與第3 2個之傳統的定位 伺服控制器不同之處。 微分器9係將馬達4的位置響應0 2次微分後用以輸 出馬達4的加速度。加速度控制器8係輸入自速度控制器 2輸出的數値與自前饋控制器7輸出的數値加起後的數値 :和自微分器9輸出之馬達4的加速度的加速度偏差後， 利用加速度迴路增益K a用以將加速度偏差放大K a倍後 的的數値當作扭力指令T 1：輸出至扭力放大器3之比例控 制器。 第2圖係簡化第1圖的控制方塊圖之控制方塊圖。 經濟部智慧財產局員工消費合作社印製 爲了進一步地簡化第2圖的控制方塊圖，將前饋增益 作成K f f 1 = 1的話，第2圖的控制方塊圖可以被簡化 成如第3圖之控制方塊圖。 第3圖的控制方塊圖與第3 4的控制方塊圖比較時， 針對分母S2項的係數而言，在第3 4圖的控制方塊圖爲J ，而在第3圖的控制方塊圖則爲Ι + J/ Ka。 由於轉移函數G中加速度迴路增益K a的値爲馬達4 的慣量J的分母的緣故，因此加速度迴路增益K a的値愈 大J/Ka就愈接近〇。 本紙張尺度適用中周國家標準（CNS ) A4規格（210X297公釐) — -26- 502141 A7 B7______ 五、發明説明（24) (請先閲讀背面之注意事項再填寫本頁) 換言之，即使當慣量J的數値不是很明確的時候’只 要藉著適當地設定加速度迴路增益K a的値’也可以減少 慣量I對位置響應0的影響。 同時，在第3圖的控制方塊圖中若前饋增益K f f 2 =1的話，可以使位置指令0 r與位置響應0之間的轉移 函數G幾乎等於1 ，進而可以消除位置響應0對於位置指 令0r所發生的延遲。 第4圖係顯示當Kp = 25〔1/s〕、Kv = 200〔l/s〕、Ka = l〇、Kffl = l〔1/s 〕、K f f 2 = 1 〔 1 / S〕時之本實施形態的定位伺服 控制器的動作之圖表。 第4圖係顯示位置指令0 r與位置響應0的微分 d 0 r / d t、d 0 / d t變動的狀態。 第4圖中的d0 r/d t與第5圖中的d0 r/d t 係屬於同樣的波形。 經濟部智慧財產局員工消費合作社印製 此外，在第4圖，其加減速時間、等速度、規定的時 間、位置迴路增益Kp、速度迴路增益Kv、慣量J的數 値亦被設定成與第5圖中的數値相同，且設定加速度迴路 增益 Ka = 10 ;前饋增益 Ki f 1 = 1 、Kf f2 = l ο 將第4圖之（a )中的B部放大的第4圖之（b )與 第3 5圖之（b )比較之下，可得知速度響應d 0/d t 的超越量量有減少的趨勢。 如上所述，本實施形態的定位伺服控制器具備有利用 本紙張尺度適用中國國家標準（CNS ) A4規格( 210XΜ?公釐） -27- 502141 A7 B7 五、發明説明（25) (請先閲讀背面之注意事項再填寫本頁) 加速度迴路增益K a將加速度指令與馬達4的加速度之加 速度偏差放大後的數値當作扭力指令予以輸出的加速度控 制器8。 藉此，在本實施形態的定位伺服控制器，即使在於以 位置指令0 r當作輸入並且以位置響應0當作輸出的轉移 函數G的係數中所包含之馬達4的慣量J爲未知數，但是 由於在轉移函數G中由於加速度迴路增益K a爲該係數中 之馬達4的慣量J的分母的緣故，因此藉著將加速度迴路 增益K a的數値設定成適當的數値也可以忽略馬達4的慣 量J對位置響應0的影響。 此一緣故，在本實施形態的定位伺服控制器，可以獲 得良好的控制響應。 同時，在本實施形態的定位伺服控制器，即使改變馬 達4的慣量J的數値，但是藉著將加速度迴路增益K a的 數値設定成適當的數値也可以忽略馬達4的慣量J對位置 響應0的影響的緣故，因此可以獲得良好的控制響應。 經濟部智慧財產局員工消費合作社印製 此外，在本實施形態的定位伺服控制器，當慣量J的 數値很明確時，藉著 kff2 = l + J/ Ka 也可以使轉移函數形成G = 1。 因此，在本實施形態的定位伺服控制器，係無論慣量 J的數値明確與否，也可以決定馬達的最佳位置。 如上所述，本實施形態的定位伺服控制器係藉由具備 利用加速度迴路增益將加速度指令與馬達的時際的加速度 本纸張尺度適用中國國家襟準（CNS ) A4規格（210X29<7公釐） 麵28 - 502141 A7 B7__ 五、發明説明（26) (請先閲讀背面之注意事項再填寫本頁) 之加速度偏差放大後的數値當作扭力指令予以輸出的加速 度控制器，形成即使在於以位置指令當作輸入並且以位置 響應當作輸出的轉移函數的係數中所包含之馬達的慣量爲 未知數，但是也形成轉移函數中之加速度迴路增益的數値 爲馬達的慣量的分母。 . 因此，藉由將加速度迴路增益的數値設定成適當的數 値形成可以忽略馬達的慣量對位置響應的影響。 此一緣故，在本實施形態的定位伺服控制器，可以獲 得良好的控制響應。 (實施形態2 ) 接著，佐以第5圖至第9圖詳細地說明達成第2個目 的之本發明的實施形態2的定位伺服控制器。 (實施形態2 - 1 ) 第5圖係顯示實施形態之2 - 1的定位伺服控制器的 構造之方塊圖。 經濟部智慧財產局員工消費合作社印製 在第5圖中，與第6圖相同之構成要素係付予同一圖 號的的緣故，在此省略說明。 本實施形態的定位伺服控制器，與之第6圖所示之傳 統的定位伺服控制器相比較下，本實施形態係分別在位置 控制器1與速度控制器2之後追加放大器1 〇 1、1 〇 2 〇 放大器1 0 1係藉著調整增益K g將自位置控制器1 輸出之數値放大K g倍後當作速度指令ω r輸出。放大器 本紙張尺度適用中國國家標準(CNS ) A4規格（210X297公釐) -29 - 502141 A7 B7 五、發明説明（27) 1 0 2係藉著調整增益Kg將自速度控制器2輸出之數値 放大K g倍後當作扭力指令T r輸出。 (請先閲讀背面之注意事項再填寫本頁) 爲了簡化說明，本實施形態亦與傳統範例的情形一樣 ，可以將控制對象視爲剛體且把控制對象與馬達4的合計 慣量當作J ，而且，假設扭力放大器3的響應速度非常的 快以至於可以將其忽略不考慮。 當計算自第5圖之位置指令0 r至位置響應Θ的轉移 函數G ( S )時（通常，速度迴路增益Kv係與慣量J相 互連動變化的緣故，Kv〇=Kv/J)，形成 G ( S ) = G 1 / G 2........ ( 1 )
Gl=Kg2-Kv〇*Kp· · · · · (2) G2 = ( S 2 + K g * Κ ν 〇 · S + Κ g 2 * Κ ν 0 · Κ ρ ) · · · · ( 3 ) 在此，控制系統的安定性係取決於特性方程式G 2 = 0的根，即取決於控制系統的極P +、P -。 經濟部智慧財產局員工消費合作社印製 從方程式（3 ) p+ = ~Kg {Kv〇 — (Κν〇2 — Κν〇 · Κρ) 0.5}/2···(4) p- = -Kg {Κν〇 - (Κν〇2 + Κν〇 ·Κρ) 0 . 5 } / 2 · · · ( 5 ) 本紙張尺度適用中國國家襟準（CNS ) Α4規格（21 ΟΧ297公釐） -30- 502141 A 7 B7 五、發明説明（28) (請先閱讀背面之注意事項再填寫本頁) 在此，假如萬一決定了 Kv與Kp，變更Kg的話只 有極座標上的時間也隨之變化，超越量的量不會產生變化 。爲了以經常使用的方式說明此事，令 G2 = (S2+2r^S + a;2) · · · · · (6) 形成 ω = ΚΕ(Κν〇·Κρ)〇.5.....(7) Γ=(Κν〇/Κρ) 〇·5/2.....(8) 由此可知只有ω與K g有關。 此時的極座標係如第6圖所示，可以知道只要一旦決 定了 Kp、Kv〇，由於Kg的緣故，超越量量不會變化 的關係形成響應波形不會變化，而只有時間方向（即ω ) 在變化。 經濟部智慧財產局員工消費合作社印製 例如，第7圖係從K g = 〇 · 5到K g = 5變化的情 形，在無超越量的狀態下不會發生變化，形成只有速度響 應變快。但是，需將第3 6圖之（b )線圖的狀態作成 K g = 1。 如此，在本實施形態的定位伺服器控制器，一旦決定 了 Kv、Kp的數値且固定該數値時，只要藉著Kg的一 種參數便可以決定響應特性。 (實施形態2 — 2 ) 接著，說明實施形態2 - 2的定位伺服控制器。 本紙張尺度適用中國國家標準（CNS ) A4規格（210 X297公釐） -31 - 502141 A7 B7___ 五、發明説明（29) 第8圖係顯示第2實施形態之定位伺服控制器的構造 之方塊圖。 (請先閲讀背面之注意事項再填寫本頁) 本實施形態之定位伺服控制器係適用於本發明之藉由 位置爲P (比例）控制，速度爲P - I (比例一積分）控 制所控制的定位伺服控制器的情形。 與第5圖所示之第1實施形態定位伺服控制器比較， 在本實施形態之定位伺服控制器係新增設積分器1 6、放 大器1 0 3。 積分器1 6係將速度指令ω :r及馬達4的速度ω的速 度偏差積分，並且利用放大積分增益將其放大積分增益 K i倍之數値輸出。放大器1 〇 3係藉由調整增益Kg將 自積分器1 6所輸出的數値放大Kg倍後予以輸出至速度 控制器2。 經濟部智慧財產局員工消費合作社印製 接著，本實施形態之速度控制器2係將來自放大器 1 0 3所輸出的數値加到藉由放大器1 0 1所輸出之速度 指令與利用微分器5所求出的馬達4的速度ω的速度 偏差的數値輸出後，將該數値放大速度迴路增益之Κ ν倍 後的數値輸出到放大器1 0 2。 如此，計算從這個時候的位置指令0 r到位置響應0 的轉移函數G ( S )時，形成 G(S)=G1/G2···.....(9) G 1 = K g 2 · Κ ν 〇 · K D ( S + K g 2 · K i ) · · (10) G 2 = (S3 + Kg - Kv〇 · S+Kg2 (Kv〇 - Ki 本紙張尺度適用中國國家標準（CNS ) A4規格（210X297公釐) -32- 502141 A7 B7 五、發明説明（30) + Kv〇-Kp) S + Kg3-Kv〇-Kp-Ki) 在此，一旦Kv〇、Ki 、Kp決定了，特性方程式 G 2 = 0的根（極）並不會因該響應波形Κ §而有所改變 〇 例如，考慮G 2 = 0有3重根一 K g p的情形時’形 成 G 2 = ( S + K g p ) 3 =(S3+3KgpS2+3Kg2p2S + K g 3 p 3 ) · · (12) 比較方程式（1 1 )與方程式（1 2 )時，形成 K v 0 = 3 p 3ρ2 = Κν〇·Κί+Κν〇·Κρ ρ3 = Κν〇·Κρ·Κί.....(13) 因此，Ρ與Kg無關，只要一旦Κν〇、K i 、ΚΡ 決定的話即形成常數。 因此，自方程式（12)，當變更Kg時3重根一 K g p的K g時只有大小發生變化，並不會使3重根本質 產生變化。換言之，其響應特性不會發生變化。 本紙張尺度適用中.國國家標準（CNS ) A4規格（210X297公釐） (請先閲讀背面之注意事項再填寫本頁) _裝- 訂 經濟部智慧財產局員工消費合作社印製 -33- 502141 A7 B7 五、發明説明（31) (實施形態2 — 3 ) (請先閲讀背面之注意事項再填寫本頁) 接著，說明實施形態2 - 3的定位伺服控制器。 第9圖係顯示本發明之第3實施形態之定位伺服控制 器的構造之方塊圖。 本實施形態之定位伺服控制器係適用於本發明之藉由 位置爲P (比例）控制，速度爲P — I (比例一積分）控 制所控制的定位伺服控制器的情形。 與第8圖所示之第2實施形態之定位伺服控制器比較 ，在本實施形態之定位伺服控制器中新增設微分器1 7。 微分器1 7係將馬達4的位置0微分後輸出馬達4的速度 ω ° 接著，本實施形態之速度控制器2係將來自微分器1 7所輸出的速度ω的數値加到自放大器1 〇 3所輸出的數 値輸入，並將該數値放大速度迴路增益之Κ ν倍後輸出。 經濟部智慧財產局員工消費合作社印製 如此，從本實施形態之定位伺服控制器的位置指令0 r到位置響應β的轉移函數G ( S )的特性方程式，係形 成 G25= (S3 + Kg · Kv〇 · S2 + Kg2· Kv〇 ·
Ki - S+ Kg3-Kv〇-Kp-Ki) •••••(14) 比較方程式（1 2 )與方程式（1 4 )時，形成 本紙張尺度適用中國國家標準（CNS ) A4規格（210X297公釐） 一 _ 34 · 502141 A7 B7 五、發明説明（32)
K v 〇 = 3 P (請先閲讀背面之注意事項再填寫本頁) 3 p 2 = K v 〇 · K i ρ3 = Κν〇·Κρ·Κί·····(ΐ5) 因此，Ρ與Kg並無關，只要—旦κν〇、Ki 、 K p決定的話即形成常數。 此一緣故，依據本實施形態之定位伺服控制器，可以 得到和第2實施形態之定位伺服控制器相同效果。 在上述實施形態2 - 1至2 - 3中，說明過使用位置 迴路增益K p、與速度迴路增益κ v爲常數的情形，但是 本發明並不被限定在此種情形，利用位置偏差等的內部變 數或回饋速度將位置迴路增益Kp、與速度迴路增益Kv 作成可變也是有效，形成使參數很容易地調整。 換言之，在這種情形下，只要位置迴路增益Κ ρ、與 速度迴路增益Κ ν、速度迴路積分κ i維持固定的狀態下 ，改變K g即可。 經濟部智慧財產局員工消費合作社印製 如上所述，根據本發明，由於只要調整一個參數便可 以調整響應特性的緣故，因此可以很輕易地實現所要求的 響應特性。 (實施形態3 ) 接著’佐以第1 〇圖至第2 0圖詳細地說明達成前述 第3個目的之本發明的實施形態3的定位伺服控制器。 本紙張尺度適用中國國家標準（CNS ) A4規格（210X297公釐） -35- 502141 A7 B7 五、發明説明（33) 第1 0圖係顯示實施形態之3 - 1的定位伺服控制器 的構造之方塊圖。 (請先閲讀背面之注意事項再填寫本頁) 在第1 0圖中，與第3 9圖相同之構成要素係付予同 一圖號的的緣故，在此省略說明。 本實施形態的定位伺服控制器，與之第3 9圖所示之 傳統的定位伺服控制器相比較下，本實施形態係新追加前 饋控制器1 0，且將控制系統作成2個自由度系統，而且 將該增益與回饋系統之屬於共通參數的調整增益K g設計 成相關連。 前饋控制器1 0係藉著將利用前饋增益K f f 1放大 2次微分位置指令0 r的數値、及利用前饋增益κ f f 2 和調整增益K g放大1次微分位置指令0 r的數値加起來 所得的數値輸出。 接著，在本發明中，控制馬達4的扭力係分別將自放 大器2 7、2 8、及前饋器1 0所輸出的數値加起來的數 値當作扭力指令後，藉由未圖示之扭力放大器產生。 經濟部智慧財產局員工消費合作社印製 雖然第1 0圖所示的本實施形態的定位伺服控制器之 轉移函數係形成如第1 1所示，但是決定此時的外來干擾 的是只有從T d到Θ 2的轉移函數的分母。 將其以G d代表的話可以利用以下的方程式（1 6 ) 表不。但是，爲了簡單地說明令j = 1。
Gd = S2 + Kg-Kd-S + Kg2-Kp· · - (16) 本紙張尺度適用中國國家標準（CNS ) A4規格（210X297公釐） -36- 502141 A7 ____B7___ 五、發明説明（34) 在此，控制系統的安定性係由特性方程式的根G d = 〇，即控制系統的極p +、p -決定。 (請先閱讀背面之注意事項再填寫本頁) 從方程示（1 6 ) P + = - K g {Kd -（Kd2 - 4Κρ) 0·5}/2 •••(17) Ρ — = — Kg {Kd + (Kd2 - 4Κρ) 0 5}/2 •••(18) 在此，假如一旦決定了 Kd與Κρ，當變更Kg時只 有極座標上的時間隨之改變，超越量的量卻不會變化。爲 了以經常使用的方式說明此事，令
Gd — (S2+2C^S + 6i)2) · · · · · (19) 形成 ω = K g (Kg)0*5.....----(20) r = Kd/(2Kp0·5).......(21) 經濟部智慧財產局員工消費合作社印製 由此可知只有ω與K g有關。 此時的極座標係如第6圖所示，只要決定了 K p、 K d，由於K g的緣故，超越量量不會變化的關係形成響 應波形不會變化，而只有時間方向（即ω )在變化。 此外，指令響應係藉著自位置指令0 r到位置偏差 0 1的轉移函數決定。將此一情況下的轉移函數作爲G = 本紙張尺度適用中國國家標準（CNS ) A4規格（210X297公釐） 一 ~ - 502141 A7 B7 五、發明説明（35) (請先閲讀背面之注意事項再填寫本頁) G 1/G 2。由於控制器同時左右分母與分子的緣故，控 制系統的響應性係由特性方程式G 2 == 0的根，即控制系 統的極P +、P -；及特性方程式G 1 = 0的根，即控制 系統的零點所決定。 關於極函數，由於G2 = G d的緣故，因此，方程式 (1 6 )至（2 1 )係可以同樣地被適用，故在此僅針對 零點作說明。但是爲了能夠簡單說明令J = 1。假設， G 1 = K f f 1 · S 2 + K g ( Κ d + Κ f f 2 ) S + K g 2 · K p = 〇 .......(22) 藉由解開方程式（2 2 )，零點z +、z —也被決定 ο 自方程式（2 2 )可以獲得下列方程式（2 3 )、（ 2 4)。 經濟部智慧財產局員工消費合作社印製 Z + = - Kg { K d + K f f 2 } - [ ( K d + K f f 2 )2- 4Κίί1·Κρ〕0·5}/(2Κίί1) ••••(23) Z- = — Kg {Kd + Ki f2} +〔（Kd +
Kf f2)2— 4Kffl.Kp〕0.5}/( 2 K f f 1 ) --.-(24) 在此，即使假如一旦決定了決定極之Kd、Kp，也 土紙張尺度適用中國國家標準jcNS ) A4規格（210X297公釐） -38- 502141 A7 B7 五、發明説明（ 可以藉由K f f 1、K f f 2改變響應。 換言之，可以與外來干擾分開用以決定控制系統。 此外，一旦決定了 Kd、Kp、Ki f 1、Kf f 2 的話，變更K g時只有時間隨之改變，超越量的量不會_ 化。 爲了以經常使用的方式說明此事，令 Gl=Kf f 1 (S2+2ri^lS + ^l2) 形成 〇l=Kg (Kp/Kffl)0·5· · · · · (26) ri=(Kd + Kff2)/{2 (Kf f 1 ·Κρ) 0·5} .....(27) 由此可知只有6l)與K g有關。 此時的極座標係如第1 3圖所示，淸楚了解：只要、决 定了 Kd、Kp、Kf f 1、Kf f2，由於 Kg 的緣故 ，不會失去平衡，且只有時間方向（即ω)在變化。 本實施形態之響應波形係如第1 4圖所示。 雖然第14圖係顯示Kg = 〇 · 5至Kg = l · 5變 化的情況下的響應波形，但是整體的波形並未產生變化， 只有響應速度變快。 但是，Kd = 40、Kp = 800、Kf f 1 = 0、 K i f 2 = - 1 6、J = 1、位置指令0 r之最大速度= 本紙張尺度適用中國國家標準（CNS ) A4規格（210X297公釐） f請先閲讀背面之注意事項再填寫本頁} -訂‘ 經濟部智慧財產局員工消費合作社印製 -39- 502141 A7 ___B7__ 五、發明説明（37) 200 (rad/s)、加速度、或減速度=0·05 ( sec)、指令的釋放時間爲〇· 〇1 (sec)。 (請先閱讀背面之注意事項再填寫本頁) 如此，一旦決定了 K d、K p的數値之後，指令響應 則只要藉著K g的參數便可以決定響應特性。 爲了將本實施形態的定位伺服控制器所獲得效果與傳 統範例作比較的緣故，令本實施形態的前饋增益K f f 1 =Kf f 2 = 0、並且將Kg = 〇 · 5至1 · 5變化的情 況下的響應波形作成如第1 5圖所示。由於K f f 1 = K f f 2 = 0，形成第1 5圖所示的響應波形變成第1 9 圖之傳統的定位伺服控制器的響應波形。 未裝設前饋控制器1 0之傳統的定位伺服控制器的響 應波形之第1 5圖的響應波形與之第1 4圖所示之響應波 形相互比較後，可以得知傳統的定位伺服控制器所產生的 響應波形其超越量量較大。 在本實施形態的定位伺服控制器，藉著將前饋控制器 10的增益作成與回饋系統之屬於共同參數的調整增益 K g相關連，形成只要藉著調整增益K g的參數即便可以 經濟部智慧財產局員工消費合作社印製 調整其響應特性。 換言之，只有設置前饋控制器於傳統的定位伺服控制 器，而在該前饋控制器的增益內並不包含調整增益K g的 情形時，形成其響應特性的調整變得困難進而無法獲得本 實施形態的效果。 爲說明此一現象，將第10圖之前饋控制器1 0中的 K g設定爲1，且將K g = 0 · 5至1 · 5的情況下的響 本紙張尺度適用中國國家標準（CNS ) A4規格（210X297公釐) ~ -40- 502141 A7 B7 五、發明説明（38) 應波形顯示於第1 6圖。 (請先閲讀背面之注意事項再填寫本頁) 自第1 6圖可以知道，由於指令響應的波形係隨著調 整增益K g的變化而變大的緣故，所以在調整上困難。 本實施形態的定位伺服控制器係可以將前饋增益與回 饋控制系統獨立分開的設定爲K f f 1、K f f 2，此外 ，由於同時在回饋控制系統與前饋控制系統的位置項及速 度項（1次微分項）分別乘上Kg2及Kg的緣故，因此一 旦響應波形決定的話只要利用調整調整增益K g，形成只 要維持該響應波形的情形下便可以變更其動作時間。 換言之，本實施形態的定位伺服控制器，係作成具備 有前饋控制器1 0，且將控制系統作成2個自由度系統， 而且作成可以利用屬於一個參數的調整增益K g調整前饋 控制器1 0的增益與回饋系統的增益的緣故，所以可以將 決定被要求的響應特性的增益調整簡單化。 (實施形態3 - 2 ) 接著，說明實施形態3 — 2的定位伺服控制器。 經濟部智慧財產局員工消費合作社印製 第1 7圖係顯示本發明之第2實施形態之位伺服控制 器的構造之方塊圖，第1 8圖係說明第1 7圖之定位伺服 控制器的響應用之圖表。 本實施形態的定位伺服控制器，與之第4 0圖所示之 傳統的定位伺服控制器相比較下，本實施形態係新追加前 饋控制器1 1的一種定位伺服控制器。 前饋控制器1 1係藉著將利用前饋增益K f f 1放大 本紙張尺度適用中國國家標準（CNS ) A4規格（210X297公釐） -41 _ 502141 A7 B7 五、發明説明（39) (請先閲讀背面之注意事項再填寫本頁) 2次微分位置指令β r的數値、及利用前饋增益Ki f 2 和調整增益K g放大1次微分位置指令0 r的數値、及利 用前饋增益Kf f 3和將調整增益2次冪過的値Kg2放大 位置指令0 I*的數値加起來所得的數値輸出。 接著，在本實施形態中，控制馬達4的扭力係分別將 自放大器27、28、29、及前饋器1 1所輸出的數値 加起來的數値當作扭力指令後，藉由未圖示之扭力放大器 予以產生。 本實施形態的定位伺服控制器，係作成具備有前饋控 制器1 1 ，且將控制系統作成2個自由度系統，而且作成 可以利用屬於一個參數的調整增益K g調整前饋控制器 1 1的增益與回饋系統的增益的緣故，所以可以和上述第 1實施形態的定位伺服控制器一樣，可以將決定被要求的 響應特性的增益調整簡單化。 (實施形態3 - 3 ) 接著，說明實施形態3 - 3的定位伺服控制器。 經濟部智慧財產局員工消費合作社印製 第1 9圖係顯示本發明之第3實施形態之位伺服控制 器的構造之方塊圖，第2 0圖係說明第1 9圖之定位伺服 控制器的響應用之圖表。 本實施形態的定位伺服控制器，與之第1 7圖所示之 第3實施形態之定位伺服控制器相比較下，本實施形態係 新追加2次微分器1 2及加速度控制器1 3的一種定位伺 服控制器。 本紙張尺度適用中國國家標準（CNS ) A4規格（210X297公釐） •42- 502141 A7 __ B7 五、發明説明（40) (請先閲讀背面之注意事項再填寫本頁) 2次微分器1 2係用來2次微分位置指令0 r和控制 對象的位置偏差。加速度控制器1 3係利用加速度增益 K i將自2次微分器1 2所求得的數値放大後輸出。 接著，在本實施形態中，控制馬達4的扭力係分別將 自放大器27、28、29、及加速度控制器1 3、及前 饋器1 1所輸出的數値加起來的數値當作扭力指令後，藉 由未圖示之扭力放大器予以產生。 本實施形態的定位伺服控制器，係作成具備有前饋控 制器1 1 ，且將控制系統作成2個自由度系統，而且作成 可以利用屬於一個參數的調整增益K g調整前饋控制器 1 1的增益與回饋系統的增益的緣故，所以可以和上述第 1實施形態的定位伺服控制器一樣，可以將決定被要求的 響應特性的增益調整簡單化。 如以上所述，根據本發明，只要調整一個參數就可以 調整回饋控制系統與前饋控制系統雙方的增益進而調整響 應波形的緣故，因此即使在於調整外來干擾響應的情況下 也可以獲得可以容易地實現所要求之響應特性之效果。 經濟部智慧財產局員工消費合作社印製 (實施形態4 ) 其次，佐以第2 1圖至第2 9圖詳細地說明改善第1 個及第2個發明之第4個發明的實施形態。 如上所述，通常，定位伺服控制器係在位置迴路處理 中擁有速度迴路處理當作次迴路。在這種回饋控制方式的 定位伺服控制器中，位置迴路增益K p、與速度迴路增益 本紙張尺度適用中國國家標準( CNS ) A4規格（210X297公釐) ' 一 -43- 502141 A7 ______B7_ 五、發明説明（41) K v的數値係爲有限値之擁有其上限値。此一緣故，馬達 (請先閲讀背面之注意事項再填寫本頁) 4的位置響應0無法與位置指令0 r完全一致，發生所謂 的伺服延遲。 解決此種伺服延遲的方法有如上述第1圖所示之定位 伺服控制器，係屬於追加：速度前饋控制器6與加速度控 制器7 ;及依據馬達4的加速度與加速度指令的偏差執行 加速度回饋控制後將扭力指令輸出至扭力放大器3的加速 度控制器8的方法。 速度前饋控制器6係輸出利用屬於第1個前饋增益之 前饋增益K f f 1將微分過位置指令0 r的數値放大所得 的第1個前饋補償量。 第1個前饋補償量係被加在自位置控制器1輸出的數 値。 加速度控制器7係輸出利用屬於第2個前饋增益之前 il增益Kf f 2將微分過第1個前饋補償量的數値放大所 得的第2個前饋補償量。 第2個前饋補償量係被加在自速度控制器2輸出的數 經濟部智慧財產局員工消費合作社印製 値。 在第1圖的定位伺服控制器，即使當馬達4的慣量J 無法明確地知到的情況下只要設定適當的數値到加速度控 制器8的加速度迴路增益K a的數値時，可以除去慣量J 對此一定位伺服控制器的控制響應的影響，且令加速度前 饋增益K f f 2 = 1的話，將位置指令0 r當作輸入且位 置響應0當作輸出之轉移函數作成1時形成可以消除伺服 本紙張尺度適用中國國家標準（CNS ) A4規格（210Χ297公釐） -44- 502141 A7 ___ B7_ 五、發明説明（42) 延遲。 (請先閲讀背面之注意事項再填寫本頁) 此外’作爲調整位置迴路增益K p、與速度迴路增益 K v等各種的控制系統的參數用以作成簡單地調整位置響 應Θ的定位至最佳狀態的方法，係有如上述第5圖所示之 定位伺服控制器，其爲在位置控制器1及速度控制器2的 後面具備藉著調整增益K g將輸入放大κ g倍之放大器 1 0的方法。 此一定位伺服控制器，並非各別地調整位置迴路增益 Κ p、及速度迴路增益K v而是藉著只有調整調整增益 K g進而可以簡單地調整位置響應0的定位至最佳狀態。 第2 1圖係顯示使用上述2個方法的定位伺服控制器 的構造之方塊圖。_ 此一定位伺服控制器，係如前所述，除了可以消除伺 服延遲，且可以簡單地調整定位至最佳狀態。 同時，第2 1圖之定位伺服控制器的方塊圖係可以改 變成如第22圖之（a)、第22圖之（b)。此時，把 扭力放大器的增益當作1。 經濟部智慧財產局員工消費合作社印製 通常，在於上述定位伺服控制器的馬達4的軸端部連 接屬於該控制器之控制對象的機械系統。 一般而言，在於大幅提升調整增益K g等的回饋控制 系統的增益値的情形時，可以將該機械系統視爲固有振動 數爲高的剛體。 同時，在於無法大幅提升調整增益K g等的回饋控制 系統的增益値的情形時，可以將該機械系統視爲固有振動 本紙張尺度適用中國國家標準（CNS ) A4規格（210X29?公釐） -45- 502141 A7 __ B7_ 五、發明説明（43) 數爲低的剛體。 (請先閲讀背面之注意事項再填寫本頁) 在於可以將機械系統視爲固有振動數爲高的剛體的情 況下，可以設定各前饋增益Kf f 1、Kf f 2 = 1 ，且 可以將第2 2圖之（b )的方塊圖變更成如第2 2圖之（ c )的方塊圖。 同時，若加速度迴路增益K a的數値比慣量J的數値 大得非常多的話，由於可以視爲J/Ka的緣故J ，因此 可以將第2 2圖之（c )的方塊圖變更成如第2 2圖之（ d )的方塊圖。 第2 3圖之（a )係包含控制對象爲機械系統之定位 伺服控制器的方塊圖。在第2 3圖之（a )中，自機械系 統1 1至馬達4的反作用力視爲非常小以致於可以予以忽 略。 0 Μ爲馬達的位置，0 L爲連接到馬達4之機械系統 1 1的位置響應，ω爲機械系統1 1的共振頻率，I：爲機 械系統1 1的阻泥常數。 經濟部智慧財產局員工消費合作社印製 若機械系統1 1的慣量爲L J ，而彈簧常數爲Κ的話 ，形成 ω = ( K / J ) 0 . 5 若機械系統屬於振動系統的情形時，I：會比1小。 在此’若前饋增益Kf f l、Kf f2=l，且J/ K a視爲接近〇時，第2 3圖之（a )的方塊圖會非常接 本紙張尺度適用中國國家標準(CNS ) A4規格（210X297公釐） "" -46- 502141 Α7 Β7 五、發明説明（44) 近如第2 3圖之（b )所示的方塊圖。 (請先閲讀背面之注意事項再填寫本頁) 第2 4圖至弟2 8圖係顯不弟2 1圖之定位伺服控制 器的位置指令Θ r及位置響應Θ L的變動的狀態的圖表。 第2 4圖至第2 8圖，係將馬達4的加減速度的時間 爲0 · 0 3 〔秒〕之S字形的加減速度、馬達4的移動時 間爲0 · 06 〔秒〕、形成馬達4的旋轉角度3 〔 r a d 〕之位置指令0 r輸入到定位伺服控制器。 在第2 4圖至第2 8圖中，0秒起開始加速，到了 0 · 06秒時位置指令0 r爲3〔 r a d〕。將此一時刻 當作指令結束時刻。 此外，在第2 4圖至第2 8圖中，當位置指令0 Γ與 位置響應0 L的誤差在定位完成寬度範圍內時，將其視爲 位置響應0 L的定位完成，且將自指令結束時刻到定位完 成的時間當作爲安定時間。 將定位完成寬度當做土 0 · 5〔rad〕。 第2 4圖係機械系統1 1的剛性高的機械系統，顯示 ω=300、5 = 0 · 01時位置響應0L的變化狀況。 經濟部智慧財產局員工消費合作社印製 各控制參數被設定爲：Κρ = 20、Κν = 60、
Kg = 2、前饋增益 Kf f l=Kf f2 = l。 如第2 4圖所示，在指令結束時刻以後，位置響應 0 L的振動係形成在定位完成寬度以內，在指令結束時刻 時早已經完成位置響應0 L的定位。因此，此時此刻的安 定時間係爲0秒。 但是，當機械系統的剛性較低ω = 1 〇 0，且各控制 本紙張尺度適用中國國家標準（CNS ) Α4規格（210 X 297公釐） -47· 502141 A7 ___ B7 五、發明説明（45) 參數的數値與第2 4圖的條件一樣的情況下，對位置響應 Θ L會發生如第2 5圖所表示之振幅大的振動。 (請先閲讀背面之注意事項再填寫本頁) 通常，在這種情形下，爲了抑制振動現象，會將各控 制參數中之調整增益K g的數値往下調降。 第2 6圖係在於與第2 5圖一樣的低剛性的機械系統 1 1當中，顯示將第2 5圖中之各控制參數的數値中之調 整增益K g的數値從2調降到1的情況下之位置響應Θ L 的變化狀況的圖表。 但是，如第2 6圖所示，其位置響應0 L的振動仍然 不會收斂，即使指自令結束後經過0 · 1 4秒位置響應 0 L的定位不會完成。 因此，此次，降下前饋增益K f f 1、K f f 2的數 値。 第2 7圖係在於與第2 6圖一樣的低剛性的機械系統 1 1當中，顯示將第2 6圖中之各控制參數的數値中之前 饋增益K f f 1、K f f 2的數値從1調降到〇的情況下 之位置響應0 L的變化狀況的圖表。 經濟部智慧財產局員工消費合作社印製 如第27圖所示，當前饋增益Kf f l=Kf f 2 = 0時，其位置響應0 L的振動的振幅變小，振動會在定位 完成寬度以內收斂，且安定時間約爲〇 · 〇 1 2秒。 但是，當令前饋增益Kf f l=Kf f 2 = 0時，會 完全失去前饋控制的效果。 因此，需要重新經過反復地嚐試及錯誤用以調整前饋 增益K f ί 1、K f f 2、調整增益K g後，進行調整位 本紙張尺度適用中國國家標準（CNS ) A4規格(210X297公釐) " ~ ^ 麵48- 502141 A7 B7 五、發明説明（46) 置響應（9 L的定位至最佳狀態。 第28圖係顯示前饋增益Kf f l=Kf f 2 = (請先閱讀背面之注意事項再填寫本頁) 0 · 5、調整增益Kg = l · 5時之位置響應0L的變動 狀態的圖表。 此一情況下，位置響應0 L的振動的振幅比定位完成 寬度還要小，形成安定時間爲0。 如上所述，在於前述的定位伺服控制器，係邊調整調 整增益K g的數値、與速度前饋增益K f f 1的數値及加 速度前饋增益K f f 2的數値邊調整定位至最佳狀態。 然而，上述各控制參數的調整係需要經過反復地嚐試 及錯誤的緣故，會造成耗費很多的調整時間的問題。 如上所述，在上述定位伺服控制器，由於需經過反復 地嚐試及錯誤調整調整增益與前饋增益後調整定位至最佳 狀態的緣故，會造成耗費很多的調整時間的問題。 因此，本發明的目的係提供一種可以簡單地調整定位 至最佳狀態的定位伺服控制器。 經濟部智慧財產局員工消費合作社印製 爲了解決上述的課題，本發明提供一種具備有：藉著 位置迴路增益將自上位裝置所發出的位置指令與控制對象 的位置的位置偏差放大並予以輸出之位置控制裝置；及利 用調整增益將自該位置控制裝置輸出之數値予以放大輸出 之第1放大裝置；及把利用第1前饋增益將前述位置指令 微分過的數値放大所獲得的第1前饋補償量加到由前述第 1放大裝置輸出的數値之數値當作速度指令之速度前饋控 制裝置； 及利用速度迴路增益將前述速度指令與前述控 本紙張尺度適用中國國家標準（CNS ) A4規格< 210X297公釐） -49- 502141 A7 B7 五、發明説明（47) (請先閲讀背面之注意事項再填寫本頁) 制對象的速度之速度偏差放大輸出之速度控制裝置；及利 用前述調整增益將自該速度控制裝置輸出的數値放大輸出 之第2放大裝置；及把利用第2前饋增益將前述第1前饋 補償量微分過的數値放大所獲得的第2前饋補償量加到由 前述第2放大裝置輸出的數値之數値當作加速度指令之加 速度前饋控制裝置；及利用加速度迴路增益將前述加速度 指令與前述控制對象的加速度之加速度偏差放大後的數値 當作扭力指令予以輸出的加速度控制裝置；及依據前述扭 力指令驅動前述控制對象之扭力放大器之定位伺服控制器 ，其特徵爲前述第1前饋增益與前述第2前饋增益的數値 係令調整增益的數値當作因數的函數値。 如上述發明的定位伺服控制器，由於利用將第1前饋 增益與第2前饋增益的數値視爲以調整增益的數値當作因 數的函數値，形成只要調整調整增益便可以調整定位至最 佳狀態的緣故，因此形成可以簡單地調整定位至最佳狀態 〇 經濟部智慧財產局員工消費合作社印製 其次，佐以圖面說明本發明的實施形態之定位伺服控 制器。 第2 9圖係顯示本實施形態之定位伺服控制器的構造 之控制方塊圖。 本實施形態之定位伺服控制器與第2 1圖的定位伺服 控制器不同點係具備有：速度前饋控制器1 2、加速度控 制前饋控制器1 3用以取代速度前饋控制器6、加速度控 制前饋控制器7。 ^氏張尺度適用中國國家標準（€奶）八4規格（210'乂297公釐） — -50- 502141 A7 B7 五、發明説明（48) 雖然各個前饋控制器1 2、1 3係利用前饋增益 Kf f 1、Kf f 2處理前饋控制，該前饋增益Kf f 1 、K f f 2的數値係令顯示於方程式（2 8 ) 、（ 2 9 ) 之調整增益Kg當作因數的單純增加函數K1 (Kg)、 K 2 ( K g )的數値。 (Kg).....(28) (Kg).....(29) (請先閲讀背面之注意事項再填寫本頁) K f f 1 = K 1 K f f 2 = K 2 但是， ^ = \{Kg-Kgmri)l{KgrML- Kgmri){Kgmn <Kg< gmd〇〇) I 1 ( Kg > Kgrmx) } ^ = [{Kg-Kgmn)!{KgmdJ.- <Kg< ^max)l
一 i 1 ( Kg > ^max) J 在此，Kgmi n、Kgma x 係形成 Kgm.i n< Kgma x的所設定的數値，且Kgm i n係Kg中的最 小値。 經濟部智慧財產局員工消費合作社印製 在實施形態4之定位伺服控制器，即使機械系統的剛 性低，且在位置響應0 L發生如第2 5圖所示之振幅大的 振動，由於藉著變更調整增益K g的數値，也可以同時變 更前饋增益Kf f 1、Ki f 2的數値的緣故，因此只要 調整調整增益K g，便可以如第2 3圖所示一般簡單地調 整機械系統的定位狀態至最佳狀態。 本紙張尺度適用中國國家標準（CNS ) A4規格（210X297公釐） -51 - 502141 A7 ___B7 五、發明説明（49) (請先閲讀背面之注意事項再填寫本頁) 此外，在實施形態4之定位伺服控制器，雖然前饋增 益的函數K 1、K 2係被當作直線的單純增加函數，但是 本發明的範圍並不被限定於此，只要前饋增益的函數K 1 、K 2爲增加函數的話，亦可成爲曲線。 如上所述，在本發明之定位伺服控制器，由於利用前 饋增益的數値視爲以調整增益的數値當作因數的函數値， 形成進行調整位置響應的定位狀態時，不需要各別地調整 複數個控制參數的緣故，因此可以簡單地調整機械系統的 定位至最佳狀態。 〔產業上之利用領域〕 經濟部智慧財產局員工消費合作社印製 如上所述，第1發明之定位伺服控制器係藉著具備利 用加速度迴路增益將加速度指令與馬達實際的加速度之加 速度偏差放大後的數値當作扭力指令予以輸出的加速度控 制器，形成即使包含在位置指令爲輸入而位置響應爲輸出 的轉移函數的係數中之馬達的慣量爲未知數，在轉移函數 中加速度迴路增益的數値爲該馬達的慣量的分母。因此， 藉著適切地設定加速度迴路增益的數値形成可以忽略對馬 達的慣量對位置響應的影響。因爲此一緣故，在本發明之 定位伺服控制器，可以獲得良好的控制響應。 同時，根據第2發明，只要調整一個參數便可以調整 響應特性的緣故，因此即使在於調整外來干擾響應的情況 下也可以獲得可以容易地實現所要求的響應特性的效果。 此外，根據第3發明，只要調整一個參數就可以調整 ^紙張尺度適用中國國家標準（ CNS ) A4規格（210X297公釐) -52 - 502141 A7 ______B7 五、發明説明（50) 回饋控制系統與前饋控制系統雙方的增益進而調整響應波 形的緣故，因此即使在於調整外來干擾響應的情況下也可 以獲得可以容易地實現所要求之響應特性之效果。 接著，在第4發明的定位伺服控制器，由於利用前饋 增益的數値視爲以調整增益的數値當作因數的函數値，形 成進行調整位置響應的定位狀態時，不需要各別地調整複 數個控制參數的緣故，因此可以簡單地調整機械系統的定 位至最佳狀態。 (請先閱讀背面之注意事項再填寫本頁) 經濟‘部智慧財產局員工消費合作社印製 本紙張尺度適用中國國家標準（CNS ) A4規格（210X297公釐） -53-