專業定制醫療鋰電池
18年專注鋰電池定制
機器人電池定制
低溫鋰電池

基于DSP的移動機器人的設計與實現

鉅大LARGE  |  點擊量:108次  |  2020年02月05日  

摘要
基于DSP的移動機器人的設計與實現- 摘要:智能交通系統是21世紀城市交通的發展方向,移動機器人作為智能車輛控制系統實驗平臺的一個主要部分,對智能交通系統的關鍵技術的研究具有十分重要的

摘要:智能交通系統是21世紀城市交通的發展方向,移動機器人作為智能車輛控制系統實驗平臺的一個主要部分,對智能交通系統的關鍵技術的研究具有十分重要的意義。介紹了面向智能交通系統的SJTNC-1移動機器人的組成和結構,并詳細敘述了基于數字信號處理器TMS320LF2407A的控制系統的設計和實現。


智能交通系統(ITS)的概念是美國智能交通學會于1990年提出的,它將先進的信息技術、通信技術、自動控制技術、電子技術及計算機處理技術綜合運用于整個運輸管理系統中,通過對交通信息的采集、傳輸和處理,對交通運輸進行協調和管理,建立起實時、準確、高效的綜合交通運輸管理體系,從而提高了交通效率和安全了,實現性交通運輸服務和管理的智能化。

智能車輛的導航與定位、自動駕駛與控制和車輛的預警防碰等智能交通系統關鍵技術的研究,近年來受到國內外越來越廣泛的關注,也取得了豐碩的成果。但真正的實驗研究還是很少,基本上只進行了仿真試驗。鑒于理論上的模擬和實際應用情況可能相差甚遠,選擇了具有智能性、易擴展性和移動性等優點的車型移動機器人作為ITS關鍵技術的研究平臺中的主要部分——車輛模擬器。


本文所闡述的移動機器人SJTNC-1,就是面向ITS提出的。考慮到關鍵技術研究中需進行大量的計算,如模糊控制、卡爾曼濾波和路徑導引等,并且系統對數據的實時性要求很高,所以采用數字信號處理器(DSp)作為移動機器人主控CpU。


1TMS320LF2407A簡介


TMS320LF2407A(以下簡稱F2407)是TI公司在TMS320系列DSp的基礎上,專為數字電機控制而設計的。除了具有一般DSp的改進的哈佛結構、多總線結構和流水線結構等優點外,它還采用高性能靜態CMOS技術,電壓從5V降為3.3V,減少了功耗。并且指令執行速度提高到40MIpS,幾乎所有指令都可以在25ns的單周期內完成。如此高的運算速度使其可以通過采用高級控制算法如模糊控制、卡爾曼濾波以及狀態控制等來提高系統的性能。而且,它具有電機控制應用所必需的外設,如:32K片內FLASH、2K單訪問RAM、串行外設接口(Spl)、串行通信接口(SCl)、兩個事件管理模塊、16通道雙10位A/D轉換器和CAN控制器模塊。

2移動機器人的運動機構


考慮到該移動機器人是面向ITS的,所以采用的是車型結構(四輪結構)。前兩輪通過減速比為8:1的齒輪減速機構與轉向電機進行連接,實現移動機器人的轉向功能;后兩輪通過減速比為6:1的齒輪減速機構與驅動電機進行連接,實現移動機器人的驅動。電機的選型可根據實際情況選擇小型步進電機或小型直流電機。這里選用的是瑞土Minimotor公司生產的直流電機,這種電機具有體積小、轉矩大等特點。


3移動機器人控制系統


控制系統以控制器F2407為核心,由無線通信、電機驅動、速度傳感器、數字羅盤、差分GpS(DGpS)接收機和4轉1串口通信模塊等組成,如圖1所示。無線通信模塊根據自行約定的通信協議接收上位機的規劃好的路徑信息,整個控制系統通過控制驅動電機和轉向電機使移動機器人跟蹤該路徑行駛。電機采用pWM調速方式,其中驅動電機采用雙閉環(速度和電流)pID控制策略,而轉向電機則通過把數字羅盤的航向信息作為轉向的反饋量進行pID控制。整個控制系統把DGpS接收機的位置信息作為系統的位置反饋信息,用以完成整個系統的位置閉環控制。

圖3

3.1無線通信模塊


MC35是德國西門子公司生產的可二次開發的支持GpRS的雙頻GSM模塊,可以通過標準串口與pC機相連。本系統用MC35作為移動機器人與上位機的通信模塊。它具有GpRS技術帶來的一切優點,如一直在線和提供高速價廉的數據傳送服務等。該產品的特性如下:


·支持雙頻:EGSM900/GSM1800


