全向車測量輪導引方式的設計與仿真

朱艷杰, 宜亞麗, 景常海, 戴勇波

(1. 燕山大學 機械工程學院, 河北 秦皇島 066004； 2. 北京星航機電裝備有限公司, 北京 100074)

?

全向車測量輪導引方式的設計與仿真

朱艷杰1, 宜亞麗1, 景常海1, 戴勇波2

(1. 燕山大學 機械工程學院, 河北 秦皇島 066004； 2. 北京星航機電裝備有限公司, 北京 100074)

針對全向車位姿檢測中由于麥克納姆輪驅動打滑引起的整車運行精度測量誤差大的問題,提出了測量輪自主導引方式,建立數學模型,并對AGV系統結構進行了闡述.設計方案中的整車六輪布局,采用四驅兩從動,倆從動輪作為測量輪,運用差速原理獲取自動導引全向車的路徑信息,同時解決了現有單測量輪全向車原地回轉狀態下位姿無法精確檢測的難題.提出浮動三自由度測量輪結構設計,實現實時接觸地面,保證位姿檢測的準確性,并對直線、曲線、原地自轉三種典型運動狀態下的位姿檢測進行了ADAMS仿真,結果表明,此種導引方式可滿足靈活設置路徑下全向車位姿的精確檢測,適用范圍廣.

全向車; 測量輪導引; 麥克納姆輪; 運動學仿真

自動導引車(automatic guided vehicle,AGV)即全向車,是現代化生產及柔性制造系統中的關鍵設備,已廣泛應用于倉儲業、制造業、自動化物流等領域[1-3].它具有柔性好、運輸效率高及作業可靠等優點,并在眾多行業中替代人工,甚至完成人工很難完成的一些操作,從而減輕了工人的勞動強度,降低危險性[4-6].

導引方式是AGV的研究核心之一[7],也是實現AGV自動化、智能化的關鍵技術.基于導引傳感器的不同,可將AGV的導引方式分為有線導引[8-10]和無線導引[11-13].鄭炳坤等[14]提出了一種基于控制器局域網絡(controller area network, CAN)總線、易于擴展的磁導航AGV控制系統,其路徑設置較容易,但磁帶易受污染和損傷,需定期更新與重涂.童峰等[15]設計出一種用于AGV的超聲波導引系統,介紹了其工作原理及結構,并進行了各項導引功能的測試,該導引方式的優點是在特定環境下具有較好的柔性，缺點是需要較大的反射面,在生產車間內應用較為困難.陳順平等[16]采用激光導引方式設計出AGV小車,其優點是定位準確,路徑變更較容易，缺點是對作業環境中光線要求較高.Jung等[17]提出基于ANFIS的AGV視覺導引方式,通過不同角度獲取周圍環境的圖像并整合成立體影像,進而確定AGV的位置和姿態(簡稱位姿)并導引,優點是路徑設置靈活,適用范圍廣,但由于技術限制,該方法并未進入實用階段.

為設計一種穩定性好、可靠性高、路徑自由且適應性強的全向車產品,本文提出一種雙測量輪導引方式.現有單測量輪方式,測量輪處于全向車平面幾何中心,當全向車作原地回轉運動時,測量輪轉軸即整車回轉中心,致使全向車原地回轉狀態下位姿無法精確檢測.雙測量輪不僅可以避免此現象,還改善了運行過程中單測量輪轉軸波動的隨機性.用編碼器記錄2個測量輪的旋轉圈數和水平旋轉角度,數據經中央控制器處理,獲得AGV的位置和姿態,進而得出其位姿偏差,CPU發送信號給四軸運動控制器,由其實時調整整車的運動方式,使 AGV沿著預定的路線行駛.

1　測量輪導引方式的工作原理

1.1測量輪導引方式

如圖1所示,在全向車中心線兩側對稱安裝2個測量輪,即六輪結構布局形式.通常差速原理運用于驅動輪(麥克納姆輪)上,但因麥克納姆輪結構的特殊性,在運動過程中不可避免地出現打滑現象,會影響位姿檢測的精度,因此將差速原理應用在從動輪(測量輪)上,通過這2個測量輪的速度差與水平旋轉角度實現AGV位姿的檢測.倆測量輪上均裝有增量式編碼器和絕對值式編碼器,增量式編碼器記錄測量輪旋轉的圈數,安裝在倆測量輪的水平旋轉軸上,倆輪圈數和方向一致說明AGV直線行駛,圈數或方向不一致說明AGV曲線行駛.絕對值式編碼器記錄測量輪水平方向轉動的角度,當全向車直線前行時,絕對值式編碼器計數為0,曲線行駛或原地自轉時,編碼器計數為相應的轉動角度值.

