畢業(yè)設(shè)計（論文）基于ARM嵌入式系統(tǒng)的深海機器人軌跡跟蹤系統(tǒng)研究

1、摘要深海機器人作為深海復(fù)合式水力提升采礦系統(tǒng)中的關(guān)鍵，其行走控制性能的好壞直接關(guān)系到深海采礦的成敗。深海機器人行走在深海底4000-6000米，環(huán)境復(fù)雜多變，因此提高深海機器人行走控制的穩(wěn)態(tài)和動態(tài)品質(zhì)，對深海采礦系統(tǒng)的可靠性具有重要的意義。本文以深海機器人為背景，在深入了解深海機器人行走控制機構(gòu)和工作原理的基礎(chǔ)上，設(shè)計了基于arm嵌入式系統(tǒng)的深海機器人軌跡跟蹤系統(tǒng)。在硬件設(shè)計中，主控制器采用是32位arm微處理器s3c2410，并通過光電編碼器和數(shù)字羅盤分別檢測深海機器人行走過程中的速度和方向角，再經(jīng)過d/a轉(zhuǎn)換器直接控制電液比例閥，從而控制深海機器人的液壓驅(qū)動系統(tǒng)。深海機器人的液壓驅(qū)動系統(tǒng)是

2、復(fù)雜的非線性高階系統(tǒng)，無法用精確的數(shù)學(xué)模型描述其控制規(guī)律，因此設(shè)計了基于模糊算法的履帶速度內(nèi)環(huán)控制器，對左右履帶的速度進(jìn)行精確的調(diào)節(jié)。而對深海機器人速度和方向角的外環(huán)控制則依據(jù)人工駕駛經(jīng)驗整定的專家控制規(guī)則，對其進(jìn)行專家控制。深海機器人軌跡跟蹤系統(tǒng)是一個實時多任務(wù)系統(tǒng)。傳統(tǒng)的單任務(wù)順序執(zhí)行機制不能很好地滿足系統(tǒng)的實時要求，且由于程序是一條單線執(zhí)行下來，如果程序某一處出現(xiàn)問題，則可能影響整個系統(tǒng)的運行，只能靠復(fù)位來解決，系統(tǒng)的可靠性不高。因此在設(shè)計中采用了開源嵌入式操作系統(tǒng)c/os-進(jìn)行多任務(wù)的調(diào)度，保證了系統(tǒng)的實時性和可靠性。仿真結(jié)果表明，本文所用控制算法對深海機器人的行走控制具有良好的性能。

3、關(guān)鍵字：深海機器人，行走控制，arm嵌入式，專家模糊控制系統(tǒng) abstractas the key of deep-sea mining system with complex hydraulic hoisting, deep-sea robots performance of tracking control decides the deep-sea minings success or not. the deep-sea robot walks in the deep seabed of 4000-6000m, and the environment is complex and chan

4、geable. thereby, it has important significance for the reliability of deep-sea mining to improve the quality and dynamic of the deep-sea robots tracking control.with the background of the deep-sea robot, and in the basis of deep understanding of the structure and work principle of deep-sea robots tr

5、acking control, this paper has designed a trajectory tracking system of deep-sea robot base on arm embedded system. in the hardware design, the host controller uses the 32-bit arm microprocessor s3c2410, and measures the speed and direction angle when the deep-sea robot is walking through the optica

6、l encoder and digital compass. finally, using the d/a converter to control the electro-hydraulic proportional valve directly, and then to control the hydraulic drive system of deep-sea system of deep-sea robot. the hydraulic drive of deep-sea robot is a complicated nonlinear multi-step system, so it

7、s difficult to describe the control theory with accurate mathematics model. therefore this paper has designed a inner loop controller by fuzzy algorithm to control the speed of the left and right pedrail accurately. meanwhile, the outer loop controller uses the expert control algorithm to control th

8、e speed and direction angle of the deep-sea robot. the trajectory tracking system of deep-sea robot is a real-time and multi-task system, and the traditional single-task cant satisfy the desire of real-time system. once a particular process makes a mistake, the whole system will be affected. in orde

9、r to solve this problem, only to make a reset. so in order to assure the real-time and reliability, this paper uses the open-source embedded operating system c/os-to manage for the multi-task. simulation results show that the control algorithm used in deep-sea robot tracking control has a good perfo

10、rmance.key word: deep-sea robot, tracking control, arm embedded, expert-fuzzy control目錄摘要iabstractii第一章 緒論11.1 深海機器人軌跡跟蹤研究的意義和目的11.2 深海機器人軌跡跟蹤的國內(nèi)外研究現(xiàn)狀21.2.1 國外研究現(xiàn)狀21.2.2 國內(nèi)研究現(xiàn)狀51.3 我國深海采礦的工藝流程71.4 論文組成8第二章 深海機器人軌跡跟蹤系統(tǒng)硬件設(shè)計92.1 深海機器人軌跡跟蹤系統(tǒng)硬件框圖92.2 深海機器人軌跡跟蹤系統(tǒng)硬件原理圖102.2.1 主控制器的選擇102.2.2 傳感器的選擇102.2.3 d

11、/a轉(zhuǎn)換器192.2.4 rs-232/rs485轉(zhuǎn)換器212.2.5 其它器件的選擇222.3 硬件抗干擾232.4 本章小結(jié)24第三章 控制算法253.1深海機器人行走作業(yè)規(guī)劃及控制要求253.2 深海機器人軌跡跟蹤系統(tǒng)控制算法的研究263.2.1 專家控制系統(tǒng)273.2.2 模糊控制系統(tǒng)273.2.3 專家模糊控制系統(tǒng)283.3 本章小結(jié)30第四章 基于matlab的系統(tǒng)仿真及其結(jié)果314.1 模糊控制器的設(shè)計314.2 基于simulink的模糊控制器仿真及其結(jié)果334.2.1 深海機器人履帶液壓系統(tǒng)理想數(shù)學(xué)模型334.2.2 基于simulink的仿真模型設(shè)計344.2.3 控制規(guī)則

