隨著物流網(wǎng)技術(shù)的發(fā)展, 機器人廣泛應(yīng)用于物流領(lǐng)域。目前國內(nèi)的物流領(lǐng)域?qū)C器人的應(yīng)用主要集中在從事包裝碼垛作業(yè)和自動化搬運, 而對于物流環(huán)節(jié)中的重要環(huán)節(jié)——倉儲卻有所缺失[1,2]。倉儲機器人技術(shù)應(yīng)用已經(jīng)成為制約我國倉儲乃至物流行業(yè)快速發(fā)展的重要原因之一[3]。
本文將多軸技術(shù)應(yīng)用與倉儲機器人, 研制了一臺八軸獨立驅(qū)動倉儲機器人, 并以此為平臺開展全輪或多輪轉(zhuǎn)向控制方法的研究, 從而提高機器人的運動靈活性和穩(wěn)定性。
按照控制和驅(qū)動轉(zhuǎn)向機構(gòu)的方式, 目前車輛上常用的多輪轉(zhuǎn)向系統(tǒng)可分為機械式、液壓式、電控機械式、電控液壓式和電控電動式等幾種類型。電控電動式多軸轉(zhuǎn)向系統(tǒng)具有動態(tài)響應(yīng)快, 無累計誤差, 轉(zhuǎn)向控制精度高、抗外界干擾能力強、結(jié)構(gòu)緊湊、體積小、布局方便等優(yōu)點, 但是其產(chǎn)生的驅(qū)動力較小。
根據(jù)倉儲機器人的體積小、運動靈活性高的要求, 采用電控電動式轉(zhuǎn)向系統(tǒng), 八軸獨立驅(qū)動, 各軸之間、各軸內(nèi)外側(cè)輪之間無任何機械連接, 結(jié)構(gòu)上相互獨立。每個輪子均裝有轉(zhuǎn)向舵機和驅(qū)動電機, 采用光電碼盤測量電機轉(zhuǎn)速。
Equation Section (Next) 控制系統(tǒng)采用主從控制結(jié)構(gòu), 主控器按照預(yù)定的轉(zhuǎn)向控制策略計算出各輪的理論轉(zhuǎn)角, 實現(xiàn)多軸協(xié)調(diào)轉(zhuǎn)向運動規(guī)劃;從控器作為單輪控制器, 實現(xiàn)單輪的轉(zhuǎn)向控制和驅(qū)動控制, 根據(jù)碼盤的反饋信號修正電機轉(zhuǎn)速。
機器人作為剛體, 在空間中運動具有6個自由度, 建立機器人固有坐標系, 以質(zhì)心為原點, 機器人前進方向為軸, 垂直于水平面向上為軸, 根據(jù)右手坐標系確定軸方向。為了便于研究通常簡化為兩個自由度, 即假設(shè)機器人前進速度不變, 只作平行于地面的運動。簡化后的兩個自由度為沿軸方向的側(cè)向運動和繞軸在平行于地面的平面內(nèi)的橫擺運動, 此時的機器人可簡化為四輪模型。
假設(shè)β為質(zhì)心的側(cè)偏角, β=v/u;ui為i輪的速度;li為質(zhì)心到i輪的距離;δi為i輪的轉(zhuǎn)角;FYi為地面對i輪的側(cè)偏力, 產(chǎn)生的側(cè)偏角為θi;當(dāng)δi較小時, 側(cè)向加速度小于0.4g, 側(cè)偏特性位于線性范圍內(nèi)[4], 有為i輪的輪胎側(cè)偏剛度, i=1, 2, 3, 4。
對質(zhì)心運動進行運動學(xué)和動力學(xué)分析, 將前輪的轉(zhuǎn)角設(shè)δ1為輸入值, 由阿克曼原理可近似為其中為系數(shù), L1i表示前軸到i軸的距離, 可得四輪模型的二自由度運動微分方程。
以機器人的質(zhì)心側(cè)偏角β=0為控制目標, 采用經(jīng)典PID算法。
由式 (1) 可以得出, 要想計算純滾動狀態(tài)下各輪的轉(zhuǎn)角, 首先必須計算轉(zhuǎn)向中心的位置, 即求出轉(zhuǎn)向中心到前軸的距離L1。機器人處于穩(wěn)定狀態(tài)時, 側(cè)向加速度、橫擺角加速度側(cè)偏角均為零, 可求得轉(zhuǎn)向中心到前軸的距離L1, 與機器人質(zhì)量和前進速度有關(guān)。
如式 (1) 所示, 當(dāng)輸入項為前軸轉(zhuǎn)角δ1, 側(cè)向加速度、橫擺角加速度均為零時, 此時解出的和為穩(wěn)態(tài)響應(yīng)結(jié)果。由βs=vs/u則可得到側(cè)偏角相對于輸入項的穩(wěn)態(tài)增益βss。在上述靜態(tài)分析的基礎(chǔ)上, 對式 (1) 進行拉普拉斯變換, 初始條件為0, 與β=v/u聯(lián)立可得出側(cè)偏角二階傳遞函數(shù)。
由于轉(zhuǎn)向中心到前軸距離L1是機器人前進速度的函數(shù), 當(dāng)機器人前進速度一定時, 轉(zhuǎn)向中心位置是確定不變的。在Simulink仿真環(huán)境下, 機器人前進速度從0.1m/s以恒定速度增加到2m/s, 結(jié)果顯示:機器人前進速度增加時, 轉(zhuǎn)向中心到前軸的距離L1也在增加, 且兩者呈非線性關(guān)系。
根據(jù)推導(dǎo)出來的側(cè)偏角與前輪轉(zhuǎn)角的傳遞函數(shù), 利用Simulink框圖進行仿真, 轉(zhuǎn)角輸入為階躍函數(shù), 以零側(cè)偏角為控制目標, 仿真時進行低速和高速轉(zhuǎn)向?qū)Ρ? 低速選擇0.6m/s, 高速選擇1.8m/s。結(jié)果顯示, 低速轉(zhuǎn)向性能較好, 但不管低速還是高速轉(zhuǎn)向, 質(zhì)心零側(cè)偏角的控制方法均能有效進行控制。
多軸轉(zhuǎn)向控制技術(shù)主動控制轉(zhuǎn)向時的側(cè)向運動, 提高轉(zhuǎn)向機動性和操縱穩(wěn)定性, 改善轉(zhuǎn)向響應(yīng)性能。本文研制的移動機器人, 采用電動電控式多軸轉(zhuǎn)向系統(tǒng), 全輪獨立驅(qū)動, 基于二自由度模型建立機器人運動微分方程, 并對全輪參與的轉(zhuǎn)向模式進行轉(zhuǎn)向原理分析與控制方法研究, 最后仿真驗證了質(zhì)心零側(cè)偏角控制算法的有效性, 為多軸轉(zhuǎn)向控制技術(shù)的深入研究打下堅實的基礎(chǔ), 為進一步的全輪或多輪轉(zhuǎn)向控制算法提供了很好的平臺。
上一篇: 保稅倉儲機遇可期
權(quán)所有©:上海陽合儲運
專業(yè)承接上海倉庫租賃、上海倉儲配送物流、上海電商倉儲企業(yè)服務(wù)與微笑同在"的先進理念不斷發(fā)展壯大。