【文章內(nèi)容簡(jiǎn)介】 同時(shí)要求系統(tǒng)阻尼大于 1， J值隨負(fù)載和位姿變化，應(yīng)選可能的最大慣量。 r?ImrrmIn KJRKJRKK??????? 4,2/2???tetIrmmIteImKkKKBJRKJRKKKKkKBR//)/(12/)]([11?????????? ?1/ KK? 機(jī)器人的位置控制 單關(guān)節(jié)位置控制器 控制參數(shù)確定與穩(wěn)態(tài)誤差 （ 2）穩(wěn)態(tài)誤差 根據(jù)控制理論，在控制系統(tǒng)框圖中，計(jì)算得到 E(s),即可得到系統(tǒng)的穩(wěn)態(tài)位置誤差、速度誤差和加速度誤差。 對(duì)于單位階越位移 C0，其穩(wěn)態(tài)誤差為 )(lim)(lim 0 ssEtee stss ??? ??ILgfmssp KKCCCRe ?? /)( ??? 機(jī)器人的位置控制 多關(guān)節(jié)位置控制器 1）為快速運(yùn)動(dòng)，一般應(yīng)采用多關(guān)節(jié)協(xié)調(diào)、同步運(yùn)動(dòng)。 2）這時(shí)各關(guān)節(jié)的位置和速度會(huì)互相作用，因此，必須進(jìn)行附加補(bǔ)償。 動(dòng)態(tài)拉格朗日公式 其他關(guān)節(jié)加速 自身加速 科式力 重力 且 D項(xiàng)皆與關(guān)節(jié)角有關(guān)。 ij kkjijkiaiijiji DqqDqJqDT ???? ???? ??616161?????? 機(jī)器人的位置控制 多關(guān)節(jié)位置控制器 1. 直流電動(dòng)機(jī)的速度與轉(zhuǎn)矩的關(guān)系 直流電動(dòng)機(jī)依據(jù)圖 同 ,有他激 、 并激 、 串激和復(fù)激電動(dòng)機(jī)等類型 。 在機(jī)器人中 ， 他激電動(dòng)機(jī)中 采用永久磁鐵的電機(jī) 用得較多 ， 所以本節(jié)只對(duì)這種電機(jī)進(jìn)行說明 。 現(xiàn)在我們根據(jù)電機(jī)學(xué)原理 ,當(dāng)設(shè)電動(dòng)機(jī)的速度為 ωm(rad／ s), 電動(dòng)機(jī)電樞的電壓 、 電流 、 電阻分別為 U(V)、 I(A)、 R(Ω), 電動(dòng)勢(shì)系數(shù)為 KE時(shí) , 它們之間滿足下列關(guān)系 : EKVIRU bm???? () 式中 ,Vb稱為電刷電壓降 , 通常為 2～ 3V, 多數(shù)情況下可以忽略不計(jì) 。但在外加電壓比較小的電動(dòng)機(jī)中 , 則必須予以考慮 。 另一方面 , 對(duì)于轉(zhuǎn)矩 Tm(Nm), 若設(shè)轉(zhuǎn)矩系數(shù)為 KT(Nm/A)時(shí) , 可求得轉(zhuǎn)矩為 Tm=KT(II0) 式中 ,I0為軸等零件上承受的摩擦轉(zhuǎn)矩的換算值 , 多數(shù)情況下可以忽略不計(jì) ,但是當(dāng)電動(dòng)機(jī)的輸出比較小時(shí) , 就不能忽略不計(jì) 。 于是 ,從上述兩式中消去電樞電流后 ,電動(dòng)機(jī)的速度與轉(zhuǎn)矩之間的關(guān)系可以用下式表示 : EbTKURIKKRU )()/( 0mm?????() () 由式 ()可以看出 , 電動(dòng)機(jī)的速度相對(duì)于轉(zhuǎn)矩成直線關(guān)系減小 , 其減小的比例顯然由電樞的電阻 、 電動(dòng)勢(shì)系數(shù)和轉(zhuǎn)矩系數(shù)決定 。 另外 , 在表 , 它們是一些具有代表性的產(chǎn)品 。 這里若以電動(dòng)機(jī) B為例 , 首先應(yīng)注意式 ()中的單位 , 再將額定值代入式 (), 于是可以確定 = + 3000+Ub Ub=(V) 此外 , 將額定值代入式 ()時(shí) , 即可求出軸上承受的摩擦轉(zhuǎn)矩的電流換算值 。 將這些值代入式 (), 即可求出這個(gè)電動(dòng)機(jī)的轉(zhuǎn)矩與速度的關(guān)系 , 其形式為 mm??? TU? () 因此 , 當(dāng)用這個(gè)電動(dòng)機(jī)驅(qū)動(dòng)機(jī)器人手臂 , 并且希望產(chǎn)生的轉(zhuǎn)矩為 m、 電動(dòng)機(jī)旋轉(zhuǎn)速度為 2200r/min時(shí) , 對(duì)這個(gè)電動(dòng)機(jī)應(yīng)該施加的電壓和電流 , 可以依據(jù)下列方法予以確定 : 首先 , 將轉(zhuǎn)矩和轉(zhuǎn)速代入式 (), 并且注意式中的單位 , 于是可以確定外加電壓為 )V( 0001 ??????? ?U電流可以根據(jù)式 ()計(jì)算得到 , 其值為 )A( ???I 一般來說 ,對(duì)于機(jī)器人 ,由于動(dòng)作和姿態(tài)的不同 , 對(duì)電動(dòng)機(jī)的速度和轉(zhuǎn)矩的要求也不同 ,因此 , 電動(dòng)機(jī)的外加電壓和電流也必須時(shí)刻作相應(yīng)的變化 。 另外 , 直流電動(dòng)機(jī)存在著電刷與整流子的維護(hù)以及防止火花的問題 。 為了能保持電動(dòng)機(jī)原來的控制特性 , 消除因電刷和整流子引發(fā)的問題 ,已經(jīng)開發(fā)出無刷直流電動(dòng)機(jī) ,并且正在進(jìn)入實(shí)用化階段 。 圖 直流電動(dòng)機(jī)速度與轉(zhuǎn)矩特性 2. 前面我們用式 ()給出了表 B的速度與轉(zhuǎn)矩的關(guān)系 。 圖 U時(shí) , 得到的直流電動(dòng)機(jī)速度與轉(zhuǎn)矩特性 。 在圖 , 速度和轉(zhuǎn)矩都用相對(duì)于額定值的百分率來表示 。 由這個(gè)圖可以明顯地看出 ,由于一方面要產(chǎn)生期望的轉(zhuǎn)矩 ,另一方面還要實(shí)現(xiàn)期望的速度 , 因此必須對(duì)端電壓進(jìn)行調(diào)整 。 圖 四象限短路器原理圖 。 在圖中的四個(gè)開關(guān)中 ,當(dāng) S1與 S4接通時(shí) ,P、 Q點(diǎn)的電位分別變成 US、 0, 因此端子上的電壓為 US。 當(dāng) S1與 S3處于接通狀態(tài)時(shí) , P、 Q點(diǎn)上的電位相同 , 端子上的電壓為 0。 同樣地 , 當(dāng)設(shè) S2處于接通狀態(tài)并接通 S3時(shí) ,則 P、 Q點(diǎn)的電位分別變成 0、 VS, 因此端子上的電壓為 VS。 S2和 S4接通時(shí) ,端子上的電壓為 0。 因此 ,當(dāng)按照?qǐng)D (b)中那樣實(shí)施對(duì)開關(guān)的接通與斷開時(shí) ,端子上的電壓將會(huì)變成如圖中表示的那樣 , 這是容易理解的 。 這里定義斜線位置上的兩個(gè)開關(guān)一同接通的時(shí)間 T1, 與周期 T的比為 流通率 d, 即 TTd 1?() 圖 ,S1和 S2決定端子上電壓的極性 , S3和 S4決定流通率 。 電動(dòng)機(jī)平均端子電壓的大小由下式?jīng)Q定 : U=dUS () 利用這個(gè)斷路器 , 可以使電源與電動(dòng)機(jī)上電流的流動(dòng)是雙向的 。 另外 , 作為一種電壓控制方法 , 可以先接通 S1和 S4, 隨后接通 S2和 S3, 根據(jù)適當(dāng)?shù)牧魍?, 重復(fù)地進(jìn)行上述接通操作 。 圖 四象限斷路器電路及其操作波形 1. 如果電動(dòng)機(jī)產(chǎn)生的轉(zhuǎn)矩 Tm大于負(fù)載的反作用轉(zhuǎn)矩 TL, 則會(huì)產(chǎn)生加速運(yùn)動(dòng) 。 反之 ,則會(huì)產(chǎn)生減速運(yùn)動(dòng) 。 如果兩者處于平衡狀態(tài) , 則系統(tǒng)會(huì)以一定速度進(jìn)行穩(wěn)定的工作 。 現(xiàn)在如果設(shè)換算到電動(dòng)機(jī)軸上的全部轉(zhuǎn)動(dòng)慣量為 J, 黏性摩擦系數(shù)為 D, 負(fù)載力矩為 TLm,則這個(gè)機(jī)械系統(tǒng)的運(yùn)動(dòng)方程式可以由下式給出 : mmmddLL TTDtJ ??? ??() 圖 減速器 多數(shù)驅(qū)動(dòng)系統(tǒng)都采用了如圖 。 若設(shè)圖中電動(dòng)機(jī)和負(fù)載的速度為 ωm和 ωL, 并且設(shè)減速器的效率為100%時(shí) , 則齒數(shù)比定義如下 : LLL TTaLM ???? ???mmm,1的齒數(shù)齒輪的齒數(shù)齒輪() 這時(shí) , 負(fù)載一側(cè)的運(yùn)動(dòng)方程式變成式 ()的形式 , 且可以寫成 LLLLL TaTDtJ ??? mdd ??() 從電動(dòng)機(jī)軸觀察到力矩為負(fù)載力矩的 1/a,而負(fù)載一側(cè)的機(jī)械常數(shù)則變?yōu)樵瓉淼?(1/a)2。 因此 ,這時(shí)電動(dòng)機(jī)的轉(zhuǎn)動(dòng)慣量和黏性摩擦系數(shù)應(yīng)分別進(jìn)行相加 , 并且必須對(duì)式 ()中的 J、 D進(jìn)行設(shè)置 。 此外 , 在實(shí)際計(jì)算中 , 多數(shù)情況下可以忽略黏性摩擦系數(shù) 。 2. 直流電動(dòng)機(jī)的啟動(dòng)和停止 圖 。 直流電動(dòng)機(jī)的電樞電流在加速過程中應(yīng)控制在一定的數(shù)值 Icon。 這時(shí) ,運(yùn)動(dòng)方程式可以根據(jù)式 ()和式 ()得到 , 并且可以表示成 LT TIIKtJ ??? )(dd0co nmm? () 將上式從時(shí)間 t1到時(shí)間 t2進(jìn)行積分 , 得到關(guān)系式 )()( 120co nT12 ttJ TIIK L ???????() 圖 電動(dòng)機(jī)的加減速 這里考慮從 0速度到額定速度 ωr的啟動(dòng)時(shí)間 TS,于是在式()中 , 當(dāng)設(shè) ω1=0時(shí) , 可以得到 LTrS TIIKJT???)( 0c o n? () 當(dāng)希望機(jī)器人進(jìn)行快速運(yùn)動(dòng)而選定電動(dòng)機(jī)時(shí) , 選擇轉(zhuǎn)動(dòng)慣量小且轉(zhuǎn)矩系數(shù)大的電動(dòng)機(jī)比較好 。 基于這種原因 , 機(jī)器人用的電動(dòng)機(jī)大都選用細(xì)長(zhǎng)型構(gòu)造 ,而且選用稀土類磁鐵 。 此外 , 在確定電動(dòng)機(jī)時(shí) , 應(yīng)該根據(jù)式 ()在大范圍內(nèi)設(shè)定加減速時(shí)的電流 , 其結(jié)果是增大了電力變換器的容量 。 1. 為了能對(duì)轉(zhuǎn)矩進(jìn)行控制 ,可在機(jī)械軸上安裝轉(zhuǎn)矩檢測(cè)器 , 以構(gòu)成一個(gè)反饋系統(tǒng) 。 但要得到性價(jià)比高 、 體積小 、 頻率特性好的轉(zhuǎn)矩檢測(cè)器則比較困難 。 另外 ,在直流他激電機(jī) 、 無刷電機(jī)和向量控制感應(yīng)電機(jī)中 , 轉(zhuǎn)矩和電流之間存在比例關(guān)系 。 為了得到期望的轉(zhuǎn)矩 , 需采用電流傳感器 。 霍爾元件的電流傳感器因其價(jià)格低 、 體積小 、 頻率特性好 , 所以這種電流傳感器在實(shí)踐中得到了廣泛應(yīng)用 。 圖 成原理圖 。 設(shè)用電動(dòng)機(jī)的轉(zhuǎn)矩系數(shù) Kr除轉(zhuǎn)矩指令 T*,得到的結(jié)果為電流指令 i*, 如果使實(shí)際的電動(dòng)機(jī)電流 i與 i*基本一致 , 那么電動(dòng)機(jī)就能夠產(chǎn)生與轉(zhuǎn)矩指令 T*相同的轉(zhuǎn)矩 。 因此 ,如圖 , 可以把由電流傳感器檢測(cè)得到的實(shí)際電動(dòng)機(jī)電流 i與電流指令 i*比較 , 得到電流誤差 : 圖 力控制系統(tǒng)的構(gòu)成原理圖 在這種方法中 ,根據(jù)圖 (a)中表示的三角波信號(hào) SW 和Δi的大小關(guān)系 , 生成斷路器的開／關(guān)信號(hào) 。 三角波比較法的原理在圖 (b)中清楚地表示了出來 。 斷路器的開信號(hào)依據(jù)下列規(guī)律發(fā)生 : ???????開信號(hào)不發(fā)生開信號(hào)發(fā)生::WWSiSi () 因此 , 在 (1)的期間 ,如果 i小于 i*, 則 Δi增加 , 其結(jié)果是在 (2)的期間斷路器信號(hào)的流通率增大 ,電動(dòng)機(jī)外加電壓上升 ,i增大 。 當(dāng) i過分增大時(shí) ,Δi減小 ,于是像 (3)期間那樣 ,流通率減小 ,電流 i減小 。 為了提高 i對(duì) Δi的跟蹤特性 , 可增大三角波的頻率 ,根據(jù)斷路器開關(guān)元件的不同 , 通常其頻率限制在數(shù)千赫到十幾千赫范圍內(nèi) 。 圖 三角波比較法的原理 2. 在前面的式 ()中研究了機(jī)械系統(tǒng)的運(yùn)動(dòng)方程 , 這里當(dāng)我們忽略黏性摩擦系數(shù) , 且相對(duì)于負(fù)載轉(zhuǎn)矩電動(dòng)機(jī)產(chǎn)生的轉(zhuǎn)矩增加時(shí) , 加速度變?yōu)檎?, 電動(dòng)機(jī)的旋轉(zhuǎn)速度上升 。 反之 , 當(dāng)轉(zhuǎn)矩減小時(shí) , 加速度變?yōu)樨?fù)值 , 電動(dòng)機(jī)的旋轉(zhuǎn)速度下降 。 電動(dòng)機(jī)的速度控制系統(tǒng)構(gòu)成如圖 , 是由轉(zhuǎn)矩控制來實(shí)現(xiàn)的 , 速度控制環(huán)路配置在轉(zhuǎn)矩控制環(huán)路的外側(cè) 。 圖 速度控制系統(tǒng) 采用以測(cè)速發(fā)電機(jī)和編碼器為代表的速度傳感器 ,可以檢測(cè)出電動(dòng)機(jī)的旋轉(zhuǎn)速度 。 這個(gè)速度用來與速度指令 ω*m進(jìn)行比較 。 這里將產(chǎn)生的速度誤差 Δωm返回到速度控制部分 , 并且通過轉(zhuǎn)矩指令 T*的增減 ,力圖使速度指令與實(shí)際速度達(dá)到一致 。 速度控制部分采用 PI控制 , 即比例積分控制 : ? ?????? tKKT dm1mp* ?? () 在式 ()中 ,用速度誤差 Δωm乘以增益 Kp的結(jié)果 ,與速度誤差的積分值乘以增益 K1的結(jié)果進(jìn)行相加 ,就給出了產(chǎn)生轉(zhuǎn)矩指令的一種方法 。 通