12、在線學(xué)習(xí)的模糊控制器的實現(xiàn)354.3 本章小結(jié)37第五章 深海機器人軌跡跟蹤系統(tǒng)軟件設(shè)計385.1 深海機器人軌跡跟蹤系統(tǒng)軟件設(shè)計總體框圖385.2 嵌入式操作系統(tǒng)的選擇及移植395.2.1嵌入式操作系統(tǒng)的選擇395.2.2嵌入式操作系統(tǒng)的移植395.2.3 快速自啟動程序的設(shè)計425.3 各應(yīng)用程序模塊的設(shè)計435.3.1 系統(tǒng)主程序設(shè)計435.3.2 速度采集模塊程序設(shè)計435.3.3 航向采集模塊程序設(shè)計435.3.4 數(shù)據(jù)處理模塊程序設(shè)計455.3.5 履帶速度調(diào)節(jié)模塊程序設(shè)計465.3.6 報警模塊程序設(shè)計475.3.7 深海機器人上位機程序設(shè)計475.4 軟件抗干擾485.5 結(jié)束

13、語49第六章 結(jié)論50參考文獻(xiàn)52致謝54附錄第一章 緒論1.1 深海機器人軌跡跟蹤研究的意義和目的曾有人預(yù)言：“21世紀(jì)將是人類開發(fā)利用海洋的世紀(jì)”。隨著人類社會人口的激增和現(xiàn)代工業(yè)的飛速發(fā)展，人們正在逐漸地把陸地上有限的礦產(chǎn)資源消耗殆盡。為了尋求新的礦產(chǎn)資源，人們開始把目光投向了海底豐富的礦產(chǎn)資源。 海洋占地球表面積的70.2%，其蘊藏著幾乎取之不盡的生物、能源和礦產(chǎn)資源1。據(jù)(2000)的粗略推算，僅海底的cu、ni、co、mn金屬資源的蘊藏量就可供全球使用千年以上。然而直到現(xiàn)在為止，人們對海洋金屬礦產(chǎn)的開發(fā)還處在起步的階段，因此加快對海洋資源的研究和開發(fā)在21世紀(jì)成了各國的共識。在過去

14、的3o年間，包括中國在內(nèi)的各國完成了千余航次的海上地質(zhì)調(diào)查、取樣和海底鉆探，對鐵錳結(jié)核和富鈷結(jié)殼的分布、物質(zhì)成分、資源量和采冶工藝進(jìn)行了全面而深入的研究，使人們對海底礦產(chǎn)的分布、資源量和開發(fā)前景有了一個較全面和較準(zhǔn)確的了解。目前探明具有商業(yè)開發(fā)前景的有多金屬結(jié)核(錳結(jié)核)、富鈷結(jié)殼和熱硫化礦床以及生物基因資源。多金屬結(jié)核是一種結(jié)核狀的鐵錳礦，又稱為大洋錳結(jié)核，它廣泛分布于水深30006 000 m海底。它主要由鐵錳物質(zhì)組成，含有70多種元素(包括工業(yè)所需要的銅、鉆、鎳、錳、鐵等金屬)，其中ni，co，cu，mn的平均含1.30%，0.22%，1.00%和25.00%，總儲量分別高出陸地相應(yīng)儲量

15、的幾十倍到兒千倍，具有很高的經(jīng)濟價值，是一種重要的深海礦產(chǎn)資源。多金屬結(jié)核在大西洋、印度洋、太平洋等世界幾大洋中均有分布，惟太平洋分布最廣，儲量最大，并呈帶狀分布，擁有東北太平洋海盆、中太平洋海盆、南太平洋、東南太平洋海盆等4個分區(qū)，其中位于東北太平洋海盆內(nèi)克拉里昂、克里帕頓斷裂之間的cc區(qū)(clarion-clipperton zone)是結(jié)核經(jīng)濟價值最高的區(qū)域2。目前,國際海底區(qū)域資源的競爭愈演愈烈,許多國家都在積極發(fā)展海洋高技術(shù),深化海洋資源利用。海底工業(yè)采礦實驗的成功，促進(jìn)了鐵錳結(jié)核和富鈷結(jié)殼的工業(yè)開采冶煉工藝。有鑒于此，聯(lián)合國海洋公約大會于1994年曾將世界海洋劃分為200海里專屬經(jīng)

16、濟區(qū)(eez)(這里的資源屬主權(quán)國)和200海里以外的國際公海。廣闊的國際公海中蘊藏的所有資源是屬于“人類的共同財富”，各國可依法進(jìn)行調(diào)查研究和申請開采。我國的大洋工作起始于20世紀(jì)70年代，最初以多金屬結(jié)核資源調(diào)查為主3。70年代中后期，我國大洋調(diào)查船先后在太平洋海底采集到錳結(jié)核。80年代初，我國大洋錳結(jié)核資源調(diào)查工作取得較大進(jìn)展，1984年開始著手制定我國大洋礦產(chǎn)資源勘查規(guī)劃，并開始部署相關(guān)的科學(xué)和技術(shù)研究工作。1991年，以“發(fā)展我國深海高新技術(shù)，為人類開發(fā)利用國際海底資源做出貢獻(xiàn)”為宗旨的中國大洋礦產(chǎn)資源研究開發(fā)協(xié)會(簡稱中國大洋協(xié)會)正式成立，成為組織我國各方面深?？蒲虚_發(fā)力量，開展

17、大洋工作的主要平臺，并代表我國向國際海底管理局和國際海洋法法庭籌備委員會申請礦區(qū)登記。2001年5月，中國大洋協(xié)會與國際海底管理局簽訂了勘探合同，以合同形式確定了我國在太平洋cc區(qū)擁有專屬勘探權(quán)和優(yōu)先商業(yè)開采權(quán)的7.5萬平方公里多金屬結(jié)核礦區(qū)，成為繼印度、原蘇聯(lián)、法國、日本之后第5個已登記的國際海底開發(fā)先驅(qū)投資者。這一多金屬結(jié)核礦區(qū)的獲得，為我國經(jīng)濟可持續(xù)發(fā)展提供了寶貴的資源戰(zhàn)略儲備。1.2 深海機器人軌跡跟蹤的國內(nèi)外研究現(xiàn)狀1.2.1 國外研究現(xiàn)狀上世紀(jì)60年代以來，西方發(fā)達(dá)國家先后投入了大量的資金、人力和物力來進(jìn)行深海采礦技術(shù)的系統(tǒng)開發(fā)和實驗研究，并已對連續(xù)繩斗法采礦系統(tǒng)、穿梭艇式采礦系統(tǒng)