圖1　全向車車輪布局圖Fig.1　The wheel layout of omnidirectional vehicle

測量輪導引方式路徑變更靈活,只需改變軟件程序即可實現[18],在導引區域內,AGV可依據程序設定的路徑自由行走并精確定位,且導引路徑可根據實際情況隨時變動,充分發揮了AGV的導引柔性,提高了工作效率.

1.2測量輪導引方式的數學模型

全向車的位姿檢測通過2個測量輪的速度差來實現,假設運動學模型在理想狀態下建立,即：車體為剛性,地面水平,測量輪與地面間無相對滑動.基于雙測量輪的全向車運動簡化模型如圖2所示.

圖2　基于雙測量輪的全向車運動簡化模型Fig.2　The simplified model of omnidirectional vehicle movement based on two measuring wheels

圖中XOY為大地坐標系,O1,O2為倆測量輪的輪心,M為O1O2中點,即車體幾何中心,且O1O2=2L,輪1、輪2與車體之間的夾角分別為γ1,γ2,輪半徑為r,瞬時轉彎半徑OM=R(t),v1,v2,vM分別為倆測量輪1,2及M點的瞬時速度.

ω1(t)=Δθ1/Δt=dθ1/dt,

(1)

ω2(t)=Δθ2/Δt=dθ2/dt,

(2)

v1(t)=rω1(t),

(3)

v2(t)=rω2(t),

(4)

式中：θ1,θ2分別為測量輪1,2的旋轉角度;ω1,ω2為其對應的角速度.

由速度瞬心法分析式(3)和式(4)可得

vM(t)=v1(t)·

(5)

由

ω(t)=vM(t)/R(t)，

得

(6)

由式(1)至式(5)可得：

(7)

(8)

則t時刻全向車的位姿向量為

(9)

1.3AGV系統結構框圖

圖3　AGV系統結構框圖Fig.3　The structure diagram of AGV system

AGV系統結構框圖如圖3所示.首先,上位機通過程序設定方式給AGV制定運行路徑,位姿檢測模塊中通過倆測量輪實時檢測AGV的位置和姿態,并將檢測數據傳輸給中央控制器,經其運算處理,得出AGV的真實運行情況及行駛偏差,CPU發送信號給四軸運動控制器,由其控制4臺電機的轉速及轉向,實時調整整車的運動方式,以完成上位機發送的指定任務.

2　測量輪的結構設計

為滿足各行業對全向車應用的需求,AGV對不同的道路環境及復雜的氣候條件應具有良好的適應性.針對位姿檢測的高精度要求,測量輪的設計中應保證倆輪時刻與地面接觸以防止打滑,并能自動適應路面不平引起的上下浮動.測量輪整體結構如圖4所示.

圖4　測量輪整體結構圖Fig.4　The overall structural diagram of measuring wheel

測量輪主要由聚氨酯包膠輪、輪架、轉軸套筒、彈簧導柱、增量式編碼器和絕對值式編碼器等組成.整個測量輪有3個自由度：繞水平軸線的轉動,用于增量式編碼器信號采集,實現位移檢測；繞豎直軸線的轉動,用于絕對值式編碼器信號采集,實現轉角檢測；沿彈簧導柱的上下移動,使彈簧時刻處于壓緊狀態,在路面不平狀態下,保證聚氨酯包膠輪時刻與地面保持接觸,提高地面不平度適應性,避免打滑現象的產生,從而保證了編碼器計數的準確性.

3　測量輪導引方式的運動學仿真

3.1模型建立及參數設置

三維建模主要運用SolidWorks軟件,車體幾何尺寸為2 854 mm×1 424 mm×478 mm,四輪連心線尺寸為2 000 mm×1 210 mm,倆測量輪位于車體中間位置,且關于幾何中心對稱.麥克納姆輪的小輥子母線利用橢圓弧方程,取點擬合的方法,繞軸線旋轉即成輥子體；輪轂的設計在滿足強度、剛度要求的同時,還應使加工制造方便.整輪裝配時,使小輥子軸線與輪轂軸線成45°夾角,并滿足小輥子外輪廓線為圓形.整車模型如圖5所示.

