亚洲免费av电影一区二区三区,日韩爱爱视频,51精品视频一区二区三区,91视频爱爱,日韩欧美在线播放视频,中文字幕少妇AV,亚洲电影中文字幕,久久久久亚洲av成人网址,久久综合视频网站,国产在线不卡免费播放

        ?

        基于STM32的無人船控制系統(tǒng)設(shè)計與實現(xiàn)

        2019-10-29 08:55:44
        計算機測量與控制 2019年10期
        關(guān)鍵詞:系統(tǒng)

        (陜西科技大學(xué) 電氣與控制工程學(xué)院,西安 710021)

        0 引言

        無人船(Unmanned Surface Vehicles, USV)是一種具有自主航行能力,并且可自主實現(xiàn)環(huán)境感知、目標(biāo)探測等任務(wù)的智能化水面機器人[1-2]。其在民用與軍用上都具有重要作用,可以代替人們在水面完成危險、繁重的任務(wù),因此無人船受到越來越廣泛的關(guān)注[3]。國際上以美國為首的幾個國家在無人船研究方面起步較早,最初主要以軍用無人船為主。隨著科學(xué)技術(shù)的突飛猛進,無人船也由半自動化向智能化發(fā)展,由軍用向民用發(fā)展[4]。目前國外的無人船技術(shù)較為成熟,相比之下,我國的無人船控制技術(shù)還有很大提升空間,許多關(guān)鍵領(lǐng)域的難題還需要攻克[5]。

        無人船要想在復(fù)雜多變的環(huán)境中安全有效地完成人們指定的任務(wù),就必須實現(xiàn)穩(wěn)定可靠的自主航行功能[6]。常用的自主導(dǎo)航方式有:慣性導(dǎo)航[7]、天文導(dǎo)航[8]、特征匹配[9]等,這些單一的導(dǎo)航方式容易受到干擾,因此需要使用組合導(dǎo)航方式以實現(xiàn)更精確的導(dǎo)航效果[10]。在無人船自主航行方面,能夠?qū)崿F(xiàn)高效率的路徑跟蹤是非常重要的,其準(zhǔn)確性的提高與采用的控制方法密切相關(guān)。目前常用的控制方法有PID控制,神經(jīng)網(wǎng)絡(luò),模糊控制等,由于這些算法或多或少存在一些不足,所以在實際應(yīng)用中還需要將這些方法做些改進。

        無人船的控制主要是通過嵌入式編程和通信技術(shù)相結(jié)合實現(xiàn)的,經(jīng)過各個模塊之間的配合完成一系列任務(wù)。本文設(shè)計了一種基于STM32的無人船控制系統(tǒng),使用GPS/IMU(Inertial measurement unit,慣性測量單元)組合導(dǎo)航方式,通過自抗擾控制技術(shù)控制無人船的航向,結(jié)合4G通信技術(shù)實現(xiàn)了無人船的遠程操控以及路徑跟蹤的功能。

        1 總體方案設(shè)計

        本設(shè)計以實現(xiàn)無人船的自主導(dǎo)航為目標(biāo),使船只能夠沿已經(jīng)規(guī)劃好的路徑前行,完成無人船的路徑跟蹤任務(wù)。本系統(tǒng)以全球定位系統(tǒng)與捷聯(lián)慣導(dǎo)系統(tǒng)相結(jié)合作為無人船的導(dǎo)航定位部分;以STM32作為主控芯片,集成了無人船的直流電機、電源顯示、信息采集等模塊的工作;以4G網(wǎng)絡(luò)為傳播媒介,可實現(xiàn)無人船的遠程操控以及實時監(jiān)視的功能,并且開發(fā)了上位機軟件,可在手機上安裝該軟件,操作極其方便,如圖1所示為該系統(tǒng)的方案設(shè)計。

        2 系統(tǒng)硬件設(shè)計

        無人船控制系統(tǒng)主要由導(dǎo)航定位模塊、人機交互模塊、電機控制模塊、4G通信模塊等幾部分組成,選取STM32F103作為主控芯片,圖2所示為該系統(tǒng)的硬件結(jié)構(gòu)圖。

        圖2 硬件結(jié)構(gòu)圖

        從圖中可以看到系統(tǒng)使用了兩個STM32F103控制芯片,左邊的STM32芯片主要用來讀取數(shù)據(jù),并且會對GPS及IMU的數(shù)據(jù)進行相關(guān)處理;右邊的STM32芯片主要用來控制無人船運動,可通過CAN總線控制電機驅(qū)動;4G模塊可以上網(wǎng),實現(xiàn)無人船的遠程操控功能;其他硬件如指示燈等可以顯示無人船的各種狀態(tài)。

        2.1 GPS/IMU組合導(dǎo)航模塊

        考慮到實用性與精確性,所選取的GPS模塊的型號為GYGPSV1-7M,其主芯片是ublox芯片,穩(wěn)定性高、應(yīng)用廣泛。模塊的供電電壓為3 V和5 V均可,本次設(shè)計采用5 V供電。為了提高信息處理速率將該模塊的波特率設(shè)置為115 200 bps,將信息刷新頻率設(shè)置為5 Hz。該模塊主要通過串口通信方式實現(xiàn)其與STM32之間的數(shù)據(jù)傳輸,且?guī)в蠩EPROM掉電保存參數(shù)數(shù)據(jù)的功能和專用的數(shù)據(jù)備份電池。

        系統(tǒng)使用的IMU模塊型號為Mini IMU AHRS,該模塊由3軸磁力計、3軸角速率、3軸加速度及氣壓高度計組成,可以更全面地獲取載體的當(dāng)前狀態(tài)。MiniIMU的控制器可以運行在72 M的主頻上,擁有更快的處理速度,傳感器通過I2C接口與控制器連接,可以在第一時間讀取最新的數(shù)據(jù),快速響應(yīng)姿態(tài)變化。IMU模塊工作電壓為4.0~7.0 V,本設(shè)計使用5 V工作電壓,該模塊通過串口向外界發(fā)送信息,波特率設(shè)置為115 200 bps。

        如圖2所示,GPS和IMU模塊都是通過串口連接到數(shù)據(jù)采集板上。將數(shù)據(jù)獲取后,STM32便會進一步解算數(shù)據(jù),使無人船的定位信息更加準(zhǔn)確,之后再將該信息通過CAN總線發(fā)送給運動控制板,以便進行下一步操作。

        2.2 電機驅(qū)動模塊

        電機驅(qū)動在無人船的運動控制中尤為重要,STM32通過電機驅(qū)動器來控制無人船的左右推進器,進而影響其運動狀態(tài)。系統(tǒng)選取的驅(qū)動器為RMDS-402有刷伺服電機驅(qū)動器,該驅(qū)動器的供電電壓為10~58 V,本次設(shè)計使用12 V供電電壓。其通信方式有CAN總線通信、RS485通信及RS232通信等方式,由于CAN總線適用于大數(shù)據(jù)量、短距離通信,可在多主多從或者各個節(jié)點平等的現(xiàn)場中使用,所以本次選用CAN總線通信方式效率最高。

        運動控制板將接收來的信息經(jīng)過一系列計算,通過CAN總線發(fā)送給電機驅(qū)動器相應(yīng)指令,驅(qū)動器再通過改變PWM的值來改變直流電機的速度。因為船只上有兩個推進器,所以需要兩個驅(qū)動器來分別控制對應(yīng)的推進器,使無人船的運動狀態(tài)發(fā)生改變。

        2.3 4G通信模塊

        本系統(tǒng)使用的4G通信模塊是華為公司生產(chǎn)的型號為ME909s-821的模塊,它的工作頻段為1 800 MHz或900 MHz,電源供電電壓為3.4~4.7 V。該模塊有很多外圍接口,包括LGA接口、UART接口、USB接口、USIM卡接口、GPIO接口等,模塊與控制器之間采用串口通信模式,波特率設(shè)置為115 200 bps。使用時把SIM卡插好,一切準(zhǔn)備就緒,將4G天線引出豎直向上放到無人船的外面,有利于信號遠距離傳輸。

        2.4 供電部分

        由于系統(tǒng)使用的硬件模塊較多,所需供電電壓有多種,因此需要設(shè)計合理的供電系統(tǒng)。經(jīng)過多方面考慮,無人船采用額定電壓為24 V的蓄電池供電。當(dāng)無人船全速前進時所需電流較大,因此將兩個相同的蓄電池并聯(lián)安裝,這樣不僅可以使船只有足夠的動力還可以延長船只運行時間。

        為了將蓄電池的供電合理應(yīng)用在無人船各個硬件模塊上,需要將24 V電壓依次轉(zhuǎn)換成12 V、5 V、3.3 V等,12 V電壓主要給推進器供電,5 V電壓給GPS、IMU等模塊供電,3.3 V電壓主要給主芯片供電,如圖3所示為系統(tǒng)電源轉(zhuǎn)換部分的原理圖。

        除了以上主要模塊之外,整個系統(tǒng)還設(shè)計了指示燈、液晶屏等硬件部分用來顯示無人船當(dāng)前狀態(tài)和電量等信息,這樣不僅可以方便人們隨時觀察,還起到了美化船只外觀的作用。

        3 系統(tǒng)軟件設(shè)計

        3.1 GPS/IMU的數(shù)據(jù)融合

        本系統(tǒng)采用松組合方式來實現(xiàn)GPS與IMU的數(shù)據(jù)融合,該方式具有結(jié)構(gòu)簡單,易于實現(xiàn)等優(yōu)點[11],主要是將GPS和IMU分別測出的位置或速度信息通過卡爾曼濾波器實現(xiàn)數(shù)據(jù)融合,并且融合后的信息還會反饋回IMU,以達到消除捷聯(lián)慣導(dǎo)系統(tǒng)累積誤差的目的,其結(jié)構(gòu)原理如圖4所示。

        圖4 GPS/IMU松組合結(jié)構(gòu)框圖

        卡爾曼濾波器的輸入為組合導(dǎo)航的量測值,輸出為捷聯(lián)慣導(dǎo)系統(tǒng)的估計誤差值,其完整遞推過程如下所示:

        式(1)是狀態(tài)預(yù)測方程,其中Xk/k-1為上一狀態(tài)的預(yù)測結(jié)果,Φk/k-1為系統(tǒng)參數(shù),Xk-1為上一狀態(tài)的最優(yōu)結(jié)果:

        Xk/k-1=Φk/k-1Xk-1

        (1)

        式(2)為預(yù)測方差陣,其中Pk/k-1是Xk/k-1對應(yīng)的協(xié)方差,Pk-1是Xk-1對應(yīng)的協(xié)方差,Γk-1是系統(tǒng)參數(shù),Qk-1是系統(tǒng)過程的協(xié)方差:

        (2)

        式(3)是卡爾曼濾波增益,Kk為卡爾曼增益,Hk是系統(tǒng)參數(shù),Rk是為噪聲的協(xié)方差:

        (3)

        式(4)為狀態(tài)估計觀測更新,其中Xk是當(dāng)前狀態(tài)的最優(yōu)化估計值,Zk為系統(tǒng)的測量值:

        Xk=Xk/k-1+Kk(Zk-HkXk/k-1)

        (4)

        式(5)是估計均方差,其中Pk是Xk的協(xié)方差:

        Pk=(I-KkHk)Pk/k-1

        (5)

        3.2 無人船路徑跟蹤

        要實現(xiàn)無人船的路徑跟蹤,使船只可以從任意初始位置駛?cè)腩A(yù)先規(guī)劃好的路徑,在該過程中,主要通過控制船只的航向來實現(xiàn)無人船路徑跟蹤目的,故設(shè)計合理的航向控制器至關(guān)重要。

        自抗擾控制器(Active Disturbance Rejection Control,ADRC)是一種不依賴被控對象精確模型的、能夠替代PID控制技術(shù)的新型實用數(shù)字控制技術(shù)。該控制器可以很好地控制無人船航向,通過規(guī)劃好的路徑與實際船舶位置的對比可以得到無人船的期望航向,將期望航向作為輸入,實際測量航向作為輸出,經(jīng)過控制器的作用使無人船實現(xiàn)路徑跟蹤的目的。

        自抗擾控制器主要由跟蹤微分器、擴張狀態(tài)觀測器、狀態(tài)誤差反饋控制律與擾動估計補償四部分組成[12],本次使用的是二階控制器,其結(jié)構(gòu)如圖5所示。

        圖5 自抗擾控制器

        式(6)和(7)為微分跟蹤器,其中v為系統(tǒng)輸入,即目標(biāo)航向,v1為v的跟蹤信號,v2是v1的微分,fhan(·)為最速綜合函數(shù),參數(shù)r為控制量增益,決定了跟蹤速度,h和h0都為采樣步長:

        v1(k+1)=v1(k)+hv2(k)

        (6)

        v2(k+1)=v2(k)+hfhan(v1(k)-v,v2(k),r,h0)

        (7)

        式(8)~(11)為擴張狀態(tài)觀測器,其中參數(shù)β01,β02,β03都是由采樣步長來決定的,y為系統(tǒng)輸出,即實際航向,fal(·)是一種特殊的非線性結(jié)構(gòu)的濾波器:

        e=z1(k)-y(k)

        (8)

        z1(k+1)=z1(k)+h(z2(k)-β01e)

        (9)

        z2(k+1)=z2(k)+h(z3(k)-β02fal(e,0.5,h)+bu(k))

        (10)

        z3(k+1)=z3(k)-hβ03fal(e,0.25,h)

        (11)

        式(12)~(14)為非線性組合:

        e1=v1(k)-z1(k)

        (12)

        e2=v2(k)-z2(k)

        (13)

        u0=β01fal(e,0.5,h)+β02fal(e,0.25,h)

        (14)

        式(15)為擾動補償?shù)目刂屏?

        u(k)=u0-z3/b

        (15)

        3.3 上位機監(jiān)控軟件設(shè)計

        無人船上位機軟件是基于Android系統(tǒng)采用Java語言開發(fā)的,這款A(yù)pp適用于Android 5.0以上的手機,穩(wěn)定性好,其運行界面如圖6所示。

        圖6 上位機軟件

        無人船上位機軟件主要由以下幾部分組成:

        1)地圖顯示區(qū):該軟件添加了高德地圖應(yīng)用,可以用來顯示船只的航行情況,包括位置、軌跡等信息。

        2)船只狀態(tài)顯示:當(dāng)無人船通過網(wǎng)絡(luò)與手機軟件成功連接上之后,軟件主頁就會顯示該船只的名字、電量、功率、行駛速度等信息,方便用戶更直觀地了解無人船的當(dāng)前情況。

        3)路徑設(shè)置:用戶可通過手機觸屏在地圖上為船只設(shè)置預(yù)定路徑,設(shè)置好后,軌跡的經(jīng)緯度會通過4G網(wǎng)絡(luò)傳給無人船,之后點擊“開始導(dǎo)航”,無人船就可以按照預(yù)設(shè)路徑進行導(dǎo)航。

        4)導(dǎo)航模式:自動導(dǎo)航模式下,地圖上會顯示兩條顏色不同的路徑,一條是設(shè)置好的預(yù)定路徑,另一條則是無人船的實際路徑,方便用戶觀察。在自動導(dǎo)航過程中,用戶可以隨時退出無人船的導(dǎo)航模式。

        5)遙控模式:該模式下是把手機當(dāng)做遙控器來控制無人船的行駛狀態(tài),可控制無人船的前進、后退、轉(zhuǎn)彎、停止等。

        6)其他信息顯示:該軟件會在歷史數(shù)據(jù)中保留每一次船只的運行狀態(tài),包括時間、航速、路徑等信息,用戶也可以手動刪除這些信息。如果船上裝了水質(zhì)模塊、雷達等,軟件也會相應(yīng)的顯示這些信息。

        4 系統(tǒng)測試結(jié)果與分析

        為測試所設(shè)計的無人船控制系統(tǒng)的可行性和穩(wěn)定性,在西安豐慶公園的人工湖里進行了多次測試。在做測試之前,需要準(zhǔn)備的有:確保無人船的所有硬件模塊可以正常工作,各個接口供電正常,顯示屏與指示燈反應(yīng)的船只狀態(tài)要在正常范圍內(nèi)。檢查上位機軟件能否正常運行,保證該軟件可以通過4G網(wǎng)絡(luò)連接到無人船的4G模塊上,確保蓄電池電量充足等。

        4.1 航向跟蹤測試

        可以通過上位機軟件給無人船發(fā)送目標(biāo)航向,無人船再通過航向控制器自動調(diào)節(jié)船體后面的推進器以達到控制無人船航向的目的,使船只可以保持在期望航向上。

        將目標(biāo)航向角設(shè)置為200°作為無人船的航向跟蹤測試,圖7為無人船實際航向變化,從圖中可以看到無人船接收到指令時航向是100°左右,接著便會向目標(biāo)航向調(diào)節(jié),20 s之后,可以穩(wěn)定在期望航向200°了,之后以該航行角繼續(xù)前行。如圖8所示為無人船實際航向角與期望航向角的航向差,從20 s之后計算無人船航向差的均方差為2.18°,說明航向控制效果較好。

        圖7 無人船航向變化

        圖8 航向差

        4.2 路徑跟蹤實驗

        可通過上位機軟件向無人船發(fā)送多個位點的坐標(biāo),其中相鄰的位點可確定一條路徑。本次測試共有4個位點,因此是3條路徑,其方向則是從前一位點指向后一位點。無人船接收到指令后,再通過控制系統(tǒng)調(diào)節(jié)左右推進器使船只能夠沿著期望路徑行駛。

        試驗設(shè)置的4個位點分別為:E108.898789°,N34.247206°;E108.898816°,N34.247089°;E108.899009°,N34.247105°;E108.898958°,N34.247251°。圖9所示為無人船的路徑跟蹤航跡圖,圖10為無人船的實際位置與期望路徑的垂直距離。由圖9、10可知完成本次路徑跟蹤測試,無人船共行駛了約2 min,從實際位點到期望初始位點約10 s,在整個跟蹤過程中計算的垂直距離均方差為0.53 m,因此在路徑跟蹤上無人船控制效果較好。

        圖10 路徑跟蹤距離差

        通過對無人船的航向跟蹤與路徑跟蹤的測試結(jié)果分析,本無人船控制系統(tǒng)具有較好的可行性與穩(wěn)定性。

        5 結(jié)束語

        本次設(shè)計的基于STM32無人船導(dǎo)航控制系統(tǒng),采用了GPS/IMU組合導(dǎo)航實現(xiàn)了無人船的精確定位,通過設(shè)計自抗擾控制器實現(xiàn)了無人船的航向控制及路徑跟蹤的目的。系統(tǒng)各個模塊分工明確運行穩(wěn)定,經(jīng)測試表明無人船的控制效果較好,實際路徑與預(yù)設(shè)路徑偏差小,達到了預(yù)期目標(biāo)。設(shè)計了基于Java開發(fā)的上位機軟件,其界面友好、功能實用可以安裝在手機上,方便人員使用,并結(jié)合4G網(wǎng)絡(luò)完成上位機與無人船之間的通信,實現(xiàn)了人機交互功能。本文通過對無人船遠程操控及自主導(dǎo)航的測試,獲得了大量研究數(shù)據(jù),證實了本系統(tǒng)的有效性及可行性,為該項目的后續(xù)研究奠定了基礎(chǔ)。

        猜你喜歡
        系統(tǒng)
        Smartflower POP 一體式光伏系統(tǒng)
        WJ-700無人機系統(tǒng)
        ZC系列無人機遙感系統(tǒng)
        北京測繪(2020年12期)2020-12-29 01:33:58
        基于PowerPC+FPGA顯示系統(tǒng)
        基于UG的發(fā)射箱自動化虛擬裝配系統(tǒng)開發(fā)
        半沸制皂系統(tǒng)(下)
        FAO系統(tǒng)特有功能分析及互聯(lián)互通探討
        連通與提升系統(tǒng)的最后一塊拼圖 Audiolab 傲立 M-DAC mini
        一德系統(tǒng) 德行天下
        PLC在多段調(diào)速系統(tǒng)中的應(yīng)用
        国产精品亚洲国产| 女人18毛片aa毛片免费| 亚洲日本国产精品久久| 人妻少妇不满足中文字幕| 18无码粉嫩小泬无套在线观看 | 色婷婷精品午夜在线播放| 97精品人人妻人人| 竹菊影视欧美日韩一区二区三区四区五区 | 亚洲一卡2卡3卡4卡5卡精品| 国产v视频| 国产av熟女一区二区三区老牛| 亚洲av免费不卡在线观看| a级毛片免费完整视频| 亚洲一区综合精品狠狠爱| 精品少妇白浆一二三区| 国产精品国产三级国产av中文| 亚洲av无码一区二区三区人妖 | 校园春色日韩高清一区二区| 亚洲av片在线观看| 国产精品久久国产精品99gif| 亚洲一区精品一区在线观看| 极品一区二区在线视频观看| 日韩亚洲欧美中文在线| 少妇无码av无码去区钱| 视频一区中文字幕在线观看| 欧美颜射内射中出口爆在线| 色伦专区97中文字幕| 西西人体大胆视频无码| 中文国产乱码在线人妻一区二区| 国产免费爽爽视频在线观看| 成年人黄视频大全| 国产精品一级黄色大片| 日韩在线 | 中文| 免费观看又污又黄的网站| aⅴ色综合久久天堂av色综合| 精品国产精品三级在线专区| 日本japanese丰满多毛| 91情侣视频| 日韩av一区二区不卡在线| 色婷婷五月综合久久| 亚洲熟妇无码久久精品疯|