18、進(jìn)行了開發(fā)研究，并進(jìn)行了一系列的試驗45678。1970年國際財團海洋采礦公司(oma)在大西洋在布萊克海底臺地試驗了拖曳式水力深海機器人，1978年在太平洋的克拉里昂-克里帕頓斷裂帶用同樣的采礦系統(tǒng)進(jìn)行了試采。在1978年,美國海洋管理財團就在太平洋礦區(qū)按1/41/5工業(yè)生產(chǎn)規(guī)模進(jìn)行了海上采礦試驗并取得成功,從而奠定了流體提升采礦法的基礎(chǔ)。該采礦法的最大特點是配備了自行遙控采礦車,具有較好的機動靈活性,能避開海底障礙物和不利地形,能實現(xiàn)大規(guī)模、高效采礦。1987年和1990年俄羅斯(前蘇聯(lián))在黑海79米水深區(qū)域采用自行式深海機器人進(jìn)行了集礦實驗。在實驗中，特地在試驗區(qū)海底拋灑了從太平洋中部水

19、域采集的十余噸錳結(jié)核，而其研制的自行式深海機器人采集錳結(jié)核的生產(chǎn)能力達(dá)到了7.2噸/小時。1994年起，韓國開始了“深海采礦技術(shù)開發(fā)和深海環(huán)境保護”項目，并進(jìn)行了大量的研發(fā)工作。韓國開發(fā)的復(fù)合式深海機器人采用履帶行走方式，與我國目前研制的履帶式深海機器人不同的是，它的采礦設(shè)備是可以相對底盤平移和旋轉(zhuǎn)運動的，而且其運動由底盤行走機構(gòu)的運動來決定。與采用固定的方式相比，這種方式集礦效率相對較高，但控制較為復(fù)雜?，F(xiàn)在韓國正在對履帶式深海機器人進(jìn)行虛擬樣機設(shè)計和數(shù)字仿真研究。德國和法國為海洋采礦系統(tǒng)研制了柔性懸掛和剛性懸掛兩臺海底履帶式深海機器人，其研究重點主要在開發(fā),對導(dǎo)航研究涉及甚少。印度在200

20、0年完成了500 m水深海底履帶式深海機器人行走試驗,采用的是法國研制的機器車底盤。目前，西方國家具有代表性的深海機器人主要有以下幾種：（1）美國omco研制的深海機器人 美國海洋礦產(chǎn)公司(omco)研制，于1978年在夏威夷以南海域進(jìn)行了實驗，并成功收集結(jié)核。見圖3.1。行走機構(gòu)：液壓驅(qū)動，阿基米德螺旋行走機構(gòu)。其工作原理是螺旋葉片陷入海泥中，螺旋體旋轉(zhuǎn)推動海泥，使行走機構(gòu)獲得向前或向后的推力而前進(jìn)或后退。其優(yōu)點為結(jié)構(gòu)簡單、海底通過性好，缺點為行走打滑、承載能力低、功耗大、對海底擾動較大。集礦方式：采用轉(zhuǎn)輪和鏈帶機械集礦。由兩根斗鏈把多金屬結(jié)核鏟起，通過輸?shù)V皮帶傳輸?shù)劫A礦罐。其優(yōu)點為結(jié)構(gòu)簡單

21、，耗能低，缺點為集礦效率不高、轉(zhuǎn)速較高時，結(jié)核有隨水流漂浮現(xiàn)象，一些用圓柱齒制作的工作表面易被細(xì)泥堵塞。傳感裝置：一個測障聲納、一個姿態(tài)角傳感器、一臺深海攝像機。幾何參數(shù)：長3415mm，寬2440mm，高2100mm.圖3.1 美國omco研制的深海機器人（2）德國錫根大學(xué)研制的深海機器人 德國從上世紀(jì)七十年代就開始了深海底采礦機器人的研制。經(jīng)歷幾十年研究，形成了具有德國特色的采礦系統(tǒng)。圖3.2為德國錫根大學(xué)研制的深海機器人。該機器人的改進(jìn)型于1999年7月在印度的淺海實驗成功。行走機構(gòu)：液壓驅(qū)動，漸開線履齒橡膠帶行走機構(gòu)。該車的特點就是采用了特殊形式的擺動車架，支承輪也能擺動，因此該底盤車

22、能較好地適應(yīng)海底復(fù)雜地形，具有較好的越障能力。履帶結(jié)構(gòu)簡單，漸開線履齒對沉積物的作用如同齒輪與齒條嚙合，對沉積導(dǎo)擾動較小。集礦方式：高壓水射流集礦。集礦時，前排射流將結(jié)核從沉積層上沖起，后排反向射流擋住沖起的結(jié)核往后的去路，并與前排射流產(chǎn)生一向上的合流將結(jié)核抬起，并沖向后部的輸送機構(gòu)。實驗表明，該集礦頭可在集礦高度100200mm內(nèi)工作，高度為140mm時，集礦效率可達(dá)100%。傳感裝置：一個測障聲納、一個磁通門羅盤、一臺多普勒測速儀、兩個測速編碼器、一臺深海攝像頭。幾何參數(shù)：長3.1m，寬3米，高2米。圖3.2 德國錫根大學(xué)研制的深海人（3）法國梭型潛水深海機器人1980年前后，法國vert

23、ut等人研制了一種梭型潛水深海機器人（見圖3.3）。為得采礦靠自身重量下行，一般與豎直方向成一定角度。壓倉物貯存在結(jié)核倉內(nèi)，當(dāng)深海機器人快到達(dá)海底時，釋放一部分壓艙物以便采礦車徐徐降落。深海機器人用阿基米德螺旋推進(jìn)器在海底行走，一邊排出壓艙物，一邊采集等效重量接近零。當(dāng)最后一點壓艙物被排出，深海機器人在阿基米德推進(jìn)器作用下返回到海面。法國所設(shè)計的第二代梭型潛水遙控深海機器人模型機pla-2型外形尺寸為5.53.32.6m、重16t（包括壓艙物）。由于系統(tǒng)投資大，產(chǎn)品價值不高，法國大洋結(jié)核研究開發(fā)協(xié)會（afernod）于1983年已停止研究。圖3.3 法國梭型潛水深海機器人（4）日本拖曳式深海機

24、器人日本在連續(xù)斗系統(tǒng)實驗失敗后，于八十年初轉(zhuǎn)入拖曳水力射流深海機器人的研究（見圖3.4）。但經(jīng)過多年研究，日本已認(rèn)識到拖曳式行走不能滿足生產(chǎn)要求，正準(zhǔn)備轉(zhuǎn)身自行走深海機器人的研究。圖3.4日本拖曳式深海機器人（5）印度深海底深海機器人印度于十九世紀(jì)七十年代即開始了多金屬結(jié)核采礦的研究，但進(jìn)展緩慢。通過與德國錫根大學(xué)合作，采用錫根大學(xué)研制的履帶車底盤，并自行研究了獨特的集礦頭，印度與1999年7月進(jìn)行了200m淺海實驗，并取得了成功。圖3.5為印度深海機器人模型。該機器人長3160mm，寬2950m，重10t，最大速度0.75m/s。在機器人頂安裝有一個可左右擺動的機械臂，機械臂的下方為一個泥漿