圖5　全向車模型Fig.5　The model of omnidirectional vehicle

將建立好的模型導入ADAMS中,并對相關參數進行設置,運動副主要包括4個麥克納姆輪與車架之間的轉動副、32個小輥子與4個輪轂之間的轉動副、測量輪與地面之間的轉動副和測量輪與轉軸套筒之間的轉動副.小輥子與地面之間、測量輪與地面之間的靜摩擦系數均為0.3,動摩擦系數均為0.25,AGV行駛速度設置為0.5 m/s.

3.2仿真及分析

為了驗證測量輪導引方式的可行性,運用ADAMS軟件,模擬全向車的幾種運行方式,分別為直線行駛、曲線行駛和原地自轉運動,得出倆測量輪的運動速度和旋轉角度曲線圖.

1) 直線行駛.

因縱向行駛(Y向)、斜向行駛、橫向行駛(X向)在運動特性中均屬于直線運動,所以以Y向行駛為例,進行仿真分析.由圖6可知,測量輪1和2在Y和X方向上的分速度分別為v1.Y,v2.Y,v1.X,v2.X,曲線基本吻合,Y方向上的速度由0逐漸增加到0.5m/s,而X方向上的速度為0,與初始設定速度吻合,仿真結果符合設計要求.

圖6　直線行駛時測量輪的速度曲線Fig.6　The speed curve of measuring wheel when driving in a straight line

圖7中θ1.Z,θ2.Z(下同)分別表示倆測量輪繞豎直軸線Z轉動的角度,倆曲線基本重合,且在0°附近波動,即:Y向行駛時,測量輪水平轉動角度為0°,與前述原理吻合.說明通過采集測量輪的速度和轉動角度能夠正確反映全向車的位置和姿態.

圖7　直線行駛時測量輪的水平轉動角度曲線Fig.7　The horizontal rotation angle curve of measuring wheel when driving in a straight line

2) 曲線行駛.

以轉彎半徑2.5 m為例,圖8為全向車曲線行駛時倆測量輪合速度v1,v2的曲線,均從0逐漸增加到穩態值,且測量輪1的速度小于測量輪2的速度,證明全向車逆時針轉彎且速度穩定后仍有波動的主要原因是測量輪隨車身旋轉的滯后性及運動中轉軸方向的左右擺動.

圖8　曲線行駛時測量輪的速度曲線Fig.8　The speed curve of measuring wheel when driving in a curve

圖9為曲線行駛時倆測量輪繞豎直軸線Z轉動的角度θ1.Z,θ2.Z,倆輪曲線基本吻合,且由起始值0°逐漸增加到穩態值,并在穩態值附近上下波動,是由測量輪轉軸在水平方向的轉動引起的.圖8、圖9能夠清晰地示出全向車曲線運動時位姿的變化過程.

圖9　曲線行駛時測量輪的水平轉動角度曲線Fig.9　The horizontal rotation angle curve of measuring wheel when driving in a curve

3) 原地自轉.

由圖10和圖11可知,倆測量輪的合速度v1,v2和轉動角度基本一致,在0.8 s時測量輪1的曲線出現了大的波動,原因是:全向車逆時針旋轉時,測量輪1需調整自身方位,由+Y向轉至-Y向,以適應原地旋轉的狀態.

圖10　原地自轉時測量輪的速度曲線Fig.10　The speed curve of measuring wheel when in situ rotation

圖11　原地自轉時測量輪的水平轉動角度曲線Fig.11　The horizontal rotation angle curve of measuring wheel when in situ rotation

4　結　論

1) 提出了測量輪導引方式,采用雙測量輪,利用差速原理,依靠編碼器計數,獲取全向車運行狀態信息.該導引方式適應性好,性能可靠,導引路徑完全自由,發展前景廣闊.

2) 建立了測量輪導引方式的數學模型,為運動控制提供了理論依據.介紹了測量輪的結構設計,實現了倆輪與地面時刻接觸及自適應不平路面的功能,為位姿檢測的準確性提供了保證.

