基于Simulink的復(fù)合驅(qū)動機(jī)器人關(guān)節(jié)臂試驗(yàn)系統(tǒng)仿真分析
加入技術(shù)交流群
(1) 液壓馬達(dá)轉(zhuǎn)向控制
單片機(jī)控制器根據(jù)步進(jìn)電機(jī)的轉(zhuǎn)向輸出兩路開關(guān)量信號,控制電磁換向閥兩個(gè)電磁鐵的通斷,使閥芯處于左位或右位,從而起到控制液壓馬達(dá)轉(zhuǎn)向的作用,使液壓馬達(dá)與步進(jìn)電機(jī)的轉(zhuǎn)向相同;
(2) 液壓馬達(dá)輸出扭矩控制
單片機(jī)控制器根據(jù)扭矩傳感器反饋信號的大小V輸出電流信號I1,控制電液比例壓力閥的調(diào)壓壓力p,起到控制液壓馬達(dá)輸出扭矩大小的作用,使步進(jìn)電機(jī)承受的負(fù)載不超過其額定負(fù)載的70%;
(3) 液壓馬達(dá)轉(zhuǎn)速控制
單片機(jī)控制器根據(jù)步進(jìn)電機(jī)控制脈沖信號的頻率輸出電流信號I2,控制電液比例調(diào)速閥的流量Q,起到控制液壓馬達(dá)轉(zhuǎn)速的作用,使液壓馬達(dá)跟隨步進(jìn)電機(jī)同步轉(zhuǎn)動;
(4) 液壓馬達(dá)啟?？刂?BR>單片機(jī)控制器根據(jù)扭矩傳感器反饋信號的大小V與液壓馬達(dá)的啟動設(shè)定值K(步進(jìn)電機(jī)額定輸出扭矩的70%)進(jìn)行比較,V≥K時(shí),控制電磁換向閥處于左位或右位,液壓馬達(dá)啟動,輔助步進(jìn)電機(jī)共同驅(qū)動負(fù)載;VK時(shí),控制電磁換向閥處于中位,液壓馬達(dá)停止,步進(jìn)電機(jī)單獨(dú)驅(qū)動負(fù)載。
由此可以看出,液壓伺服系統(tǒng)實(shí)質(zhì)上是一個(gè)位移與扭矩控制的伺服隨動系統(tǒng)。
通過單片機(jī)控制器的協(xié)調(diào),使電機(jī)伺服系統(tǒng)的控制在液壓伺服系統(tǒng)的輔助驅(qū)動下實(shí)現(xiàn)重載荷快速高精度定位的功能,達(dá)到復(fù)合伺服驅(qū)動的目的。
3 復(fù)合驅(qū)動機(jī)器人關(guān)節(jié)臂試驗(yàn)系統(tǒng)的數(shù)學(xué)建模
3.1 電機(jī)伺服驅(qū)動建模
設(shè)機(jī)器人關(guān)節(jié)臂的輸出角位移為
,步進(jìn)電機(jī)輸入角位移為
,傳動系統(tǒng)為剛性系統(tǒng),則步進(jìn)電機(jī)輸出角位移也為
,試驗(yàn)系統(tǒng)采用斬波恒流驅(qū)動方式,在恒流源條件下,其轉(zhuǎn)矩為[1] 
式中,
為電機(jī)總電磁轉(zhuǎn)矩系數(shù),
為電機(jī)轉(zhuǎn)子角位移,
為電機(jī)轉(zhuǎn)子實(shí)際角位移,
為步進(jìn)電機(jī)有效輸出轉(zhuǎn)矩,
為步進(jìn)電機(jī)轉(zhuǎn)子轉(zhuǎn)動慣量,
為步進(jìn)電機(jī)轉(zhuǎn)子轉(zhuǎn)動時(shí)的阻尼系數(shù),
為電機(jī)驅(qū)動系統(tǒng)總有效輸入轉(zhuǎn)矩,
為機(jī)器人關(guān)節(jié)臂傳動軸等效轉(zhuǎn)動慣量,
為機(jī)器人關(guān)節(jié)臂傳動軸等效阻尼系數(shù)。
對式(1)進(jìn)行拉普拉斯變換,假定初始條件為0,得
3.2 液壓馬達(dá)驅(qū)動建模
本系統(tǒng)所用液壓馬達(dá)實(shí)際輸出扭矩[2]
為 
式中,
為液壓馬達(dá)工作壓力
為機(jī)械效率;電液比例壓力閥的比例電磁鐵的輸入電流為
,比例常數(shù)為
。
液壓馬達(dá)的進(jìn)口處實(shí)際流量[3
為
式中,
為液壓馬達(dá)排量
,
為液壓馬達(dá)實(shí)際轉(zhuǎn)速
,
液壓馬達(dá)容積效率,
為液壓馬達(dá)實(shí)際角速度
;電液比例調(diào)速閥的比例電磁鐵的輸入電流為
,比例系數(shù)為
。
由上述公式經(jīng)化簡得 
對式(2)進(jìn)行拉普拉斯變換,并設(shè)初始條件為0,得
4 復(fù)合驅(qū)動機(jī)器人關(guān)節(jié)臂試驗(yàn)系統(tǒng)仿真
4.1 系統(tǒng)仿真模型的建立與仿真
應(yīng)用Matlab/Simulink軟件,根據(jù)系統(tǒng)的數(shù)學(xué)模型建立復(fù)合驅(qū)動系統(tǒng)仿真模型[4]如圖3所示,stepmotormodel是電機(jī)伺服系統(tǒng)的仿真子模型系統(tǒng)模塊,Transfer Fcn1是機(jī)器人關(guān)節(jié)臂傳遞函數(shù)模塊,Slider Gain2和Transport Delay是液壓伺服系統(tǒng)的增益和延遲模塊。仿真系統(tǒng)采用最大扭矩負(fù)荷50000N●mm作為負(fù)載擾動,采用變步長仿真算法,最大步長設(shè)置為0.1,最小步長設(shè)置為1×10-30,仿真算法采用ode45算法,延遲時(shí)間為0.02s,在輸入端In1分別輸入階躍信號和正弦信號。系統(tǒng)響應(yīng)如圖4所示。
51單片機(jī)相關(guān)文章:51單片機(jī)教程
伺服電機(jī)相關(guān)文章:伺服電機(jī)工作原理
評論