25、泵。采礦時，通過機械臂的左右擺動，用泥漿泵抽取海底表面的多金屬結(jié)核。該機器人除可采集多金屬結(jié)核外，也可進(jìn)行海底采沙。圖3.5印度深海底深海機器人1.2.2 國內(nèi)研究現(xiàn)狀國內(nèi)深海機器人控制技術(shù)研究始于“八五”計劃?！鞍宋濉逼陂g，我國在綜合研究國外深海機器人作業(yè)行走機構(gòu)的基礎(chǔ)上，長沙礦山研究院在“八五”期間研制了一臺自行式履帶車模型機（見圖3.6(a)），該車采用近似漸開線高齒橡膠履帶，雙浮動懸架和橫向擺動梁，雙泵全功率供油，液壓馬達(dá)分別驅(qū)動，電液比例控制，采用水力機械復(fù)合集礦方式，外形尺寸4.63.02.1m，重8t,行駛速度01m/s。結(jié)合深海采礦模型深海機器人的研制和實驗室研究，于95年成功

26、開發(fā)了稀軟底履帶行走式深海機器人控制系統(tǒng)，淺水試驗初獲成功，取得了階段性研究成果。同時暴露了控制系統(tǒng)水下儀表的執(zhí)行機構(gòu)多根電纜和信號纜相互間的纏繞扭曲嚴(yán)重、密水接頭過多、主要依賴觀測手段操作等薄弱環(huán)節(jié)，為“九五”擴大研究奠定了基礎(chǔ)?！熬盼濉逼陂g，由我國自行設(shè)計，與法國cebynetic公司合作，研制了第二代深海機器人（見圖3.6(b)）主要改進(jìn)表現(xiàn)為采用尖三角齒特種合金履帶板，提高了深海機器人在深海軟底環(huán)境下的可靠性和可行駛性；改用全水力集礦方式，進(jìn)一步提高了深海機器人的效率；增加了控制密水箱和相關(guān)傳感器，提高了深海機器人的可操作性。該深海機器人達(dá)到了牽引特性理想、牽引力大、承載能力強、跨越或

27、繞過海底障礙容易、能適應(yīng)軟海底行走的預(yù)期目標(biāo)。研究重點集中于深海中的試深海機器人控制和供電技術(shù)的研究開發(fā)，旨在打通深海采礦主要子工藝系統(tǒng)的控制流程。基于技術(shù)設(shè)計和實驗室研發(fā)，采用國際合作的技術(shù)路線，各控制環(huán)節(jié)初步形成，于2000年研制出我國第二代深海機器人控制系統(tǒng)。控制系統(tǒng)基于compact-pci-ipc組成dcs層次結(jié)構(gòu)，控制功能較為完善。開發(fā)了基于plc的硬管揚礦監(jiān)控裝置、基于研華一體化ipc的軟管控制裝置。各子系統(tǒng)工藝流程基本滿足工藝實驗室要求，但控制系統(tǒng)功能有待完善。并于2001年成功進(jìn)行130m水深湖試。由于自身和外部環(huán)境等因素，在湖試時發(fā)現(xiàn)，深海機器人在130m軟底是行駛的難度很

28、大，現(xiàn)在人工控制效果很不理想。2001年，中國大洋協(xié)會發(fā)布了“十五”深海資源研究開發(fā)計劃，并向中南大學(xué)、長沙礦山研究院、長沙礦冶研究院等研究課題承擔(dān)單位下達(dá)了深海采礦中試系統(tǒng)監(jiān)控、動力配置技術(shù)設(shè)計研究開發(fā)子項目任務(wù)，下轄5個子課題，重點仍然集中于深海中試深海機器人控制技術(shù)的研究開發(fā)。面向?qū)嶒炇已芯亢图夹g(shù)設(shè)計，旨在打通深海采礦各子工藝系統(tǒng)的控制流程，為“十五”海試控制系統(tǒng)工藝設(shè)計和研制開發(fā)提供技術(shù)支撐。根據(jù)中國大洋協(xié)會“十五”計劃安排，結(jié)合“八五”“九五”研究和技術(shù)設(shè)計成果，開展深海機器人控制技術(shù)深度開發(fā)?！笆晃濉庇媱澋念^兩年完成深海采礦系統(tǒng)1000米海試的試驗工作，積累海上大型系統(tǒng)施工作業(yè)的

29、經(jīng)驗。試驗完成后開展針對6000米的關(guān)鍵技術(shù)攻關(guān)，為6000米海上試驗開采做好準(zhǔn)備。與此同時在“十一五”計劃期間展開其他資源的開采方案和部分關(guān)鍵技術(shù)的研究，力爭深海采礦技術(shù)能面向多種資源。圖3.6第一代深海機器人 圖3.7第二代深海機器人1.3 我國深海采礦的工藝流程我國采用的采礦系統(tǒng)方案是深海復(fù)合式水力提升采礦系統(tǒng)，屬于深海機器人加管道輸送采礦系統(tǒng)中的一種9。該系統(tǒng)包括三個相互連系部分，即深海底采礦機器車、提升設(shè)備和海面設(shè)施（見圖2.1）。其基本的工作原理是，集礦子系統(tǒng)（即深海機器人）在海底按預(yù)定路徑行駛，由深海機器人上的采集頭將多金屬結(jié)核吸入深海機器人并進(jìn)行破碎。破碎后的礦漿經(jīng)輸送管到達(dá)中

30、間艙，再由水力提升系統(tǒng)將礦漿通過揚礦管（硬管）輸送到水面采礦船。在而在整個采礦系統(tǒng)中，集礦子系統(tǒng)部分是該方案中的一個關(guān)鍵環(huán)節(jié)，由深海機器人和與之相配套的控制系統(tǒng)及動力配置系統(tǒng)構(gòu)成。深海機器人主要包括自行式履帶作業(yè)車、深海機器人構(gòu)、破碎機構(gòu)、液壓系統(tǒng)、控制系統(tǒng)、動力裝置、軟管連接裝置。整個深海機器人行走、姿態(tài)調(diào)整、采集、破碎的動力都由液壓系統(tǒng)提供，采用2臺高壓水下電機驅(qū)動油泵提供壓力。深海機器人是履帶式的自行走作業(yè)車，采用高尖齒的履帶行走，兩條履帶由安裝在后輪上的兩臺液壓馬達(dá)分別驅(qū)動，用變量泵調(diào)節(jié)速度。同時，為了在深海機器人收放時控制其姿態(tài)，防止其旋轉(zhuǎn)，在深海機器人的前后各安裝了一臺液壓馬達(dá)驅(qū)動