3) 通過ADAMS仿真,得到了全向車在直線行駛、曲線行駛和原地自轉三種運行方式中倆測量輪的速度和轉動角度曲線圖.經分析可知,通過測量輪檢測全向車的位置和姿態能夠滿足設計要求,驗證了此導引方式的可行性.

[1] 葉錦華,李迪,葉峰.多信息融合定位的自動導向車魯棒導引控制[J].電機與控制學報,2013,17(9)：111-118．

YE Jin-hua,LI Di,YE Feng.Robust guidance control of nonholonomic AGV with localization based on multi-source information fusion[J].Electric Machines and Control,2013,17(9):111-118．

[2] 蒲亮亮,張小棟.光導AGV智能循跡測控系統的建模與仿真[J].測控技術,2011,30(5)：85-88,97．

PU Liang-liang,ZHANG Xiao-dong.Modeling and simulation of intelligent tracking control system for a photoconductive AGV[J].Measurement and Control Technology,2011,30(5):85-88,97．

[3] 武星,樓佩煌,唐敦兵.自動導引車路徑跟蹤和伺服控制的混合運動控制[J].機械工程學報,2011,47(3)：43-48．

WU Xing,LOU Pei-huang,TANG Dun-bing.Integrated motion control of path tracking and servo control for an automated guided vehicle[J].Journal of Mechanical Engineering,2011,47(3):43-48．

[4] 武啟平,金亞萍,任平,等.自動導引車(AGV)關鍵技術現狀及其發展趨勢[J].制造業自動化,2013,35(5)：106-109．

WU Qi-ping,JIN Ya-ping,REN Ping,et al.Present situation and developing trend of AGV key technology[J].Manufacturing Automation,2013,35(5):106-109．

[5] 王榮本,儲江偉,馮炎,等.一種視覺導航的實用型AGV設計[J].機械工程學報,2002,38(11)：135-138．

WANG Rong-ben,CHU Jiang-wei,FENG Yan,et al.Design for a new type of AGV based on machine vision[J].Journal of Mechanical Engineering,2002,38(11):135-138．

[6] 張文,張作雷,曾連蓀,等.基于超聲波雷達傳感器的AGV導航參數選擇[J].傳感器與微系統,2014,33(12)：34-37．

ZHANG Wen,ZHANG Zuo-lei,ZENG Lian-sun,et al.Selection of AGV navigation parameters based on ultrasonic wave radar sensor[J].Transducer and Microsystem Technologies,2014,33(12):34-37．

[7] 王皖君,張為松,杜亞玲,等.自動導引車導引技術研究現狀與發展趨勢[J].傳感器與微系統,2009,28(12)：5-7．

WANG Wan-jun,ZHANG Wei-song,DU Ya-ling,et al.Research state and development trend of guide technology for automated guided vehicle[J].Transducer and Microsystem Technologies,2009,28(12):5-7．

[8] 擺玉龍,楊利君,董存輝.基于MC9S128的電磁導航智能車的設計與實現[J].測控技術,2011,30(11)：59-64．

BAI Yu-long,YANG Li-jun,DONG Cun-hui.Electromagnetic navigation smart car control system based on MC9S128[J].Measurement & Control Technology,2011,30(11):59-64．

[9] 季冉鳴,王芳.一種基于磁釘和慣導系統的機器人導航控制算法[J].制造業自動化,2014,36(2):52-54．

JI Ran-ming,WANG Fang.A new method based on magnetic medium and inertial navigation system for the navigation control of AGV[J].Manufacturing Automation,2014,36(2):52-54．

[10] 王偉,白玉成,吳功平,等.一種基于信息融合的巡線機器人電磁導航方法[J].電力系統自動化,2013,37(16):73-79．

WANG Wei,BAI Yu-cheng,WU Gong-ping,et al.An electromagnetic navigation method based on information fusion for inspection robot[J].Automation of Electric Power Systems,2013,37(16):73-79．

[11] 張曉霞,汪傳龍,韓劉柱,等.AGV用GPS /DR組合導航信息融合[J].沈陽建筑大學學報(自然科學版),2011,27(1):173-177．

ZHANG Xiao-xia,WANG Chuan-long,HAN Liu-zhu,et al.On the GPS/DR integrated navigation system for AGV [J].Journal of Shenyang Jianzhu University (Natural Science),2011,27(1):173-177．

