【導(dǎo)讀】基于DSP的全向運(yùn)動控制系統(tǒng)軟件設(shè)計。指導(dǎo)教師（職稱）：。[摘要]本文基于DSPC2021系列TMS320LF2407A核心控制芯片，以CCStudio. 軟件為開發(fā)平臺，在了解RoboCup中型組足球機(jī)器人和其他全向機(jī)器人的基礎(chǔ)上，主。全向運(yùn)動學(xué)數(shù)學(xué)模型，并對整體平移運(yùn)動、原地旋轉(zhuǎn)運(yùn)動、邊平移邊旋轉(zhuǎn)三種運(yùn)動方式。進(jìn)行分析和數(shù)學(xué)建模；利用上位機(jī)，經(jīng)無線模塊發(fā)送運(yùn)動方式和各種運(yùn)行參數(shù)，控制運(yùn)。動系統(tǒng)實現(xiàn)各種運(yùn)動模式；經(jīng)全向運(yùn)動控制系統(tǒng)軟件的編寫和與相關(guān)硬件聯(lián)機(jī)調(diào)試，系。統(tǒng)實現(xiàn)了預(yù)訂的全向運(yùn)動形式。通過試驗驗證和結(jié)果分析，各種運(yùn)動狀態(tài)的準(zhǔn)確性已達(dá)。到性能的基本要求。[關(guān)鍵詞]DSP；全向運(yùn)動控制；數(shù)學(xué)建模；MATLAB仿真；串行通信;軟件設(shè)計

　　