31、的螺旋槳。深海機器人構(gòu)安裝在作業(yè)車的前端，由前后兩排相對斜向海底射流的噴嘴、附壁噴嘴、封閉輸送管道和排泥隔柵等組成。采用低壓大流量水力沖抬輸送原理采集結(jié)核，壓力水由液壓馬達(dá)驅(qū)動的水泵提供。深海機器人構(gòu)利用水射流將賦存在海這個底表面的多金屬結(jié)核擾動、捕獲，經(jīng)過脫泥后輸送到破碎機構(gòu)的料倉中；破碎機構(gòu)將多金屬結(jié)核破碎成滿足揚礦輸送要求的大小的礦石粒徑后進(jìn)入揚礦輸送管道，完成整個集礦作業(yè)。破碎機構(gòu)采用單齒輥式破碎，由液壓馬達(dá)驅(qū)動，同時具有液壓自動防卡排除大塊裝置。采礦系統(tǒng)還包括一個中繼站，中繼站為深海機器人處理過的礦結(jié)核提供一個暫存和中轉(zhuǎn)的場所，另外，合理地分擔(dān)了部分設(shè)備安裝，使深海機器人有最大的機動

32、靈活性。海面采礦船為集礦和揚礦提供所有操作控制和維護。整個系統(tǒng)由海面采礦船上的監(jiān)控中心分別對深海機器人的集礦過程、行走速度和方向、以及海面采礦船之間的相對位置、深海機器人上的碰壁聲納進(jìn)行控制。深海機器人上的定位聲納用來確定和顯示深海機器人在采礦區(qū)相對中繼站的位置，多波聲納用來探測前進(jìn)方向的地形和障礙物。此外深海機器人上安裝的電視攝像機用來觀察深海機器人的各種運動和各工作機構(gòu)的工作情況，以及其周圍的地形。采礦船揚礦管復(fù)合電纜提升泵中間倉輸送軟管深海機器人6000m圖2.1 深海底多金屬結(jié)核采集系統(tǒng)示意圖1.4 論文組成由于深海機器人對整個采礦方案有著舉足輕重的作用，因此，開展對深海機器人行走控制

33、的研究是非常有必要的。為此本文著重對深海機器人的行走控制進(jìn)行了研究，研究的內(nèi)容如下：第一章簡要介紹了深海采礦的背景、工藝流程及深海機器人在深海采礦中的重要意義及其在國內(nèi)外的研究現(xiàn)狀。第二章設(shè)計了基于arm微處理器的深海機器人行走控制硬件方案。第三章提出了基于專家模糊控制的深海機器人行走控制算法。第四章采用matlab對深海機器人行走控制系統(tǒng)進(jìn)行動態(tài)仿真。第五章設(shè)計了深海機器人行走控制系統(tǒng)的軟件方案。第六章總結(jié)。第二章 深海機器人軌跡跟蹤系統(tǒng)硬件設(shè)計2.1 深海機器人軌跡跟蹤系統(tǒng)硬件框圖中斷主控制器armarmrs-232rs-485rs-232uart1 ldata07 eint05 uart

34、0rs232/rs485轉(zhuǎn)換器上位機rs-232d/a電液比例閥增量式光電編碼器（左右履帶、車體線速度）數(shù)字羅盤（航向角采集）左右履帶速度rs232/rs485轉(zhuǎn)換器圖2.1 深海機器人軌跡跟蹤系統(tǒng)硬件框圖從深海機器人軌跡跟蹤系統(tǒng)硬件框圖可以看出，需要檢測的數(shù)據(jù)包括: 左右履帶當(dāng)前的實際轉(zhuǎn)速、深海機器人的當(dāng)前實際切向速度和深海機器人當(dāng)前行駛方向角。這三種參數(shù)的檢測原理為：1.左右履帶當(dāng)前的實際轉(zhuǎn)速是通過安裝在左右履帶驅(qū)動輪上的光電編碼器來進(jìn)行檢測的。通過測量編碼器兩個相鄰脈沖時間間隔，就可以測得深海機器人左右履帶的速度。2. 深海機器人的當(dāng)前實際線速度是通過安裝在深海機器人的地輪來進(jìn)行檢測的。

35、其檢測原理是：在深海機器人中下部安裝一個拖在地面的可以自由轉(zhuǎn)動的輪子，當(dāng)深海機器人行駛時，利用安裝在輪子一側(cè)的增量式光電編碼器來檢測輪子的轉(zhuǎn)速，從而得到集礦機的當(dāng)前線速度。由于地輪基本上不發(fā)生打滑現(xiàn)象，因此地輪的轉(zhuǎn)速即反應(yīng)了深海機器人當(dāng)前的實際線速度。3.深海機器人當(dāng)前行駛方向角是由安裝在深海機器人上的數(shù)字羅盤檢測得到。數(shù)字羅盤是通過檢測磁阻的變化來確定深海機器人當(dāng)前方向角的傳感器。數(shù)字羅盤的接口簡單，可以通過rs-232或rs-485串口直接讀取深海機器人當(dāng)前行駛的方向角。主控制器進(jìn)行傳感器數(shù)據(jù)的在線采集并存儲，然后根據(jù)相關(guān)控制算法進(jìn)行數(shù)據(jù)的處理，經(jīng)d/a轉(zhuǎn)換發(fā)出相應(yīng)的控制信號，控制電液比例

36、閥的動作，從而達(dá)到控制深海機器人左右履帶的目的。為了實時監(jiān)控深海機器人的軌跡，通過rs-485與上位機進(jìn)行通信。由于上位機的通信端口只有rs-232，所以為了與上位機進(jìn)行通信，必須進(jìn)行rs-232/rs485轉(zhuǎn)換。2.2 深海機器人軌跡跟蹤系統(tǒng)硬件原理圖深海機器人軌跡跟蹤系統(tǒng)硬件原理圖見附錄圖1圖7。2.2.1 主控制器的選擇 目前世界上具有嵌入式功能特點的處理器已經(jīng)超過1000種，流行的體系結(jié)構(gòu)包括mcu、mpu等30多個等系列。其中的典型代表有單片機、arm、dsp等。而針對深海環(huán)境的復(fù)雜性，主控制器的選擇必有具有很強的實時任務(wù)支持能力，能夠完成多任務(wù)并且有較短的中斷響應(yīng)時間，從而使內(nèi)部的