[12] SEELINGER M,YODER J.Automatic visual guidance of a forklift engaging a pallet[J].Robotics and Autonomous Systems,2006,54(12):1026-1038．

[13] LOW C B,WANG D.GPS-based tracking control for a car-like wheeled mobile robot with skidding and slipping[J].IEEE/ASME Transactions on Mechatronics,2008,13(4):480-484．

[14] 鄭炳坤,賴以宗,葉峰.磁導航AGV控制系統的設計與實現[J].自動化與儀表,2014,29(3)：6-10．

ZHENG Bing-kun,LAI Yi-zong,YE Feng.Design and implementation of the magnetic navigation AGV control system[J].Automation and Instrumentation,2014，29(3):6-10．

[15] 童峰,許天增,許鷺芬.一種用于自動導引車(AGV)的超聲波導航系統[J].高技術通訊,2002，15(8)：47-50．

TONG Feng,XU Tian-zeng,XU Lu-fen.An ultrasonic navigation system used for automatic guided vehicle[J].High Technology Letters,2002，15(8):47-50．

[16] 陳順平,梅德慶,陳子辰.激光導引AGV的自動引導系統設計[J].工程設計學報,2003,10(5)：279-282．

CHEN Shun-ping,MEI De-qing,CHEN Zi-chen.Design of intelligent navigation system for laser assisted automated guided vehicle[J].Chinese Journal of Engineering Design,2003,10(5):279-282．

[17] JUNG K,LEE I,SONG H,et al.Vision guidance system for AGV using ANFIS[C].5th International Conference on Intelligent Robotics and Applications.Montreal,Oct.3-5,2012．

[18] 黃玉美,史恩秀,史文浩,等.AGV的混合式導航功能設計[J].制造技術與機床,2004 (4)：45-47．

HANG Yu-mei,SHI En-xiu,SHI Wen-hao,et al.Hybrid navigation function design for AGV[J].Manufacturing Technology and Machine Tool,2004 (4):45-47．

Design and simulation of measuring wheel guidancemode for omnidirectional vehicle

ZHU Yan-jie1, YI Ya-li1, JING Chang-hai1, DAI Yong-bo2

(1. College of Mechanical Engineering, Yanshan University, Qinhuangdao 066004, China；2. Beijing Xinghang Mechanical-Electrical Equipment Co.,Ltd., Beijing 100074, China)

Aiming at solving the large measurement error of vehicle operating accuracy caused by the slip of driving Mecanum wheel in the detecting of the position and attitude of omnidirectional vehicle,measuring wheel guiding approach is proposed.Mathematical model is established,and the structure of AGV system is expounded.The layout structure of omnidirectional vehicle was made up of six wheels,including four driving wheels and two driven wheels in the design.The two driven wheels were used as measuring wheels,and the differential principle was applied to the two measuring wheels to get the path information of automatic guided omnidirectional vehicle,at the same time,the problem that the existing omnidirectional vehicle with single measuring wheel couldn’t detect accurately in-situ rotary posture was solved.The structure of measuring wheel with floating three freedoms was put forward.It could maintain contact with ground in real time and ensure the accuracy of position detection.ADAMS simulation for the pose detection of three typical movements which were straight line,curve and in situ rotation is performed.The results show that this guidance mode can meet the accurate detection of position and attitude of omnidirectional vehicle on flexible path setting and has a wide application range.

omnidirectional vehicle; measuring wheel guidance; Mecanum wheel; kinematics simulation

2015-11-27.

本刊網址·在線期刊：http://www.journals.zju.edu.cn/gcsjxb

國家國防科技工業局科工一司資助項目(2012764).

朱艷杰(1987—),女,河北唐山人,碩士,從事自主導引車本體設計與運動性能分析等研究,E-mail:zhuyanjie1987@163.com.http://orcid.org//0000-0002-5465-9658

通信聯系人：宜亞麗(1976—),女,山西永濟人,副教授,博士,從事新型機械傳動的理論與應用技術研究,E-mail:yiyali@ysu.edu.cn.http://orcid.org//0000-0001-8123-4172

10.3785/j.issn. 1006-754X.2016.04.006

TH 11

A

1006-754X(2016)04-0333-05