雙驅(qū)雙向AGV機器人運動學分析及仿真

2016-04-12 06:53:00KinematicsanalysisandsimulationofdoubledriveanddoubledirectionAGVrobot

制造業(yè)自動化 2016年3期

Kinematics analysis and simulation of double-drive and double-direction AGV robot

王殿君1，關(guān)似玉1，陳　亞1，彭文祥1，王超星2

（1.北京石油化工學院機械工程學院，北京 102617；2.北京化工大學機械工程學院，北京 100029）

WANG Dian-jun1,　GUAN Si-yu1,　CHEN Ya1,　PENG Wen-xiang1,　WANG Chao-xing2

雙驅(qū)雙向AGV機器人運動學分析及仿真

Kinematics analysis and simulation of double-drive and double-direction AGV robot

王殿君1，關(guān)似玉1，陳亞1，彭文祥1，王超星2

（1.北京石油化工學院機械工程學院，北京 102617；2.北京化工大學機械工程學院，北京 100029）

WANG Dian-jun1,GUAN Si-yu1,CHEN Ya1,PENG Wen-xiang1,WANG Chao-xing2

摘要：針對雙驅(qū)雙向AGV機器人采用兩個驅(qū)動模塊的構(gòu)型特點，利用四輪差速原理建立AGV機器人在轉(zhuǎn)彎過程的運動學模型，運用ADAMS仿真軟件對AGV機器人進行運動學仿真，并利用MATLAB軟件對AGV機器人運動學模型進行數(shù)值分析，通過對比機器人理論計算和仿真結(jié)果的偏差，驗證了運動學理論分析的正確性，為繼續(xù)優(yōu)化機器人結(jié)構(gòu)設(shè)計、軌跡規(guī)劃以及控制系統(tǒng)設(shè)計奠定了基礎(chǔ)。

關(guān)鍵詞：雙驅(qū)雙向AGV機器人；運動學模型；虛擬樣機

0　引言

自動導(dǎo)引車（Automated Guided Vehicle，簡稱AGV）是智能搬運機器人的種，它主要依靠電磁、激光或磁條等導(dǎo)引裝置，無需操作人員駕駛就能沿預(yù)定軌跡或?qū)б窂叫羞M，實現(xiàn)物料的智能搬運[1～3]。在自動化物流系統(tǒng)中，最能充分地體現(xiàn)AGV的自動化和柔性，實現(xiàn)高效、經(jīng)濟、靈活的無人化生產(chǎn)。同時，隨著AGV性能的不斷完善，其應(yīng)用范圍大為擴展，不僅將在工業(yè)、農(nóng)業(yè)、國防、醫(yī)療、服務(wù)等行業(yè)中得到廣泛的應(yīng)用，而且將在搜索、救援、輻射和空間領(lǐng)域等有害與危險場合得到很好的應(yīng)用。

1　雙驅(qū)雙向AGV機器人運動學模型的構(gòu)建

1.1三維模型的建立

雙驅(qū)雙向AGV機器人的機械本體是由車體、驅(qū)動模塊、牽引模塊以及輔助運動模塊等組成。采用UG軟件建立了AGV的維模型如圖1所示。AGV的行走機構(gòu)由四個向輪、兩個驅(qū)動模塊組成，按中心對稱布置，每個驅(qū)動模塊包括兩個驅(qū)動輪。機器人的直線和轉(zhuǎn)彎行走主要通過驅(qū)動模塊來實現(xiàn)，AGV機器人可以按照預(yù)設(shè)的軌跡路線進行作業(yè)，實現(xiàn)在不同復(fù)雜工況下的預(yù)設(shè)搬運任務(wù)。

圖1　雙驅(qū)雙向AGV機器人三維模型

1.2運動學模型的建立

在對雙驅(qū)雙向AGV機器人進行運動學建模之前，先作如下假設(shè)：

1）AGV由剛性構(gòu)架組成；

2）運動平面平整光滑，且只作無滑移純滾動運動；

3）車輪與地面摩擦小到不足以影響車輪沿自身旋轉(zhuǎn)軸線轉(zhuǎn)動。

圖2　雙驅(qū)雙向AGV機器人結(jié)構(gòu)簡圖

當AGV機器人沿著鋪設(shè)的磁條直線行走時，兩個驅(qū)動模塊的四個驅(qū)動輪速度相等；當AGV機器人轉(zhuǎn)彎行走時，要通過兩個驅(qū)動模塊的協(xié)調(diào)以及AGV機器人自動循跡運動來實現(xiàn)。將雙驅(qū)雙向AGV轉(zhuǎn)彎過程抽象為個階段，如圖3所示。