37、代碼和實時內(nèi)核心的執(zhí)行時間減少到最低的限度。單片機、arm、dsp都具有這樣的特點。但單片機的抗干擾能力較弱，性能一般，一般用在低端的控制系統(tǒng)中，對于深海復(fù)雜的環(huán)境來說并不適合，而dsp是專門用來處理數(shù)字信號的，在語音合成和編碼器中有廣泛的應(yīng)用，用來控制深海機器人行走也不合適。所以對于深海機器人的行走控制來說選用arm控制器是最佳的選擇。samsung公司的s3c2410處理器是一款arm9系列的處理器，基于arm9tdmi處理器核，采用1.8v/2.0v內(nèi)核供電，3.3v存儲器供電，3.3v外部i/o口供電。這塊芯片含有非常豐富的片上資源：具備16kb的i-cache和16kb的d-cach

38、e/mmu;外部存儲控制器（sdram控制和片選邏輯）；4通道dma并有外部請求引腳；3通道uart（irda1.0，16字節(jié)txfifo，和16字節(jié)rxfifo）,2通道spi；4通道pwm定時器和1通道內(nèi)部定時器；看門狗定時器；117個能用i/o口和24通道外部中斷源；功耗控制模式：具有普通，慢速，空閑和掉電模式。8通道10比特adc和觸摸屏接口；s3c2410是目前國內(nèi)使用較為普遍的arm處理器，有較為豐富的資源可以參考，同時，采購比較方便，成本低。2.2.2 傳感器的選擇1. 光電編碼器光電編碼器在現(xiàn)代電機控制系統(tǒng)中常常用以檢測轉(zhuǎn)子的位置與速度，是通過光電轉(zhuǎn)換將輸出軸上的機械幾何位移量

39、轉(zhuǎn)換成脈沖或數(shù)字量的傳感器10。因此深海機器人左右履帶和整體的速度可以通過光電編碼器來測得。（1）光電編碼器的原理光電編碼器由光柵盤和光電檢測裝置組成。光柵盤是在一定直徑的圓板上等分地開通若干個長方形孔。由于光電碼盤與電動機同軸，電動機旋轉(zhuǎn)時，光柵盤與電動機同速旋轉(zhuǎn)，編碼器光源產(chǎn)生的光經(jīng)光學(xué)系統(tǒng)形成一束平行光投射在碼盤上，并與位于碼盤另一面成徑向排列的光敏元件相耦合，經(jīng)放大整形后辦出若干的脈沖信號。其原理示意圖如圖2.2所示，通過計算每秒光電編碼器輸出脈沖的個數(shù)就能反映當(dāng)前電動機的轉(zhuǎn)速。此外，為判斷旋轉(zhuǎn)方向，碼盤還可提供相位相差的兩路脈沖信。透鏡轉(zhuǎn)軸光源光敏元件放大整形碼盤透鏡脈沖輸出 圖2.

40、2 光電編碼器原理圖根據(jù)光電編碼器的刻度和輸信號的不同，可以分為絕對式光電編碼器和增量式光電編碼器。1）絕對式光電編碼器絕對式編碼器可直接輸出數(shù)字量。在它的圓形碼盤上沿徑向有若干同心碼道，每條道上由透光和不透光的扇形區(qū)相間組成，相鄰碼道的扇區(qū)數(shù)目是雙倍關(guān)系，碼盤上的碼道數(shù)就是它的二進(jìn)制數(shù)碼的位數(shù)，在碼盤的一側(cè)是光源，另一側(cè)對應(yīng)每一碼道有一光敏元件;當(dāng)碼盤處于不同位置時，各光敏元件根據(jù)受光照與否轉(zhuǎn)換出相應(yīng)的電平信號，形成二進(jìn)制數(shù)。這種編碼器的特點是不要計數(shù)器，在轉(zhuǎn)軸的任意位置都可讀出一個固定的與位置相對應(yīng)的數(shù)字碼。顯然，碼道越多，分辨率就越高，對于一個具有n位二進(jìn)制分辨率的編碼器，其碼盤必須有n

41、條碼道。絕對 式 編 碼器是利用自然二進(jìn)制或循環(huán)二進(jìn)制(葛萊碼)方式進(jìn)行光電轉(zhuǎn)換的。編碼的設(shè)計可采用二進(jìn)制碼、循環(huán)碼、二進(jìn)制補碼等。特點：具有輸出數(shù)字量可與微機或dsp直接接口，可以直接讀出角度坐標(biāo)的絕對值；沒有累積誤差；電源切除后位置信息不會丟失。但是分辨率是由二進(jìn)制的位數(shù)來決定的，也就是說精度取決于位數(shù)，目前有10位、14位等多種。缺點：引出線較多，信號線數(shù)量與二進(jìn)制的位數(shù)相同；但是價格高、制造工藝復(fù)雜，不宜實現(xiàn)小型化。2）增量式光電編碼器增量式編碼器是直接利用光電轉(zhuǎn)換原理輸出三組方波脈沖a、b和z相;a、b兩組脈沖相位差，從而可方便地判斷出旋轉(zhuǎn)方向，而z相為每轉(zhuǎn)一個脈沖，用于基準(zhǔn)點定位。

42、增量式光電編碼器利用雙光柵疊柵條紋技術(shù)，對空間位置進(jìn)行光學(xué)放大，通過光電接收器輸出相位相差的兩路信號sin和cos口，判向電路根據(jù)這兩號的相位關(guān)系，確定碼盤的轉(zhuǎn)動方向，然后按光柵付之間的轉(zhuǎn)動方向?qū)φ倚盘柕拿總€周期進(jìn)行增或減計數(shù)，正轉(zhuǎn)則加，反轉(zhuǎn)則減，于是便可獲得相對某一位置的計數(shù)值n。若光柵節(jié)距角為:,那么相對該指定位置的角度粗碼值就為:=n。特點：分辨率高、響應(yīng)速度快、體積小、輸出穩(wěn)定，測速度和測角度精度高；輸出信號可以直接連接到微機或dsp的計數(shù)器輸入端，由其軟件來辨相和計數(shù)； 成本低。 缺點：不具有計數(shù)和接口電路；無記憶能力，斷電后要重新計數(shù)。根據(jù)以上對比，選用增量式光電編碼器是最佳的選

