張豫南， 楊懷彬， 黃濤,2， 張舒陽， 房遠

(1.陸軍裝甲兵學院 兵器與控制系， 北京 100072； 2.63983部隊， 江蘇 無錫 214035)

向心型履帶式全方位移動平臺運動分析

張豫南1， 楊懷彬1， 黃濤1,2， 張舒陽1， 房遠1

(1.陸軍裝甲兵學院 兵器與控制系， 北京 100072； 2.63983部隊， 江蘇 無錫 214035)

兵器科學與技術(shù)； 全方位移動平臺； 履帶； 向心型

0 引言

全方位移動平臺在平面上具備縱向、橫向和中心轉(zhuǎn)向3個運動自由度，其運動具有較高的靈活性，且運動過程中能夠保持平臺本身位姿不變，廣泛應用于倉儲運輸[1-2]、運動競賽[3-4]、智能服務[5]、精確安裝[6-7]等領(lǐng)域。目前，全方位平臺使用的行走機構(gòu)大部分為輪式，其中麥克納姆輪應用最為廣泛，但其在負重載荷、運動“敲地”、路面適應性等方面存在諸多不足。文獻[8-10]通過改變輥輪數(shù)量、加裝減震機構(gòu)等方法對其進行改進，取得了一定的改善效果，但結(jié)構(gòu)較為復雜。平臺布局形式主要分為縱向?qū)ΨQ型和向心型兩種[11-12]。前者為高速行駛和越障提供了可能，后者的運動均衡性更好。

傳統(tǒng)履帶車輛在負重和越野等方面具備較強的優(yōu)勢。將麥克納姆輪按序列進行展開，結(jié)合傳統(tǒng)履帶的機械結(jié)構(gòu)，可設(shè)計出一種具有多運動自由度的行走機構(gòu)，即全方位移動履帶[13]。文獻[14]中研究了全方位移動履帶采用縱向?qū)ΨQ布局形式構(gòu)建全方位平臺的基本結(jié)構(gòu)及其運動規(guī)律。本文主要針對向心型布局的全方位平臺進行研究，建立三履帶、四履帶全方位平臺運動學和動力學模型，分析平臺運動規(guī)律，并通過虛擬樣機進行仿真驗證。

1 全方位移動履帶結(jié)構(gòu)及運動分析

1.1 全方位移動履帶結(jié)構(gòu)

1.2 全方位移動平臺運動分析

在分析平臺運動之前，做以下假設(shè)：

1)平臺與地面均為剛體，各種運動在平面上進行；

2)不考慮滑轉(zhuǎn)、滑移對平臺運動的影響；

3)平臺重心與幾何中心完全重合，不存在重心偏移現(xiàn)象。

選取平臺第i(1≤i≤N)條全方位履帶作為分析對象，如圖3所示。圖3中，矩形框代表履帶接地部分，短斜線代表輥輪接地部分。假定平臺參數(shù)如下：Oxy為以平臺幾何中心為原點的直角坐標系，Oixiyi為以履帶接地段幾何中心為原點的直角坐標系，θi為Oixi與Ox所成夾角，li為Oi點到O點的距離，αi為輥輪偏置角，βi為OOi與x軸所成夾角，vy、vx、ωz為平臺在Oxy坐標系下的運動速度。通過分析得到平臺的逆運動學方程[14]，如(1)式所示。

(1)

式中：矩陣J為平臺逆運動學方程雅克比矩陣，表示履帶與平臺之間的運動關(guān)系；r為驅(qū)動輪半徑；ωi為履帶驅(qū)動輪角速度。對于任一平臺，若要實現(xiàn)全方位移動性能，必須確保平臺逆運動學方程雅克比矩陣J的秩滿足Rank(J)≥3[15]. 因此，平臺至少要具備3條以上履帶，才能實現(xiàn)全方位移動性能。鑒于加工安裝、體積、質(zhì)量、系統(tǒng)控制等因素，三履帶和四履帶構(gòu)成的全方位平臺實用價值和適用范圍更大。因此，本文重點研究這兩類平臺。當履帶數(shù)量超過4條時，平臺在成本、冗余度等方面表現(xiàn)較差，尤其在多電機協(xié)調(diào)控制上存在難度，實用價值不大。若需要增加平臺載重能力，可通過對全方位履帶進行適當?shù)募娱L加寬或增加輥輪數(shù)量來滿足要求[14]。