·支持GpRSClass8協議


·支持數據、語音、短消息和傳真服務


·采用電路交換方式,最大傳送速率為14.4kbps


·支持的電壓范圍:8V~30V


·采用標準工業接口


·體積:65mmx74mmx33mm


·重量:130g


3.2驅動模塊


驅動電機和轉向電機的驅動原理相同,都采用脈寬調制(pWM)方式進行調速,pWM信號由F2407產生。驅動電路采用H全橋方式,由4個達林頓管(2個TIpl32和2個TIpl37)、4個IN4001二極管及與非門組成。電路原理圖如圖2所示。當pWM2、pWM4為低電平而pWMl、pWM3為高電平時,T1、T4飽和導通,T2、T3截止,電流從T1→電機→T4,電機正轉;反之,當pWMl、pWM3為低電平而pWM2、pWM4為高電平時,T2、T3飽和導通,T1、T4截止,電流從T2→電機→T3,電機反轉。

圖4

為防止T1、T3或T2、T4同時導通,形成短路而擊穿器件,要用一對無重疊的pWM輸出去正確地開啟和關斷這兩對管子。在一個管子關斷和另一個管子開啟之間加入死區時間,這樣就使得一個管子開啟前,另一個管子已完全關斷。F2407具有死區控制單元是其一大特色,從而可用軟件確保功率電路上下橋臂開關元件的開通區間沒有重疊,簡化了硬件電路設計,提高了可靠性。


3.34轉1串口通信模塊


由于DGpS接收機、磁羅盤、里程計和MC35通信模塊都采用RS-232異步串行通信,而F2407只有一個串行口,所以必須將4個串口數據通過轉換處理來完成與F2407的串口通信。為此研制了基于分時復用方法的4轉1串口通信模塊。當F2407需要某個傳感器(或無線通信模塊)的數據時,就通過電路選通該傳感器占用F2407串口進行通信;當需要另外傳感器或無線通信模塊數據時,則關斷上次傳感器的選通,同時選通該次傳感器或無線通信模塊。4轉1串口通信模塊由3-8譯碼器74LSl38、三態輸出的四總線緩沖門74LSl25和電平轉換器MAX232等組成,其電路原理圖如圖3所示。


3.4定位傳感器


3.4.1DGpS接收機


CpS(全球定位系統)是基于衛星的無線電導航系統,它提供一種廉價實用的可在全球范圍內確定位置、速度和時間的工具。CpS由24顆衛星(21顆工作星、3顆備份星)組成星座,星座分布在與地球赤道面傾角為55°的6個軌道面上,其運行周期為11小時58分,軌道半徑為20200km,各軌道面夾角,為60°。每顆衛星向地球發射L頻段的特高連續波,調制兩種偽隨機碼(軍用高精度保密p碼和民用C/A碼)。這樣的分布特點保證了用戶在地球上任何地點、任何時間至少可以連續地收到4顆以上衛星的導航信號,從而聯立解算出接收機的三維坐標以及接收機和GpS間的時間偏移。三維坐標采用ECEF笛卡兒坐標系或大地坐標系如WGS84。


雖然美國政府于2001年5月取消了民用C/A碼的可選擇性保護,但民用導航型GpS接收機的單點實時定位精度只能達到25m左右,不能滿足系統的定位導航要求。而采用實時差分GpS(DGpS),其定位精度可以達到2~5m,該精度已能滿足系統定位和導航的要求。


為此研發了單基站DGpS(SRDGpS)系統,其結構框圖如圖4所示。基準站由ALLSTARBASEGpS接收機、天線和MDS無線電發射臺、天線組成,流動站由SUpERSTARGpS接收機、天線和MDX無線電接收臺、天線組成。其中基準站安裝在上海交大徐家匯校區教學一樓樓頂,該基準站能覆蓋方圓30公里的范圍,流動站安裝在車載單元上。


3.4.2數字羅盤和車速傳感器


采用HoneyWell公司的HMR3300數字羅盤作為移動機器人的方向檢測傳感器。其主要技術指標為:(1)1度航向精度,0.1度分辨率;(2)0.5度重復性;(3)±60度傾斜俯仰范圍;(4)15Hz響應時間;(5)-40+85度工作溫度;(6)6~15V直流電壓。


同時采用用于大眾汽車公司桑塔納2000型轎車的霍爾車速傳感器作為移動機器人的車速傳感器。其工作原理是以霍爾傳感器為變換元件,將機械旋轉量轉化為電脈沖信號輸出。主要技術指標為:(1)輸出波形為矩形脈沖,占空比為50%;(2)每旋轉一周產生6個脈沖;(3)額定電壓為12V。