43、擇。在本文中選用歐姆龍增量式光電編碼器e6b2-cwz6b，其分辨率為1024脈沖/轉(zhuǎn)。（2）增量式光電編碼器的測速原理及應(yīng)用增量式光電編碼器輸出兩個互差的方波信號為a、b，每轉(zhuǎn)一周每個信號輸出n個脈沖。a、b信號的相位關(guān)系體現(xiàn)了光電編碼器旋轉(zhuǎn)方向。當(dāng)光電編碼器順時針旋轉(zhuǎn)時，a超前b；逆時針旋轉(zhuǎn)時，b超前a。辨向電路通過a、b的相位關(guān)系來判斷旋轉(zhuǎn)方向，并且據(jù)此決定當(dāng)一個計數(shù)脈沖出現(xiàn)時應(yīng)該對當(dāng)前計數(shù)值加1還是減1。圖2.3是增量式光電編碼器的輸出波形。bzzbaa （a）碼盤正轉(zhuǎn)時 (b)碼盤反轉(zhuǎn)時圖2.3 增量式光電編碼器的輸出波形由以上的波形圖可以看出整個測速步驟有兩個：1）脈沖鑒相；2）脈

44、沖計數(shù)。1）脈沖鑒相脈沖鑒相的方法比較多，既可以用軟件實現(xiàn)，也可以用一個d觸發(fā)器實現(xiàn)11。本文采用的是采用d觸發(fā)器來實現(xiàn)脈沖的鑒相，其工作的原理如圖2.4所示：w3w4w2bw1a （a）原理電路 （b）波形（順時針）圖2.4 鑒相電路及其相應(yīng)波形其中d觸發(fā)器實現(xiàn)鑒相，異或門從a、b信號產(chǎn)生計數(shù)脈沖，起到倍頻的作用所以精度為2nppr，最大的的脈沖頻率是nn/30hz,其中n是轉(zhuǎn)速（r/min）。增量式光電編碼器順時針旋轉(zhuǎn)時，信號a超前b ，如圖2.4（b）所示，d觸發(fā)器輸出q非（波形w1）為高電平，q（波形w2）為低電平，則下面的與非門開通，計數(shù)脈沖通過（波形w3），送至計數(shù)器輸入端，進(jìn)行加

45、法計算。此時上面的與非門關(guān)閉，其輸出為高電平(波形w4)。當(dāng)光電編碼器逆時針旋轉(zhuǎn)時，情況相反。2）脈沖計數(shù)增量式光電編碼器除直接用于測量角位移外，常用來測量轉(zhuǎn)軸的轉(zhuǎn)速。其轉(zhuǎn)速檢測的方案主要有以下幾個方法12：m法，通過測量在一段固定的時間間隔內(nèi)的的編碼器脈沖數(shù)來計算轉(zhuǎn)速，適用于高速場合。t法，通過測量相鄰脈沖間的時間間隔來計算轉(zhuǎn)速，適用于低速場合。m/t法，通過同時測量光電編碼器輸出脈沖的數(shù)目m和時間間隔t，相除后獲得轉(zhuǎn)速，適用于轉(zhuǎn)速動態(tài)范圍較大的場合。但是對于低速，該方法需要較長的檢測時間才能保證結(jié)果的準(zhǔn)確性，無法滿足轉(zhuǎn)速檢測系統(tǒng)的快速動態(tài)響應(yīng)指標(biāo)。由于深海機器人的行走速度為0.5m/s，屬

46、于低速的場合，所以選用t法進(jìn)行測量。編碼器脈沖m圖2.5 t法測速原理圖假設(shè)時鐘頻率為，光電編碼器每轉(zhuǎn)脈沖數(shù)為，為對時鐘脈沖的計數(shù)值。則由圖2.5可以得到轉(zhuǎn)速： 公式 (2.1)相對誤差為： 公式 (2.2)由于在控制系統(tǒng)中編碼器的轉(zhuǎn)速具有不可預(yù)見性，造成脈沖周期t具有不確定的特點，所以為了提高光電編碼器的測量精度，本文采用了光電編碼器的四倍頻的電路設(shè)計13。詳細(xì)觀察圖2.3可發(fā)現(xiàn)，在脈沖周期t內(nèi)，a、b兩相信號共產(chǎn)生了四次變化，盡管t不確定，但由于a、b兩相信號之間相位關(guān)系確定，使這四次變化在相位上的平均分布。如果利用這四次變化產(chǎn)生四倍頻信號，則可以實現(xiàn)光電編碼器測量精度的提高。四倍頻電路的

47、設(shè)計關(guān)鍵在于鑒別出a、b信號的上升沿和下降沿。鑒別信號上升沿和下降沿的方法有很多，但其實質(zhì)是一樣的，其原理圖如圖2.6所示，輸入信號異或后，就可得到倍頻的信號。而對于延時的處理方法也很多，如圖2.7所示。微分電路其信噪比小，抗干擾性差，積分型電路可以提高信噪比，但和微分型電路一樣有致命的缺點：當(dāng)輸入信號嚴(yán)重變形；對于各路倍頻電路來說，電阻和電容的參數(shù)不可能完全一致，所以倍頻后的各路脈沖寬度不等，而且寬度的調(diào)節(jié)也比較困難。因此本文采用數(shù)字型延時電路可以很好的克服以上延時電路的缺點，延時的時間和各電路倍頻的脈沖寬度由時鐘控制，倍頻后脈沖寬度均勻一致。out延時異或門 （a）倍頻原理 (b)倍頻波形

48、 圖2.6 倍頻電路原理圖outclkdq (a)微分型 （b）積分型 （c）數(shù)字型圖2.7 延時電路綜上所述，可以設(shè)計以下四倍頻電路原理圖如圖2.8所示以及所得的四倍頻波形如圖2.9所示。 圖2.8 增量式光電編碼器四倍頻電路原理圖其中clk的頻率應(yīng)大于a或b相的脈沖頻率，ba圖2.9 增量式光電編碼器四倍頻波形2. 數(shù)字羅盤(1)數(shù)字羅盤的分類及其工作原理目前世界上常用的指向設(shè)備有用電羅經(jīng)、磁羅經(jīng)、磁通門和磁阻傳感器。由于電羅經(jīng)啟動后需要較長的時間才能穩(wěn)定、陀螺球轉(zhuǎn)速高、磨損大、壽命短、價格高、故障多、需大功率電源供應(yīng)等諸多缺點造成使用上的不便，而磁通門雖然靈敏度高、起動快，但其體積大、價