2 三履帶全方位移動平臺分析

2.1 平臺結(jié)構(gòu)與運動學分析

由圖4可知，圖中1、2、3分別表示3條履帶標號，且定義了每條履帶的運動正方向。布局1中履帶與平臺中線垂直，輥輪偏置角可變化；布局2中履帶縱向中心線與平臺中線重合，輥輪偏置角可變化；布局3中輥輪偏置角與平臺中線平行，履帶角度可變化。通過對3種平臺布局形式的幾何關(guān)系進行分析，得到如表1所示的平臺結(jié)構(gòu)參數(shù)。將各結(jié)構(gòu)參數(shù)代入(1)式，可得到平臺逆運動學方程的具體形式及其雅克比矩陣秩的值。由前文分析可知，布局1、布局2可以實現(xiàn)全方位移動，但布局3不能。雖然布局2可以實現(xiàn)全方位移動，但該布局形式不利于履帶安裝，而且在平臺驅(qū)動效率、運動穩(wěn)定性等方面不如布局1. 因此，這里重點分析如圖4(a)所示的三履帶全方位移動平臺的運動特性。

根據(jù)表1中布局1的結(jié)構(gòu)參數(shù)，可得其逆運動學方程：

(2)

2.2 平臺各向最大平移速度分析

當平臺的履帶數(shù)量和布局確定后，輥輪偏置角成為影響平臺運動的關(guān)鍵因素。不同偏置角情況下，平臺各向運動的速度差異較大。

假定平臺在Oxy平面內(nèi)只進行平移運動，不伴隨轉(zhuǎn)向運動，其速度為v，運動方向與x軸間的角度為ψ(0≤ψ≤2π rad)，則

(3)

式中：vy、vx分別表示平臺在y軸、x軸上的速度分量。

由(2)式可得

(4)

假定驅(qū)動輪的最大線速度為1 m/s，即rωi≤1 m/s(i=1,2,3)，不考慮轉(zhuǎn)向運動情況下可將(4)式記為rωi=aiyvy+aixvx，aiy、aix為平臺平動時各向速度相對于第i條履帶的運動分量系數(shù)。其中：

則

rωi=aiyvsinψ+aixvcosψ，

(5)

即

(6)

綜上可得

(7)

式中：A=|aiysinψ+aixcosψ|max.

由(7)式可得

(8)

(9)

2.3 平臺各向最大平移加速度分析

輥輪偏置角的選取還會影響到平臺的驅(qū)動能力，因此還需要考慮平臺的動力學特性。全方位履帶因其在履帶板上安裝有輥輪結(jié)構(gòu)，其動力學特性與傳統(tǒng)履帶有較大差別。輥輪可自由旋轉(zhuǎn)，其牽引力方向主要沿輥輪軸線方向。假定驅(qū)動輪提供的驅(qū)動力為Fi、履帶牽引力為fi，則fi=Fisinα(i=1,2,3)[14]。對圖4(a)所示的平臺進行受力分析，結(jié)果如圖6所示。

(10)

(11)

由圖7可知，平臺各向最大平移加速度與最大平移速度分布特征相似，呈正六邊形規(guī)律分布，平臺最大加速度隨著輥輪偏置角的增大逐漸增大。

3 四履帶全方位移動平臺分析

3.1 平臺結(jié)構(gòu)與運動學分析

四履帶平臺布局形式如圖8(a)～圖8(d)所示，定義每條履帶的運動正方向。布局1中履帶與平臺各邊平行，輥輪偏置角可變化；布局2中輥輪偏置角與平臺各邊平行，履帶角度可變化；布局3中履帶縱向中心線與平臺對角線重合，輥輪偏置角可變化；布局4中輥輪偏置角與平臺對角線平行，履帶角度可變化。通過對4種平臺布局形式的幾何關(guān)系進行分析，得到如表2所示的平臺結(jié)構(gòu)參數(shù)。將各個結(jié)構(gòu)參數(shù)代入(1)式，可得到平臺逆運動學方程的具體形式及其雅克比矩陣秩的值。由上文分析可知，布局1～布局3均可實現(xiàn)全方位移動，但布局4不能。其中，布局2和布局3均不利于履帶安裝，而且在驅(qū)動效率、運動穩(wěn)定性等方面不如布局1. 因此，本文重點分析圖8(a)所示的四履帶全方位移動平臺運動特性，根據(jù)表2中布局1的結(jié)構(gòu)參數(shù)，可得其逆運動學方程：