【正文】 平移運(yùn)動時時全向運(yùn)動的最主要部分， 其是否準(zhǔn)確穩(wěn)定關(guān)乎全向運(yùn)動系統(tǒng)整體的成敗。在驗證平移性能的時，采用在系統(tǒng)上安裝自制鉛筆 留痕 裝置 （如圖 28） ，能夠跟隨系統(tǒng)運(yùn)動時留下系統(tǒng)運(yùn)動的軌跡，依此來采集系統(tǒng)平移是的各項性能。 圖 28 留痕裝置 基于 DSP 的全向運(yùn)動控制系統(tǒng)軟件設(shè)計 25 下圖 29 為 系統(tǒng)沿 x 軸負(fù)方向平移的曲線圖，起始位置為（ 110 20），結(jié)束位置為（ 10 ），即走過 1m的距離誤差△ e=，最大 。 圖 29 系統(tǒng)平移曲線 原地旋轉(zhuǎn) 測試 系統(tǒng)安裝有數(shù)字指南針，能夠根據(jù)地球磁 場感知方位。其快速性和精確性為系統(tǒng)準(zhǔn)確的方位提供可能。驗證指南針轉(zhuǎn)角是否正確比較簡單，直接觀看 TFT 液晶顯示的指南針角度就可以知道準(zhǔn)確性。同時可以參考試驗場地標(biāo)出互成 45176。的虛線 看是否轉(zhuǎn)到位，下圖 30 為試驗場地轉(zhuǎn)角 有 0176。到 45176。時的情況。 圖 30 0176。到 45176。轉(zhuǎn)角示意圖 基于 DSP 的全向運(yùn)動控制系統(tǒng)軟件設(shè)計 26 通過指南針顯示能夠很清晰的看到，最終轉(zhuǎn)到的角度已經(jīng)達(dá)到了設(shè)定角度，誤差在? 1176。，而且此誤差是為了避免 轉(zhuǎn)到角度出現(xiàn)來回校準(zhǔn)而設(shè)置的死區(qū)，故原地旋轉(zhuǎn)運(yùn)動能夠準(zhǔn)確的執(zhí)行。 平移 +旋轉(zhuǎn)運(yùn)動 測試 全向運(yùn)動特與其他運(yùn)動形式最大的區(qū)別在于它 能 二維平面內(nèi)不但能夠不做任何準(zhǔn)備的情況下 往任意方向平移，但最高級運(yùn)動形式為在全向平移的基礎(chǔ)上能夠調(diào)整自身姿態(tài)也就是平移過程中自身能夠旋轉(zhuǎn)。 下圖 31 為系統(tǒng)由（ 20 20）到（ 80 80）邊移動邊旋轉(zhuǎn)，黑色三角箭頭為系統(tǒng)方向。 圖 31 系統(tǒng)平移 +旋轉(zhuǎn)曲線 經(jīng)顯示測試，其最終坐標(biāo)在（ 82 78），誤差約等于在 3cm。 影響因素 分析 影響系統(tǒng)性能的因素大部分來源于外部，大致分為以下幾種 情況： （ 1） 電池電量不足，導(dǎo)致系統(tǒng)電機(jī)啟動或大的變化時電流不足。導(dǎo)致系統(tǒng)不能很好的按照設(shè)定的形式運(yùn)動。 (2） 外部磁場干擾，數(shù)字指南針能夠很靈敏的感應(yīng)磁場，所以外部稍強(qiáng)點的磁場就能干擾系統(tǒng)， 一方面是 金屬鐵，其很容易磁化，導(dǎo)致變成弱磁鐵。 在室內(nèi)鋼筋結(jié)構(gòu)的環(huán)境下各個位置受到的磁干擾不同，經(jīng)測試最大可影響角度達(dá) 30176。角，嚴(yán)重影響了系統(tǒng)性能。 另一方面是電機(jī)，由于電機(jī)帶有磁性較強(qiáng)磁鐵，產(chǎn)生磁場的磁場也對指南針有一定干擾。 去除干擾的方法只能經(jīng)過硬磁補(bǔ)償來減少很少部分干擾，大多數(shù)干擾無法去除。 基于 DSP 的全向運(yùn)動控制系統(tǒng)軟件設(shè)計 27 (3） 驅(qū)動輪干 擾，本設(shè)計使用的是瑞典全向輪，輪子外側(cè)有兩排相互交錯的側(cè)輪，使得驅(qū)動輪滾動過程中，造成上下震動。同時由于驅(qū)動輪滾動會造成電機(jī)力矩發(fā)生變化，L=12 或 ，及內(nèi)外兩個側(cè)滑輪著地時會造成力矩 的變化，會使得系統(tǒng)轉(zhuǎn)動發(fā)生誤差。 基于 DSP 的全向運(yùn)動控制系統(tǒng)軟件設(shè)計 28 結(jié)束語 全向 運(yùn)動控系統(tǒng)在全向機(jī)器人上的應(yīng)用 可實現(xiàn)機(jī)器人向任意方向做直線運(yùn)動而不需要事先作旋轉(zhuǎn)運(yùn)動，并且在以直線運(yùn)動到達(dá)目標(biāo)點的過程中同時可以做自身旋轉(zhuǎn)運(yùn)動，以調(diào)整機(jī)器人的姿態(tài)，從而達(dá)到終態(tài)所需的姿態(tài)角。 其特殊的移動方式使得全向機(jī)器人 越來越得到重視和應(yīng)用，其未來的實用領(lǐng)域和前景將更加寬廣。本設(shè)計完成的主要工作為以下幾點： (1) 對目前的幾種運(yùn)動結(jié)構(gòu)進(jìn)行了研究分析， 設(shè)計了互成 120 度的三軸運(yùn)動結(jié)構(gòu)。 (2) 對三軸運(yùn)動控制結(jié)構(gòu)進(jìn)行了數(shù)學(xué)建模，進(jìn)行了運(yùn)動學(xué)分析。對全向運(yùn)動的運(yùn)動的幾種運(yùn)動形式進(jìn)行了詳細(xì)的分析計算 。 (3) 運(yùn)用 TMS320LF2407A 芯片為控制核心， 使 用了 其模塊 UART（ SCI） 、 IIC（模擬）、PWM、 I/O、 CAP、外部擴(kuò)展 RAM。同時圍繞核心的外部器件進(jìn)行程序的編寫調(diào)試，已達(dá)到全向控制的目的。 (4) 使用了 的 MSComm 控件編寫上位機(jī)軟件，設(shè)計上位機(jī)界面和功能，編寫通信協(xié)議。使得系統(tǒng)能夠經(jīng)過 選擇相關(guān)運(yùn)動形式， 修改上位機(jī) 的相關(guān)參數(shù)來實現(xiàn)運(yùn)動系統(tǒng)的全向運(yùn)動。同時能夠在上位機(jī)顯示系統(tǒng)現(xiàn)在運(yùn)動的狀態(tài)和三個電機(jī)速度值。并實現(xiàn)了通過游戲手柄來遙控系統(tǒng)的各種運(yùn)動狀態(tài)。 (5) 對多電機(jī)實現(xiàn)了數(shù)字增量式 PID 控制， 三個電機(jī)各自 PID 控制且互不影響，并通過 MATLAB 進(jìn)行了仿真。 使得 計算出的速度能夠很好的執(zhí)行，提高了系統(tǒng)的準(zhǔn)確性。 (6) 實現(xiàn)了全向運(yùn)動控制系統(tǒng)的所有運(yùn)動形式，且經(jīng)過試驗測試驗證了其準(zhǔn)確性。 基于 DSP 的全向運(yùn)動控制系統(tǒng)軟件設(shè)計 29 參考文獻(xiàn) [1] 徐旭 ,李實 ,葉榛 ,孫增圻 .A Survey: RoboCup and the Research Proceedings of the 3rd World Congress on Intelligent Control and Automation[M],2021 [2] 趙冬斌 ,易建強(qiáng) ,鄧旭玥 .全方位移動機(jī)器人結(jié)構(gòu)和運(yùn)動分析 [J].機(jī)器人 .2021(25) [3] 海丹 .全向移動平臺的設(shè)計與控制 [D].長沙 :國防科技大學(xué) . 2021 [4] 龔建偉 .Visual C++/Turbo C串口通信編程實踐 . 北京 .電子工業(yè)出版社 ， 2021 [5] RaulRojas:Omnidirectional Control,FreieUniversityBerlin,Technical Report B1003, 2021． [6] 劉和平 .DSP 原理及電機(jī)控制應(yīng)用 — 基于 TMS320LF240X 系列 [M].北京 :北京航空航天大學(xué)出版社 ,2021. [7] 王茂飛 ,程昱 .TMS320C2021DSP技術(shù)與應(yīng)用開發(fā) [M].北京 :北京清華大學(xué)出 版 社 ,2021. [8] Texas Peripherals SPRU357B[M].December,2021. [9] 陶永華，尹怡欣，葛蘆生 .新型 PID控制及其應(yīng)用 [M].北京 .機(jī)械工業(yè)出版社 .1998 [10] 薛定宇 .控制系統(tǒng)計算機(jī)輔助設(shè)計 MATLAB 語言與應(yīng)用（第 2 版） [M].北京 :清華大學(xué)出版社 ,2021. [11] 范海艇 .基于 NiosⅡ的中型足球機(jī)器人底層控制系 統(tǒng)的研究與實現(xiàn) [D].上海 ,上海大學(xué) . [12] 姜艷波 .數(shù)字信號處理器 DSP應(yīng)用 100例 [M]，北京：化學(xué)工業(yè)出版社， 2021 [13] 海丹 .全向移動平臺的設(shè)計與控制 [D].長沙 :國防科技大學(xué) ， 2021 [14] 張宏林 .精通 Visual C++串口通信技術(shù)與工程實踐 (第 3版 ) .北京 . 人民郵電出版社， 2021 [15] 龔建偉 .Visual C++/Turbo C串口通信編程實踐（第二版） [M],北京：電子工業(yè)出版社， 基于 DSP 的全向運(yùn)動控制系統(tǒng)軟件設(shè)計 30 附錄 基于 DSP 的全新運(yùn)動控 制系統(tǒng)軟件清單如下 : 其中自己建的有 （存儲液晶字模數(shù)據(jù)） ， （操作指南針）， （運(yùn)動控制策略）， （液晶顯示）， （主程序） 。由于程序比較大， 在此只附錄上 和 兩個文件。 ： /******************************************************************************/ /* File Name : */ /* Autor : Li Haiqing */ /* Date : 04/01/2021 */ /* Description : This file provides main function, provide initialization */ /* 串口發(fā)送與中斷接收程序 ,波特率設(shè)置為 9600 */ /* IO口占用：： PE1PE6（ PWM） PA3PA6和 PB0PB7和 PE7液晶屏使用 */ /* PF0=CAP5,PF1=cap6,PA3=cap1三電機(jī)測速。 PE2=PWM8 PE4=PWM10， PE6=PWM12三電機(jī) */ /* PC01 PF23 PF45電機(jī)正反轉(zhuǎn) */ /******************************************************************************/ include include void SystemInit()。 void Timer1Init()。 void ILI9163_init()。 void KickDog()。 void PWM_Init()。 基于 DSP 的全向運(yùn)動控制系統(tǒng)軟件設(shè)計 31 void IOinit()。 void Timer4Init()。 void Timer2Init()。 /****************************************************/ /* 主程序 */ /****************************************************/ main() { SystemInit()。 //系統(tǒng)初始化 IOinit()。 //IO口初始化 SCI_Init()。 //SCI初始化 PWM_Init()。 //PWM初始化 ILI9163_init()。 //液晶初始化 Timer1Init()。 /*定時器 1初始化 */ Timer4Init()。 /*定時器 4初始化 */ Timer2Init()。 /*定時器 2初始化 */ asm( CLRC INTM )。 display(0xff07,0xffe0)。 LCD_PutString(40,03,李海清 ,0x001f,0x07e0)。 // 液晶界面顯示信息 LCD_PutString(16,23,運(yùn)動控制系統(tǒng) ,0x001f,0x07e0)。 // LCD_PutString(0,143,指南針 :,0x001f,0x07e0)。 // while(1) { SciRed()。 //判斷并讀取 SCI數(shù)據(jù) speedPV()。 //速度函數(shù) } } /************************************************/ /* 系統(tǒng)初始化 */ /************************************************/ void SystemInit() { asm( SETC INTM )。 /* 關(guān)閉總中斷 */ asm( CLRC SXM )。 /* 禁止符號位擴(kuò)展 */ asm( CLRC CNF )。 /* B0塊映射為 onchip DARAM*/ asm( CLRC OVM )。 /* 累加器結(jié)果正常溢出 */ SCSR1=0x834E。 /* 系統(tǒng)時鐘 CLKOUT=20*2=40M */ /* 打開 ADC,EVA,EVB,CAN和 SCI的時鐘 */ WDCR=0x006F。 /* 禁止看門狗 ,看門狗時鐘 64分頻 */ KickDog()。 /* 初始化看門狗 */ IFR=0xFFFF。 /* 清除中斷標(biāo)志 */ IMR=0x000B。 /* 打開中斷 1,2*/ } /************************************************/ /* IO口初始化 */ /************************************************/ void IOinit() { MCRC=MC