周燁
(常州劉國鈞高等職業(yè)技術(shù)學(xué)校,江蘇 常州 213000)
數(shù)學(xué)及數(shù)學(xué)工具如MATLAB 現(xiàn)已滲透到各個工程領(lǐng)域并開展了廣泛深入的應(yīng)用,正是這些應(yīng)用的廣泛和深入推廣,推動了工程領(lǐng)域的高速發(fā)展。在工程領(lǐng)域,全向移動機(jī)器人具有平面內(nèi)三個自由度(即具有全向移動性),適合在狹小的工作空間內(nèi)移動[1]。經(jīng)查閱文獻(xiàn),國內(nèi)對主動腳輪研究甚少,僅在文獻(xiàn)[2]中進(jìn)行了研究,其研究方向側(cè)重于控制算法研究[2]。同時,文獻(xiàn)[3]表明主動腳輪是全向移動機(jī)器人的理想行走機(jī)構(gòu)。因此,本文對機(jī)器人腳輪展開研究,利用腳輪基本的幾何和運(yùn)動關(guān)系,構(gòu)建并推導(dǎo)了腳輪速度的數(shù)學(xué)關(guān)系表達(dá)式及運(yùn)動學(xué)數(shù)學(xué)模型,同時進(jìn)一步采用數(shù)學(xué)仿真工具M(jìn)ATLAB 對其進(jìn)行仿真計算,獲得了該腳輪的運(yùn)動學(xué)解,驗證了本文所構(gòu)建的數(shù)學(xué)模型的正確性,為機(jī)器人腳輪及相近領(lǐng)域提供一定的分析參考。
機(jī)器人主動腳輪具有驅(qū)動能力,主動腳輪具有驅(qū)動電機(jī)和轉(zhuǎn)向電機(jī)兩個電機(jī)同時驅(qū)動。其結(jié)構(gòu)有驅(qū)動電機(jī)、齒輪、皮帶等。
根據(jù)兩腳輪的幾何關(guān)系,同時對角度以時間進(jìn)行求導(dǎo),得出兩輪子作用到移動機(jī)器人幾何中心的速度為:
整理成矩陣形式腳輪1 的運(yùn)動學(xué)模型為:
采用數(shù)學(xué)工具M(jìn)ATLAB 軟件對上述模型進(jìn)行求解,將模型的尺寸參數(shù)、電機(jī)轉(zhuǎn)速參數(shù)作為輸入條件,其中結(jié)構(gòu)參數(shù)為:m=692.82mm,r=b=50mm。在軟件中獲取機(jī)器人進(jìn)行原地轉(zhuǎn)向1s后,得到機(jī)器人的各運(yùn)動關(guān)節(jié)數(shù)據(jù)如圖2 所示。
圖2 腳輪軟件求解結(jié)果曲線
軌跡規(guī)劃是移動機(jī)器人進(jìn)行運(yùn)動控制的關(guān)鍵步驟,是分析計算的目的和意義所在。軌跡規(guī)劃發(fā)方法很多,目前普遍的是多項式法。由于采用五次多項式進(jìn)行插值能保證位置、速度、加速度以及加價速度的曲線平滑,因此本文采用五次多項式法進(jìn)行軌跡規(guī)劃。在XY 平面用五次樣條曲線對移動機(jī)器人進(jìn)行軌跡規(guī)劃后得到的位置(P),速度(V),加速度(a)曲線值如圖3 所示。
圖3 機(jī)器人的位置、速度、加速度曲線圖
從仿真結(jié)果來看:對于移動機(jī)器人進(jìn)行速度規(guī)劃,令移動機(jī)器人的運(yùn)動軌跡為一個矩形;移動機(jī)器人以0.25m/s2的加速度加速2s 后,以0.5m/s 的速度勻速行駛4s,最終以0.25m/s2的加速度減速到靜止;移動機(jī)器人以-0.25m/s2的加速度加速2s 后,以0.5m/s 的速度實(shí)現(xiàn)倒行,最終以0.25m/s2的加速度減速到停止;移動機(jī)器人以0.25m/s2的加速度加速2s 后,實(shí)現(xiàn)以0.5m/s的速度勻速側(cè)向移動4s,最終以0.25m/s2的加速度減速到靜止。移動機(jī)器人的運(yùn)動仿真與預(yù)期規(guī)劃好的運(yùn)動軌跡完全吻合,文中所建立的移動機(jī)器人的運(yùn)動學(xué)模型合理。
采用數(shù)學(xué)及其數(shù)學(xué)工具,針對一種機(jī)器人腳輪展開分析,利用腳輪基本的幾何和運(yùn)動關(guān)系構(gòu)建并推導(dǎo)了腳輪速度的數(shù)學(xué)關(guān)系表達(dá)式及運(yùn)動學(xué)數(shù)學(xué)模型,進(jìn)一步對其仿真求解驗證了模型的正確性;并在此基礎(chǔ)上進(jìn)一步采用五次多項式進(jìn)行了軌跡規(guī)劃,獲得了較好的控制目標(biāo),能夠為機(jī)器人腳輪的設(shè)計計算提供一定參考和借鑒。