(12)

3.2 平臺各向最大平移速度分析

按照三履帶全方位平臺最大平移速度分析方法，可得四履帶全方位平臺各向最大平移速度為

(13)

式中：A=|aiysinψ+aixcosψ|max,i=1,2,3,4.

由(12)式可知，

3.3 平臺各向最大平移加速度分析

按照三履帶全方位平臺的分析方法，可得四履帶全方位平臺動力學方程：

(14)

由圖10可見，平臺各向最大平移加速度與最大平移速度分布特征相似，呈正四邊形規(guī)律分布，平臺最大加速度隨著輥輪偏置角的增大而逐漸增大。

4 平臺對比分析及仿真驗證

4.1 平臺對比分析

由圖11和圖12可知：

從速度數(shù)值來看，在輥輪偏置角相同的情況下，三履帶平臺與四履帶平臺的最小速度值相同；但四履帶平臺的最大速度值略大，約為三履帶平臺的1.22倍，可見四履帶平臺的速度性能更優(yōu)。從速度分布來看，在輥輪偏置角相同的情況下，三履帶平臺速度域為正六邊形，四履帶平臺速度域為正四邊形，因此三履帶平臺的各向速度均衡性更好。

從加速度數(shù)值來看，在輥輪偏置角相同的情況下，四履帶平臺的加速度明顯大于三履帶平臺，其最大值約為三履帶的1.63倍；相同平移方向時四履帶平臺的加速度明顯大于三履帶平臺，可見四履帶平臺的驅(qū)動加速性能更優(yōu)。從加速度分布來看，在輥輪偏置角相同的情況下，三履帶平臺加速度域為正六邊形，四履帶平臺的加速度域為正四邊形，因此三履帶平臺的各向加速度均衡性更好。

總體來看，在履帶結(jié)構(gòu)相同的條件下，四履帶平臺相對于三履帶平臺在速度和加速度方面都有較大的提升，但三履帶平臺的運動均衡性較好。增加一套驅(qū)動系統(tǒng)和履帶系統(tǒng)后四履帶平臺載重能力更強，但平臺的體積、質(zhì)量、成本有所增加。三履帶平臺則結(jié)構(gòu)緊湊、質(zhì)量輕便、經(jīng)濟實用。在控制方面，由于三履帶平臺對稱性不如四履帶平臺，當平臺運動速度和方向確定后各電機所分配速度的差異性較大。在實際工程應用中，電機加速性能和每條履帶的機械特性等不能完全相同，可能會造成平臺運動偏移，而且往往發(fā)生在運動起始階段或運動發(fā)生改變階段。因此，三履帶平臺的控制更加困難，必要時還需要進行適當?shù)难a償控制。在控制穩(wěn)定性方面，四履帶平臺優(yōu)于三履帶平臺。

4.2 仿真驗證

將平臺結(jié)構(gòu)參數(shù)分別代入(2)式和(12)式，可得到三履帶、四履帶全方位平臺的逆運動學方程：

(15)

(16)

針對平臺的全方位移動性能，分別對縱向、橫向和中心轉(zhuǎn)向3種運動狀態(tài)進行仿真。對應地，將平臺目標速度設(shè)置為(1 m/s 0 m/s 0 m/s)T、(0 m/s1 m/s 0 m/s)T、(0 m/s 0 m/s 1 m/s)T，分別代入(15)式和(16)式，可以得到驅(qū)動輪期望轉(zhuǎn)速。將仿真時間設(shè)置為4.0 s，其中：0～0.5 s為平臺靜穩(wěn)定時間，0.5～1.5 s為平臺加速時間，1.5～4.0 s為平臺穩(wěn)態(tài)運動時間，樣機運動軌跡及速度曲線如圖14所示。