49、格高、結(jié)構(gòu)復(fù)雜，不適合小型化和高可靠性的要求。磁傳感器本身是固定態(tài)的，電阻的體積可以做的很小且沒有活動部件，功耗也很低，配合選用體積小功耗低的外圍器件可以將磁阻羅盤微型化，已有逐步取代磁通門的趨勢。圖2.10是磁阻傳感器及其工作原理。（a）磁阻傳感器工作原理（b）磁阻傳感器圖2.10 磁阻傳感器及其工作原理磁阻傳感器利用的是鎳鐵合金的電阻對某一個方向的磁場敏感的原理。在鐵磁性材料中會發(fā)生磁阻的各向異性（amr），當(dāng)沿著一條長而薄的鐵磁合金帶的長度方向施加一個電流，在垂直于電流的方向施加一個磁場，合金帶自身的阻值會發(fā)生變化。磁阻傳感器由四個磁阻組成了惠斯通電橋。其中供電電源為vb，在電阻中有電流

50、流過。且在電橋上施加一個偏置磁場h，使得兩個相對放置的電阻的磁化方向朝著電流方向轉(zhuǎn)動，引起電阻阻值增加；另外兩個相對放置的電阻的磁化方向背向電流方向轉(zhuǎn)動，引起電阻阻值減少。在線性區(qū)域輸出和外加磁場成正比（v=shvb）。靈敏度s 和傳遞函數(shù)的線性區(qū)成反比。方位角是物體從地理上的“北極”繞垂直于水平面的軸的轉(zhuǎn)角，或物體從“磁北”繞垂直于水平面的軸的轉(zhuǎn)角m，且，m均是順時針旋轉(zhuǎn)為正。如果地磁矢量h在水平面的投影分別為hx，hy，則有14： 公式 (2.3) 公式 (2.4)這時可以由下式計算運載體的磁角方位角： 公式 (2.5)對于載體方位角可以通過歐拉角描述固定坐標(biāo)系oxyz和運動坐標(biāo)之間的關(guān)系

51、（見圖2.11）。這里規(guī)定，運動坐標(biāo)系是由固定坐標(biāo)系oxyz先繞z軸旋轉(zhuǎn)角度m，得到坐標(biāo)系，然后再繞軸旋轉(zhuǎn)角度，得到坐標(biāo)系，最后繞軸旋轉(zhuǎn)角度得到坐標(biāo)。這里涉及的三次旋轉(zhuǎn)都按右手法則，例如，繞oz軸旋轉(zhuǎn)時，由ox軸向oy軸方向旋轉(zhuǎn)為正，反之為負(fù)。此時，三個角度：m為定義為磁方位角，定義為橫滾角，定義為俯仰角。旋轉(zhuǎn)順序 圖2.11 坐標(biāo)變換圖因為方向余弦矩陣是正交矩陣，它的逆矩陣存在且就等于它自身的轉(zhuǎn)置矩陣。所以從到oxyz的逆過程的轉(zhuǎn)換關(guān)系如下： 公式（2.6） 公式（2.7） 公式（2.8）由式（2-4）（2-5）（2-6）可得 公式（2.9） 公式（2.10） 由式（2-3）得到方位角為 公

52、式（2.11）由式（2-9）方位角的計算公式可以看出，在捷聯(lián)方位測量系統(tǒng)中并不需要知道各個分量之間的比例關(guān)系就可以進(jìn)行方位解算。(2)數(shù)字羅盤hmr3000的應(yīng)用磁場基于磁阻傳感器hmr3000羅盤模塊的數(shù)字羅盤經(jīng)系統(tǒng)以其價格便宜、操作簡單、具有數(shù)字化接口、便于數(shù)據(jù)處理等優(yōu)勢，在船舶導(dǎo)航中得到越來越普的應(yīng)用15。hmr3000是一款集航向、俯仰和橫滾三個旋轉(zhuǎn)量測量于一體的磁敏傳感器，由三軸磁阻傳感器和一個充有液體的兩軸傾斜傳感器組成，可以得到進(jìn)行傾斜補償后的航向數(shù)據(jù)，并且?guī)в须娮悠胶饧?，其航向角度的精確度可以達(dá)到，俯仰和翻滾方向的精度可以達(dá)到，分辨率達(dá)到，即使在傾斜達(dá)到時，也能給出精確的航向角

53、。其內(nèi)部全部采用貼片元件，不含任何移動元件，非常堅固可靠，并且其輸入電壓范圍廣、功耗低、體積小，適合安裝在各種平臺上使用。圖2.12是hmr3000的原理圖。ascii輸出微處理器傳感器傾斜磁阻iir濾波器航向計算非線性濾波器rs232rs485圖2.12 hmr3000原理圖hmr3000數(shù)字羅盤由內(nèi)置單片機控制傳感器的測量時序，所有控制hmr3000操作的參數(shù)都存儲在內(nèi)置eeprom中1617。hmr3000可以配置數(shù)字羅盤輸出3類nmea標(biāo)準(zhǔn)語句（hdg、hdt和xdr），3類專用語句（hpr、rcd和ccd），并且在數(shù)據(jù)輸出前有一串a(chǎn)scii字符頭信息。它與外界通信的接口簡單，用標(biāo)準(zhǔn)的

54、rs-232 t型頭接口，采用串行通信的方法，為傳輸波特率可選擇從1200bit/s到38 400bit/s，可以方便的采集數(shù)據(jù)，供cpu處理。 由于hmr3000與外部的通信通過rs-232接口或rs-485接口，因此不能直接與arm進(jìn)行通信，必須通過數(shù)據(jù)轉(zhuǎn)換電路進(jìn)行通信。hmr3000數(shù)字羅盤上自帶有標(biāo)準(zhǔn)的d型9針插頭，可以利用該插頭通過max3232芯片，連接到arm的串口。這里需注意的是，在使用串口連接arm時，hmr3000的9針串口的2、3管腳經(jīng)常會出現(xiàn)連接錯誤。這主要是因為hmr3000的輸出數(shù)據(jù)在連接到d型插頭時，為了方便和pc機的連接已經(jīng)調(diào)換了2、3腳的順序，因此只要將hmr3000的2、3腳按順序連接到對應(yīng)的管腳就可以了。當(dāng)hmr3000采用不同的電源時，其rs232有兩種不同的接法，如圖2.13所示。gnd 5tx 3rx 29 v+5 gnd3 rx2 txhmr3000接口未經(jīng)穩(wěn)壓電源6-15v dcarm接口（a） 接入未經(jīng)穩(wěn)壓的電源8 v+5 gnd3 rx2 txgnd