4電源模塊


電源模塊需分別給各傳感器、DSp芯片、其它芯片和電機供電。其中,磁羅盤、碼盤和DGpS接收機使用12V直流電壓,DSp芯片使用3.3V直流電壓,其它芯片使用5V直流電壓,還有電機電源使用12V直流電壓。所以,采用1節12V的直流蓄電池(4AH),直流5V通過ST半導體公司的L7805和擴流用的功率管實現,DSp芯片用3.3V電源采用ON半導體公司的1SMB5913BT3實現。F2407正常工作時,所有電源管腳都為3.3V;寫入FLASH存儲器時,VCCp引腳為5V供電;復位時,復位電路會產生一個10μs寬度的持續低電平使芯片復位。


5控制器程序結構


DSp程序由五大功能模塊組成,分別為系統初始化模塊、串口通信模塊、路徑引導模塊、驅動電機控制模塊和轉向電機控制模塊。TI公司提供了用于C語言開發的CC和CCS平臺。該平臺包括了ANSIC優化編譯器,從而可以在源程序級進行開發調試。這種方式大大提高了軟件的開發速度和可讀性,方便了軟件的修改和移植。但在某些情況下,代碼的效率還是無法與手工編寫的匯編代碼的效率相比。此外,用C語言實現芯片的某些硬件控制也不如匯編程序方便,有些甚至無法用語言實現。為了充分利用芯片的資源,更好地發揮C語言和匯編語言進行軟件開發的各自優點,采用混合編程方法將兩者有機結合起來,兼顧兩者的優點,避免其弊端。系統的框架如圖5所示。下面對關鍵的幾大模塊進行簡要的闡述。


5.1串口通信模塊


該模塊程序采用串口中斷方式實現,主程序主要由系統初始化、串口初始化、串口中斷設置和等待中斷組成。而中斷子程序分為發送子程序和接收子程序。本文給出發送子程序流程圖。主程序及發送子程序流程圖如圖6所示。


5.2路徑引導模塊


該模塊在移動機器人行駛中為其提供實時的速度和轉向指令,從而引導它沿著上位機給定的路徑行駛。主要包括行駛指令的產生和規劃路徑的跟蹤兩個環節。


根據預瞄跟隨理論及駕駛員的開車行為特性,智能行駛和駕駛員操縱行為是內在一致的。通過研究有駕駛員操縱行為,發現主要根據兩個因素決定車輛的前進速度,這兩個因素分別是道路的彎曲程度和機器人相對參考路徑上的方向偏差。

移動機器人的前進速度的控制不需要連續變化,可設置為三檔,分別對應高、中和低三個速度。由此確定的前進速度跟蹤規則為:


·當方向偏差小于10度時,路徑基本為直線,前進速度設為高速;


·當方向偏差小于90度時,路徑彎曲較嚴重,前進速度設為低速;


·其它情況時,前進速度為中速。


5.3驅動電機和轉向電機控制模塊


驅動電機模塊采取pID控制策略,將車速傳感器檢測的信號作為電機的反饋信號,進行pID控制,取得了很好的控制效果。轉向控制模塊的控制策略與驅動電機的類似,只是其反饋的信號為數字羅盤的方向信號。pID控制算式為:


△u(k)=Kp[e(k)-e(k-1)]+Ki·e(k)+


Kd[e(k)-2e(k-1)+e(k-2)]


u(k)=(k-1)+△u(k)


式中,u(k)為控制的輸出;e(k)為k時刻的偏差;Kp、Ki、Kd分別為pID控制算法的比例系數、積分常數和微分常數。


技術專區慕展上,世強帶來的SiC、GaN、三電平讓你的效率直達最high點如何利用二級輸出濾波器防止開關電源噪聲陶瓷垂直貼裝封裝(CVMp)的焊接注意事項及布局DC-DC轉換器的平均小信號數學建模及環路補償設計常用基準穩壓電源產生辦法有哪些?

聲明: 本網站所發布文章,均來自于互聯網,不代表本站觀點,如有侵權,請聯系刪除(QQ:378886361)

點擊閱讀更多 v
立即咨詢
鉅大精選

鉅大核心技術能力

常州花麻将口诀 排列三全中 不用网络捕鱼单机版 股票申购新股中签查 贵州捉鸡麻将下载安 加导师微信赚钱是真的吗 全民捕鱼破解版 下载南京麻将免费打的玩 pk10最牛稳赚模式4码 西甲赛程是怎么安排的 温州熟客麻将安卓手机下载 试玩游戏赚钱是什么 加股票微信群 永利棋牌? 怎么买平特稳 上证基金指数 金游棋牌游戏大厅?