對圖14中平臺在1.5 s達到穩(wěn)態(tài)運動后進行平均速度數(shù)據(jù)統(tǒng)計，結(jié)果如表3所示。由表3并結(jié)合圖14中的運動軌跡和速度曲線可以看出，兩種平臺都可以實現(xiàn)全方位移動性能，穩(wěn)態(tài)后平均速度都接近期望速度1 m/s，但平臺運動軌跡存在一定的偏移。圖15中履帶1達到最大線速度1 m/s，三履帶平臺的履帶3和四履帶平臺的履帶2速度約為0 m/s，兩種平臺的45°斜向運動速度與前文分析基本相符。

通過上述對兩種平臺全方位移動性能和各向相異性的仿真分析，驗證了該平臺運動分析的正確性。但在45°斜向運動中發(fā)現(xiàn)，兩種平臺都至少有1條履帶處于純滑動狀態(tài)，未參與平臺的驅(qū)動行為，如三履帶平臺中的履帶3和四履帶平臺中的履帶2、履帶4. 可見，該狀態(tài)下平臺的驅(qū)動效率有所降低。但此類情況因全方位平臺行走機構(gòu)的特殊性又必然存在，因此在實際應用過程中應盡量避免平臺運行在這些特殊的方向上，以提高平臺的運行效率。通過觀察可以發(fā)現(xiàn)，仿真中平臺的運動軌跡和速度曲線會發(fā)生一定的偏斜和波動，分析原因如下：1)仿真中的接觸參數(shù)設(shè)置不夠精確；2)運動分析中未將履帶長度和寬度考慮在內(nèi)，對實際運動有一定的影響；3)履帶運動過程中伴隨有一定的滑轉(zhuǎn)、滑移現(xiàn)象。

5 結(jié)論

2) 在履帶結(jié)構(gòu)相同的條件下，四履帶平臺相對于三履帶平臺在速度和加速度方面都有較大提升，但三履帶平臺的運動均衡性較好。四履帶平臺載重能力更強，三履帶平臺結(jié)構(gòu)緊湊、質(zhì)量輕便和經(jīng)濟實用。此外，在控制穩(wěn)定性方面，四履帶平臺優(yōu)于三履帶平臺。

3) 在某些特殊運動方向上，兩種平臺都存在至少有1條全方位履帶處于純滑動狀態(tài)的情況。該狀態(tài)下平臺的驅(qū)動效率降低，但由于全方位履帶結(jié)構(gòu)的特殊性又必然存在，在實際應用過程中應盡量避免平臺運行在這些特殊的方向上，以提高平臺的運行效率。

)

[1] 張金玲, 陳浩, 張玄, 等. 一種智能物流車設(shè)計[J]. 機械工程師, 2016(7): 60-61.

ZHANG Jin-ling, CHEN Hao, ZHANG Xuan, et al. Design of an intelligent logistics car[J]. Mechanical Engineer, 2016(7): 60-61. (in Chinese)

[2] Peng T R, Qian J, Zi B, et al. Mechanical design and control system of an omni-directional mobile robot for material conveying[C]∥Proceedings of the 9th International Conference on Digital Enterprise Technology. Nanjing: Nanjing Uniersity of Aeronautics and Astronautics, 2016: 412-415.

[3] Ismael O Y, Hedley J. Development of an omnidirectional mobile robot using embedded color vision system for ball follow[J]. American Scientific Research Journal for Engineering, Technology, and Science, 2016, 22(1): 231-242.

[4] 梁延德, 于華龍, 何福本. 全方位小型足球機器人運動特性分析[J]. 組合機床與自動化加工技術(shù), 2008(4): 5-8.

LIANG Yan-de, YU Hua-long, HE Fu-ben. Analysis on the kinematic performance of omnidirectional small size soccer robot[J]. Chinese Journal of Scientific and Technical Periodicals, 2008(4): 5-8. (in Chinese)

[5] Jiang S Y, Lin C Y, Huang K T, et al. Shared control design of a walking-assistant robot[J]. IEEE Transactions on Control Systems Technology, 2017, 99: 1-8.

