【正文】 能夠加速機器人技術(shù)的發(fā)展。同時機器人技術(shù)本身是對電子技術(shù)的一個集合運用，從學(xué)生時代從事機器人技術(shù)的學(xué)習(xí)研究的過程，不但對機器人技術(shù)加速發(fā)展，還帶動中國其它電子技術(shù)的發(fā)展 ，帶動科技強國，科技富國。 全向運動機器人是移動機器人中的一部分，其高靈活性和準(zhǔn)確性越來越突出其優(yōu)越性?，F(xiàn)在在全向運動機器人方面 使用較多的是 RoboCup 中型組足球機器人 （如圖 2） 。1997 年成立于日本 ，足球機器人作為人工智能的一個重要組成部分，已是當(dāng)前機器人研究領(lǐng)域最為活躍的領(lǐng)域之一 [1]。 RoboCup 以機器人足球作為中心研究課題，通過舉辦機器人足球比賽，旨在促進人工智能、機器人技術(shù)及其相關(guān)學(xué)科的發(fā)展。 RoboCup 的最終目標(biāo)是在 2050 年成立一支完全自主的擬人機器人足球隊，能夠與人類進行一場真正意義上的足球賽。 RoboCup 的最終目標(biāo)是：到 21 世紀(jì)中葉，一支完全自治的人形機器人基于 DSP 的全向運動控制系統(tǒng) 軟件設(shè)計 2 足球隊?wèi)?yīng)該能在遵循國際足聯(lián)正式規(guī)則的比賽中，戰(zhàn)勝最 近的人類世界杯冠軍隊。要想實現(xiàn)足球機器人靈活自如的“踢足球”，傳統(tǒng)的三輪和四輪結(jié)構(gòu)移動不夠靈活已經(jīng)被淘汰，現(xiàn)在使用的是三輪和四輪結(jié)構(gòu)配備全向輪的全向運動機器人?？梢圆蛔鋈魏螠?zhǔn)備的情況下朝球移動，并且可以邊移動邊調(diào)整踢球姿態(tài)已達到最近效果。 對然全向運動機器人有了很多，但是很多都在實驗室，還不能在實際的環(huán)境使用，全向運動 機器人還需要很長的時間發(fā)展。 圖 2 RoboCup 中型組機器人 本課題的 研究 意義及前景 隨著機器人技術(shù)的發(fā)展，機器人從工業(yè)走進生活中。國外很多國家已經(jīng)研制出很多全方位機器人，應(yīng)用領(lǐng)域 不斷擴大，如導(dǎo)游機器人、導(dǎo)購機器人、電動輪椅、平穩(wěn)的測量裝置、醫(yī)院巡視病房機器人和倉庫作業(yè)機器人等。這些機器人 很大程度上代替了人大勞動，提高了人的生活質(zhì)量。 如圖 3 是 三種 全向機器人。 全向運動機器人在社會服務(wù)、教育、娛樂、軍事和環(huán)境探測領(lǐng)域都將發(fā)揮著不可代替的作用。其未來的應(yīng)用前景將十分廣闊 [2]。 圖 3 三種 全向機器人 基于 DSP 的全向運動控制系統(tǒng) 軟件設(shè)計 3 論文組織結(jié)構(gòu) 本設(shè)計內(nèi)容安排分為 6 章，其各章節(jié)的內(nèi)如安排如下： 第 1 章 ：引言。 介紹此課題的現(xiàn)狀和未來發(fā)展前景。 第 2 章 ：全向運動控制系統(tǒng)分析。建立全向運動數(shù)學(xué)模型，對模型進行力的分解合成，計算各種運動狀態(tài)下各電機運動公式。分別分析了全向運動三種基本運動形式：平移運動、原地旋轉(zhuǎn)運動 、平移 +旋轉(zhuǎn)運動。 第 3 章 ： DSP 及相關(guān)控制系統(tǒng)。選擇 TMS320LF2407A 為核心控制芯片，選擇電機、驅(qū)動模塊、顯示模塊、無線通訊模塊、電源模塊等等，組建硬件系統(tǒng) 第 4 章 ： 系統(tǒng)運動控制部分的設(shè)計和 MATLAB 仿真 。 根據(jù)系統(tǒng)運動形式計算好各個電機矢量速度， 如何能讓電機穩(wěn)準(zhǔn)快的執(zhí)行設(shè)定的矢量速度是運送形式是否實現(xiàn)的關(guān)鍵。本設(shè)計采用傳統(tǒng)的 PID 增量式控制方式及 MALTAB 仿真來實現(xiàn)。 第 5 章：系統(tǒng)軟件設(shè)計。根據(jù)建立數(shù)學(xué)模型及外設(shè)資源設(shè)計系統(tǒng)結(jié)構(gòu)和系統(tǒng)流程圖，通過 編寫系統(tǒng)程序，利用上位機和無線傳輸模 塊對機器人運動形式進行控制，其中也包括建立簡單的無線通訊協(xié)議。 第 6 章 ： 試驗驗證及結(jié)果分析。通過前幾章設(shè)計出了全向機器人，本章主要是通過試驗驗證各種運動形式是否達到要求，并對結(jié)果進行分析。 2 全向運動控制系統(tǒng) 分析 全向運動控制系統(tǒng) 運動學(xué) 模型建立 在 引言 中介紹了全向 運動 控制的 幾種 結(jié)構(gòu)， 本設(shè)計 選用三輪結(jié)構(gòu)構(gòu)建 全向 運動系統(tǒng)[3][4]。 其結(jié)構(gòu)圖和實物付如圖 4 所示 。 (a) 結(jié)構(gòu)圖 (b) 實物圖 圖 4 全向結(jié)構(gòu)圖和實物圖 基于 DSP 的全向運動控制系統(tǒng) 軟件設(shè)計 4 其中三個驅(qū)動輪的旋轉(zhuǎn)軸互相成 120 176。 夾角，且驅(qū)動輪中心到整體系統(tǒng)中心的距離L1=L2=L3。 為實現(xiàn) 全向運動控制，首先對系統(tǒng)進行運動方式建模 [5]， ， 建立運動學(xué)模型。對全向機器人的運動學(xué)模型 （圖 5所示） 進行分析 并對控制算法進行研究 。 要 由圖 5 中(a)圖所示， 小車運行在二維平面內(nèi)， 世界 坐標(biāo)系 XY 和機器人坐標(biāo)系 aa yx? 。 ? 為 X與 ax 的夾角， ? 為 驅(qū)動輪 與 ay 的 夾角， 驅(qū)動輪之間的夾角 為 120o 角。 iL (i=1,2,3)為機器人中心到 驅(qū)動輪 中心的距離 ,由于 本設(shè)計 使用的 瑞典 輪在旋轉(zhuǎn)的時候?qū)Φ孛娴慕佑|位置 一直在 變化， 會造成驅(qū)動輪與機器人中心的距離也一直在變化， 但變化值比較小 。 為方便 建立運動學(xué)模型及 計算取 L=L1=L2=L3。 iV (i=1,2,3)為 驅(qū)動輪 i 提供沿驅(qū)動方向的速度 ， 規(guī)定 方向 逆時針為正 。 由圖 5中 (b)所示， V為機器人系統(tǒng)整體速度，世界坐標(biāo) XY 坐標(biāo)系中 X軸與整體速度 V的逆時針夾角為β，在世界坐標(biāo)系中將整體速度 V 分解成沿 X軸和 Y 軸的速度分別為 XV 和 yV 。 (a) 運動學(xué)建模 (b) 系統(tǒng)整體速度矢量分解 圖 5 運動學(xué)模型 根據(jù) 運動學(xué) 模型 分析出 各個驅(qū)動輪的速度 為下式 (1)： 1 si n( ) c os( )2 c os si n3 si n( ) c os( )XyXyXyV V V LV V V LV V V L? ? ?? ? ?? ? ????? ? ? ? ? ? ? ? ????? ? ???? ? ? ? ? ? ? ? ??? (1) 式 (1)中：由機械結(jié)構(gòu)可知 ? =30 o， ? 取 逆時針為正， ?? 為角速度且逆時針為正。 將這些已知的值代入式 (1)中得到式 (2)。 基于 DSP 的全向運動控制系統(tǒng) 軟件設(shè)計 5 1 s i n ( ) c o s ( )662 c o s s i n3 s i n ( ) c o s ( )66XyXyXyV V V LV V V LV V V L??? ? ?? ? ???? ? ????? ? ? ? ? ? ???? ? ? ???? ? ? ? ? ? ??? (2) 由式 (2)寫出矩陣形式 ，即式 (3)。 si n( ) c os( )1 662 c os si n3 si n( ) c os( )66xyL VVV L VV L?????????? ???? ??? ? ? ????? ???? ????? ???????? ? ? ? ???? (3) 所以在任意時刻，小車的運動形態(tài)就是 TxyV V V ????? ????。 在實際中，路 徑規(guī)劃、位姿控制，通過矢量分解、坐標(biāo)變化，即可轉(zhuǎn)換為對機器人每個軸驅(qū)動電機的運動控制。 為使模型成立， 機器人應(yīng) 該符合以下幾點 要求 ： (1) 驅(qū)動輪與地面有足夠的摩擦力，不存在打滑現(xiàn)象。 (2) 小車的構(gòu)造及安裝位置應(yīng)盡量精確。 (3) 各個驅(qū)動輪速度應(yīng)在電機提供的最高速之內(nèi) [Vmax Vmax]。 (4) 忽略驅(qū)動輪轉(zhuǎn)動過程中 L 的變化，取 L=L1=L2=L3。 (5) 車的重量均勻分布三個驅(qū)動輪 上。 不同運動方式 的運動特性 全向運動 的運動 形式大體 可分為 平移 運動 、原地旋轉(zhuǎn) 運動 、 邊平移邊旋轉(zhuǎn) 運動 三種運動形式 。 三種運動形式有著不同的運動特性，以下將分三小節(jié)對三種運動形式進行單獨分析。 平 移 運動 平移 是基本的也是比較常用的運動形式。 由于是 平移 不考慮旋轉(zhuǎn)運動，我們將模型進行簡化 ，其簡化后運動學(xué)模型圖如圖 6 所示 。 基于 DSP 的全向運動控制系統(tǒng) 軟件設(shè)計 6 (a) 平移模型 (b) 系統(tǒng)整體平移模型 圖 6 簡化后 運動 運動學(xué) 模型 單獨考慮平移運動故將 式 (3)進行簡化 為式 (4)： 131 222 1 03 01322xyL VVV L VVL?????? ???????? ? ???????? ???? ??????? (4) 假設(shè)小車整體平移矢量速度為 V，與 X 軸成 γ 角。所以我們可以分解為 xV 和 yV ，其分解公式為式 (5)。 cos( )sin( )xyVVVV ?????? ??? (5) 由式 (4)和式 (5)我們可以得到三個驅(qū)動輪的速度 ，見式 (6)。 11223313 sin( )c os( ) sin( )622c os( ) c os( )13 sin( )c os( ) sin( )622VVV V VV V V VVVV V V? ???? ???? ?? ? ?? ? ?? ?? ??? ? ?????? ? ?? ? ???? (6) 驅(qū)動輪速度 1V 、 2V 、 3V 的速度范圍都是 ? ?max maxVV? 。 maxV 的值則由電機性能決定。通過式 (6)我們可以反向推導(dǎo)出平移速度 V的速度范圍。 如圖 7， 其中圓是以驅(qū)動輪最大速度 maxV 大小為半徑的圓，紅色速度 V與 X 軸的角度為 γ ，隨著 γ 由 基于 DSP 的全向運動控制系統(tǒng) 軟件設(shè)計 7 0176。 ~360176。 變化 V的軌跡為紅色 正 六邊形。其中最大速度為max233 V。 圖 7 平移最大速度 模型 原地旋轉(zhuǎn)運動 全向 機器人不但要平移，而且很多時候都需要轉(zhuǎn)向，轉(zhuǎn)向 運動 分為原地旋轉(zhuǎn) 運動 和邊平移邊旋轉(zhuǎn) 運動 。原地旋轉(zhuǎn)是旋轉(zhuǎn)的最基本運動 形式 ，邊 平移 邊 旋轉(zhuǎn) 運動將在下節(jié) 中闡述 ，本節(jié)主要分析原地旋轉(zhuǎn)運動形式。 原地旋轉(zhuǎn)運動時 V=0，即 xV 和 yV 都為 0，所以由式 (2)可 的下式 (7)。 123VLVLVL??????? ??? ???? ?? (7) 其中 ?? 為角速度，逆時針為正。 所以可以得知三個驅(qū)動 電機的矢量速度是相同的。為了表述直觀，建立原地旋轉(zhuǎn)運動模型，其模型圖如圖 8 所示。 圖 8 原地 旋轉(zhuǎn) 運動模型 基于 DSP 的全向運動控制系統(tǒng) 軟件設(shè)計 8 邊平移邊旋轉(zhuǎn)運動 邊 平移 邊旋轉(zhuǎn)運動方式是全向運動中較為復(fù)雜的運動方式，即不做任何準(zhǔn)備動作的前提下往任何方向運動 并且可以 邊運動邊調(diào)整自身姿態(tài)。 這種運動形式是 平移 與旋轉(zhuǎn)的合成。在前文 中已經(jīng)推導(dǎo)出公式 (1)。此處不再過多敘述。 3 基于 DSP 的硬件 系統(tǒng) 簡介 控制芯片選擇 作為 運動控制系統(tǒng) 的核心控制芯片，根據(jù)以往在實驗室的經(jīng)驗 ，其核心控制芯片當(dāng)屬DSP C2020 系 類。 C2020 系類對于運動控制有著諸多的優(yōu)點，本設(shè)計采用 C2020 系類TMS320LF2407A 的控制板。 TMS320LF2407A 主要 特點 如下 ： ? 高性能、高速度：集成了高性能的 DSP 內(nèi)核和微處理器的片內(nèi)外設(shè)；每秒 4000萬條指令 (40MIPS)的處理速度 。 ? 高可靠性、可編程性： TMS320LF2407A 的 16 位定點 DSP 內(nèi)核為模擬系統(tǒng)的設(shè)計者提供了一個不犧牲系統(tǒng)精度和性能的數(shù)字解決方案。 ? 兩個事件管理器模塊 EVA 和 EVB， 可以 提供完整的、高效的電機控制方案，提供所有的 PWM(8 個 16 位脈沖調(diào)制通道 )和 IO，可以控制所有類型的電機。 ? 采用高性能靜態(tài) CMOS 技術(shù)，使得供電電壓降為 ，減少了控制器的損耗。 ? 片內(nèi)有高達 32K16位的 Flash程序存儲器 ： 高達 16位的數(shù)據(jù) /程序 RAM；544 字節(jié) 的 雙端口 RAM(DARAM)； 2K 字的單口 RAM(SARAM)。 ? 可擴展的外部存儲器總共具有 192K16 位的空間，分別為 64K 字 的 程序存儲器空間、 64K 字的數(shù)據(jù)存儲空間和 64K 字的 I/O 空間。 ? 10 位 ADC 轉(zhuǎn)換器，其特性為 ： 最小轉(zhuǎn)換時間為 500ns、 8 個或 16 個多路復(fù)用的輸入通道，采集時間和轉(zhuǎn)換時間分開 ，提高了采樣率和輸入阻抗，并且支持自動順序采樣，不需 CPU干預(yù)。 ? CAN 總線控制器，可以為控制器、傳感器、激勵源以及其它節(jié)點提供良好的通訊，特別適用于工業(yè)現(xiàn)場和汽車等強噪聲和惡劣的環(huán)境中。 ? 5 個外