圖3　轉(zhuǎn)彎過程運動簡圖

圖4　轉(zhuǎn)彎第一階段

O1點速度為：

由圖4可知，在ΔFHO2中，，進步化簡得：

綜上所述，雙驅(qū)雙向A G V最小轉(zhuǎn)彎半徑為Rmin=737mm/1.414=521mm。

由于剛體運動時剛體上各點角速度相等，則O2點角速度為：

設(shè)t1時刻兩個驅(qū)動模塊瞬時運動半徑為R'，O2點瞬時速度為：

在ΔFO1O2中，，在ΔFHO2中，，代入公式(5)可得：

由于第二個驅(qū)動模塊沿著磁條做直線運動，可以得出C、D輪速度為：

2）AGV轉(zhuǎn)彎第二階段

圖5　轉(zhuǎn)彎第二階段

設(shè)t2時刻兩個驅(qū)動模塊瞬時運動半徑為磁條的鋪設(shè)半徑R，由式(3)～式(5)可以得出O2點速度為：

圖6　轉(zhuǎn)彎第三階段

設(shè)經(jīng)過時間t3，第二個驅(qū)動模塊轉(zhuǎn)過的角度與X軸夾角為D輪走過的弧長為，C輪走過弧長為，則C輪和D輪走過的弧長差為：

設(shè)t3時刻兩個驅(qū)動模塊的瞬時半徑為R''，在ΔFO1O2中，則在ΔFHO1中：

此時C輪速度為V3，D輪速度為V4，則O2點速度為：

第二個驅(qū)動模塊沿著磁帶做圓周運動，則O2點角速度為：

兩個驅(qū)動模塊組合成剛體運動，剛體運動時角速度處處相等，則O1點角速度為：

O1點瞬時速度為：

聯(lián)立式(10)、式(13)與式(14)可知O1點瞬時速度為：

表1　AGV轉(zhuǎn)彎過程各驅(qū)動輪瞬時速度

2　雙驅(qū)雙向AGV機器人運動學仿真

2.1仿真方案的確定

圖7　運動學仿真技術(shù)方案

2.2虛擬樣機的建立

圖8　ADAMS中的雙驅(qū)雙向AGV機器人虛擬樣機

模型導(dǎo)入后首先將不需要仿真的AGV部件運用固定副連接起來使之不能相對運動，然后對四個向支撐輪和四個驅(qū)動輪創(chuàng)建旋轉(zhuǎn)副，并把剩余的部件運用相應(yīng)的運動副連接起來，最后在各個車輪和地面之間建立接觸。

將虛擬樣機中的各個部分連接好后，需要在四個驅(qū)動輪上添加驅(qū)動。由于驅(qū)動模塊上有個彈簧提供給驅(qū)動模塊正壓力，所以還需要在驅(qū)動模塊和車架之間添加彈簧，然后將彈簧系數(shù)設(shè)置為15N.mm，并添加預(yù)緊力[8～10]。經(jīng)過上述操作，使得AGV虛擬樣機能夠在設(shè)置的平面上順利行走。

2.3運動學仿真與分析

為了完整地仿真AGV的行走特性，設(shè)定AGV的行走過程為：先讓AGV走段直線，控制AGV左轉(zhuǎn)彎，然后再讓AGV走段直線，再左轉(zhuǎn)彎，反復(fù)運動，AGV共完成四個彎道。將AGV仿真過程分為四部分，每個部分包括直線行走以及轉(zhuǎn)彎行走個階段，共16個運動階段，每個驅(qū)動輪需要編寫16個STEP函數(shù)，根據(jù)AGV各個驅(qū)動輪瞬時速度方程，計算各個階段臨界點速度，編寫四個驅(qū)動輪的STEP函數(shù)。

在圖10中，每個驅(qū)動模塊的位移曲線在X、Z方向的同步變化反應(yīng)了AGV的行走狀態(tài)。兩個驅(qū)動模塊的位移曲線在X或Z方向的大小與趨勢幾乎沒有偏差，說明AGV的兩個驅(qū)動模塊運行時軌跡重復(fù)，不會發(fā)生脫離磁條的情況。

2.4理論計算與仿真分析的對比

根據(jù)所推導(dǎo)出的AGV機器人運動學模型，采用ADAMS仿真中初始驅(qū)動輪的瞬時速度值及臨界點的速度值，利用MATLAB編程并求解出AGV機器人第個驅(qū)動模塊和第二個驅(qū)動模塊中心點在X、Z方向的位移，將數(shù)據(jù)提取出來，再與ADAMS仿真得出的軌跡點繪于同圖中，如圖11～圖14所示。