[6] 呂永健, 叢新勇, 楊銘. 步進電機驅(qū)動的Mecanum輪全向裝備運輸車的設(shè)計[J]. 微特電機, 2013, 41(12): 14-16.

LYU Yong-jian, CONG Xin-yong, YANG Ming. Design of Mecanum wheeled omnidirectional equipped vehicle driven by stepper motor[J]. Small & Special Electrical Machines, 2013, 41(12): 14-16. (in Chinese)

[7] 葉長龍, 佟澤卉, 于蘇洋，等. 全方位移動裝配機器人運動學分析[J]. 機器人, 2016, 38(5): 550-556.

YE Chang-long, TONG Ze-hui, YU Su-yang, et al. Kinematic analysis of an omnidirectional mobile assembly robot[J]. Robot, 2016, 38(5): 550-556. (in Chinese)

[8] 劉勇. 狹小空間內(nèi)的全向移動平臺關(guān)鍵技術(shù)研究[D]. 鎮(zhèn)江: 江蘇科技大學, 2016.

LIU Yong. Research on omnidirectional mobile platform in narrow workspace[D]. Zhenjiang: Jiangsu University of Science and Technology, 2016.(in Chinese)

[9] 楊天旭. 全方位移動AGV智能控制技術(shù)研究[D]. 南京: 南京航空航天大學, 2016.

YANG Tian-xu. Intelligent control technology for the omnidirectional mobile AGV[D]. Nanjing: Nanjing University of Aeronautics and Astronautics, 2016. (in Chinese)

[10] 臧紅彬, 許雄, 周穎玥,等. 具有全方位移動和越障功能的新型機器人的設(shè)計[J]. 機械傳動, 2016, 40(6): 63-69.

ZANG Hong-bin, XU Xiong, ZHOU Ying-yue, et al. Design of a novel robot with omni-directional mobile and obstacle-crossing function [J]. Journal of Mechanical Transmission, 2016, 40(6): 63-69. (in Chinese)

[11] 田鵬. 8×8全方位移動平臺運動性能仿真及控制研究[D]. 北京: 裝甲兵工程學院, 2013.

TIAN Peng. Research on motion performance simulation and control of the 8×8 omnidirectional platform[D]. Beijing: Academy of Armored Force Engineering, 2013. (in Chinese)

[12] Masmoudi M S, Krichen N, Masmoudi M, et al. Fuzzy logic controllers design for omnidirectional mobile robot navigation[J]. Applied Soft Computing, 2016, 49: 901-919.

[13] 張豫南.一種全方位移動履帶及其平臺:中國, CN203078622U[P]. 2013-07-24.

ZHANG Yu-nan. An omnidirectional mobile track and platform: China, CN203078622U[P]. 2013-07-24. (in Chinese)

[14] Zhang Y N, Huang T. Research on a tracked omnidirectional and cross-country vehicle[J]. Mechanism and Machine Theory, 2015,87: 18-44.

[15] 王一治, 常德功. Mecanum四輪全方位系統(tǒng)的運動性能分析及結(jié)構(gòu)形式優(yōu)選[J]. 機械工程學報, 2009, 45 (5)：307-310.

WANG Yi-zhi, CHANG De-gong. Motion performance analysis and layout selection for motion system with four Mecanum wheels[J]. Journal of Mechanical Engineering, 2009, 45(5)：307-310. (in Chinese)

AnalysisaboutMotionofCentripetalTrackedOmnidirectionalMobilePlatforms

ZHANG Yu-nan1， YANG Huai-bin1， HUANG Tao1,2， ZHANG Shu-yang1， FANG Yuan1

(1.Department of Arms and Control Engineering，Academy of Army Armored Force，Beijing 100072，China; 2.Unit 63983 of PLA， Wuxi 214035， Jiangsu，China)

ordnance science and technology; omnidirectional mobile platform; track; centripetal

U270.1+1; TJ801.1

A

1000-1093(2017)12-2309-12

10.3969/j.issn.1000-1093.2017.12.003

2017-03-21

國家國防科技工業(yè)局技術(shù)基礎(chǔ)研究項目(2015ZB15)

張豫南(1961—)， 男， 教授， 博士生導師。 E-mail： zhang_yunan@sina.com