專利名稱:一種植保無人機專用飛控系統(tǒng)的制作方法
【專利摘要】本實用新型涉及一種植保無人機專用飛控系統(tǒng),包括無人機植保綜合管理模塊、高度控制子模塊、航路導航控制子模塊，噴霧控制子模塊。植保綜合管理模塊管理航路導航、噴霧作業(yè)、飛行高度控制以及作業(yè)參數(shù)設定等交互功能；高度控制子模塊測量無人機距離作物冠層的距離，并保持無人機的作業(yè)高度，降低自然風影響而產(chǎn)生的霧滴飄失，保證了作業(yè)效果；航路導航控制子模塊使無人機沿預設作業(yè)航路飛行，做到精確導航；噴霧控制子模塊依據(jù)無人機的作業(yè)位置實時控制植保作業(yè)開關，有效避免農(nóng)藥的漏噴和重噴。本發(fā)明實現(xiàn)了植保無人機的自主飛行控制，鉛垂升力與水平推力的驅(qū)動解耦保證控制系統(tǒng)的簡單可靠，減輕操作人員的勞動強度，避免農(nóng)藥漏噴或重噴。
【專利說明】一種植保無人機專用飛控系統(tǒng)

【技術領域】
[0001]本實用新型屬于農(nóng)用航空植保領域，涉及一種針對驅(qū)動解耦植保無人機平臺的飛控系統(tǒng)，使之具備沿預設的飛行航路進行植保作業(yè)，保持作業(yè)高度，避免出現(xiàn)農(nóng)藥漏噴、重噴或嚴重霧滴飄失。
技術背景
[0002]與傳統(tǒng)的田間人工噴灑農(nóng)藥作業(yè)相比，植保無人機噴灑農(nóng)藥有著非常明顯的優(yōu)勢:無人機作業(yè)效率高，農(nóng)藥對作業(yè)人員的危害較小，大幅度減小作業(yè)人員的勞動強度，霧滴漂移少，霧流對農(nóng)作物的穿透性明顯加強，對病蟲草害防治效果良好，無人機不需要專用的升降場地，機動性能良好。同時也推動了我國農(nóng)業(yè)機械化、數(shù)字化的發(fā)展進程。
[0003]植保無人機施藥時，需穩(wěn)定在距離作物2?3米的高空上平穩(wěn)低速飛行并噴灑藥液。目前植保無人機多采用遙控直升機或多旋翼無人機作為作業(yè)平臺。無人直升機結(jié)構(gòu)復雜，其飛行過程中存在鉛垂方向升力和水平推力耦合問題，一方面加大了直升機機械結(jié)構(gòu)和控制算法的復雜性，另一方面也提高其遙操作的復雜性，因此需要對無人機遙控者進行專業(yè)培訓。多旋翼無人機作為植保作業(yè)平臺，其載重相對直升機小的多，主要原因是采用了多個小尺寸螺旋槳，效率低，而且由于電源不能過大，其持續(xù)作業(yè)時間較短。因此在多旋翼無人機作業(yè)過程中需要多次的返回加藥和更換電池，工作效率低，也造成了能源的浪費。
[0004]一種驅(qū)動解耦的無人機平臺有效的解決了現(xiàn)有無人機結(jié)構(gòu)復雜，操作困難，負載低的問題。所謂驅(qū)動解耦植保無人機平臺僅需要實現(xiàn)鉛垂方向升降運動、一定飛行高度下的平面運動。無人機平臺在高度上的升降僅由其鉛垂方向的大旋翼提供升力，而無人機平臺相對機身前后方向運動僅由左右兩個小旋翼提供推力，無人機平臺相對機身左右方向運動僅由前后兩個小旋翼提供推力，因此該無人機平臺的驅(qū)動力是完全解耦的。該平臺極大地適應了無人機作為專業(yè)植保平臺的作業(yè)需求。
[0005]現(xiàn)有植保無人機大多是人工遙控操作的，不帶自動導航系統(tǒng)，噴灑藥液的準確性差，漏噴現(xiàn)象時有發(fā)生。而基于GPS導航的無人機飛控系統(tǒng)控制無人機沿預設的飛行航路進行植保作業(yè)，但其植保過程中易出現(xiàn)的航路誤差或作業(yè)高度不穩(wěn)定，從而極大地影響植保作業(yè)效果，極易造成農(nóng)藥漏噴、重噴或霧滴飄失嚴重?，F(xiàn)有無人機飛控系統(tǒng)無法適應驅(qū)動解耦的無人機平臺進行植保作業(yè)的需求，因而無法直接配置應用到此類驅(qū)動解耦的植保無人機上作為其植保飛行控制系統(tǒng)。
[0006]綜上所述，針對現(xiàn)有植保無人機存在的問題和不足，發(fā)明一種針對低成本、高負載、驅(qū)動解耦植保無人機的飛控系統(tǒng)具有非常重要的實際意義。


【發(fā)明內(nèi)容】

[0007]針對現(xiàn)有各種植保無人機平臺存在的不足，克服現(xiàn)有飛控導航系統(tǒng)無法直接應用于驅(qū)動解耦的植保無人機平臺，本實用新型提供了一種適合于驅(qū)動解耦植保無人機平臺的飛控系統(tǒng)，并使之不僅具備依據(jù)設置的作業(yè)路線進行導航，而且在作業(yè)過程中使無人機保持預定的噴藥高度的特點。
[0008]本實用新型一種植保無人機專用飛控系統(tǒng)采用的技術方案:包括無人機植保綜合管理模塊、高度控制子模塊、航路導航控制子模塊，噴霧控制子模塊。所述無人機植保綜合管理模塊作為整個無人機控制的核心，管理航路導航控制子模塊、噴霧作業(yè)控制子模塊、飛行高度控制子模塊的信息交換以及實現(xiàn)作業(yè)參數(shù)設定等人機交互功能。所述高度控制子模塊可以測量無人機距離作物冠層的距離，并且實時調(diào)整無人機鉛垂方向升力使之穩(wěn)定在作業(yè)高度上。所述航路導航控制子模塊使無人機沿預設作業(yè)航路飛行，同時可以隨時調(diào)整飛行過程中出現(xiàn)的航路誤差，做到精確導航。所述噴霧控制子模塊依據(jù)植保無人機的作業(yè)位置實時控制植保作業(yè)開關，有效避免農(nóng)藥的漏噴和重噴。
[0009]所述的無人機植保綜合管理模塊，包括飛控處理單元、信息接收單元、控制信息輸出單元。所述的飛控處理單元選用DSP處理器，該芯片集成有豐富的外圍接口，具備浮點運算能力、計算精度高、能提高控制輸出精度。所述的信息接收單元包括高度信息輸入接口、飛行信息輸入接口、無線傳輸模塊和無線信息輸入接口。所述的控制信息輸出單元包括高度控制信息輸出接口、飛行姿態(tài)調(diào)整信息輸出接口和噴藥控制信息輸出接口。所述的高度信息輸入接口采用UART接口與飛控處理單元通訊。所述的飛行信息輸入接口的SPI接口與飛控處理單元通訊。所述的無線傳輸模塊經(jīng)無線信息輸入接口與飛控處理單元進行遠程通信。
[0010]所述的高度控制子模塊包括超聲波測高裝置和高度控制單元。所述的超聲波測高裝置測量無人機與作物冠層的實際距離，也即是測量出無人機的飛行高度。所述的高度控制單元包括油門舵機、發(fā)動機、大旋翼。所述油門舵機利用測高傳感單元反饋的信息調(diào)整發(fā)動機油門大小，控制輸出動力大小，進而控制大旋翼的旋轉(zhuǎn)速度，調(diào)整無人機鉛垂向的升力。測高傳感單元經(jīng)過高度信息輸入接口進入飛控處理單元，經(jīng)飛控處理單元計算后，再經(jīng)高度控制信息輸出接口輸出控制參數(shù)，控制油門舵機的油門大小，以控制大旋翼速度，進而調(diào)整無人機高度。
[0011]所述的航路導航控制子模塊包括飛行參數(shù)傳感單元和飛行姿態(tài)調(diào)整單元。所述的飛行參數(shù)傳感單元包括GPS裝置、6軸運動處理組件和電子羅盤。所述的GPS裝置通過飛行信息輸入接口送入飛控處理單元，GPS裝置獲取無人機的空間位置和飛行速度信息，用于控制無人機沿著預定航路進行作業(yè)。所述的6軸運動處理組件為3軸陀螺儀和3軸加速器儀組合模塊，用于測量無人機空間三個旋轉(zhuǎn)自由度的偏轉(zhuǎn)角度和三個平移自由度的加速度值。所述電子羅盤利用內(nèi)置磁阻效應傳感器，用于確定無人機相對地磁場的絕對航向角。所述的6軸運動處理組件和電子羅盤采用MEMS傳感器，各傳感器信號通過AD轉(zhuǎn)換后由飛行信息輸入接口送入飛控處理單元。所述飛行姿態(tài)調(diào)整單元分為前后向姿態(tài)調(diào)整模塊和左右向姿態(tài)調(diào)整模塊，每個模塊均包括機身兩側(cè)與其相應的電子調(diào)速器、電機和小旋翼。所述電子調(diào)速器與電機連接，電機隨著電子調(diào)速器輸出的電機驅(qū)動電流的大小和方向變化改變電機的轉(zhuǎn)速和轉(zhuǎn)向，小旋翼和電機共軸連接，產(chǎn)生不同推力帶動無人機調(diào)整飛行姿態(tài)。所述的飛行參數(shù)傳感單元經(jīng)過飛行信息輸入接口進入飛控處理單元，飛控處理單元根據(jù)飛行參數(shù)傳感單元獲取無人機GPS位置信息和姿態(tài)信息進行計算，得出無人機姿態(tài)調(diào)整參數(shù)，再經(jīng)飛行姿態(tài)調(diào)整信息輸出接口輸出控制參數(shù)，改變電子調(diào)速器的輸出電流大小和方向，以控制小旋翼速度，進而調(diào)整無人機的飛行姿態(tài)和水平速度。
[0012]所述的噴霧控制子模塊包括繼電器、電動隔膜泵和噴頭組。所述的繼電器與電動隔膜泵連接，用于控制電動隔膜泵開關。所述的電動隔膜泵通過藥液管與噴頭組連接，用于將藥液從藥液箱中泵出。所述的噴頭組用于將藥液霧化噴灑到空中，再由無人機的下洗氣流夾帶霧滴到作物表面。所述的噴藥控制信息輸出接口與繼電器連接，飛控處理單元依據(jù)是否到達噴霧區(qū)域進行繼電器開關的控制，從而控制電動隔膜泵是否進行噴霧作業(yè)。
[0013]一種植保無人機專用飛控系統(tǒng)的控制流程如下:
[0014]I)植保無人機平臺通過無線信息輸入接口接收地面站預先設定的飛行高度和規(guī)劃的噴霧航路數(shù)據(jù)，存儲在飛控處理單元中。
[0015]2)啟動發(fā)動機，油門舵機控制油門大小，大旋翼加速旋轉(zhuǎn)，無人機平穩(wěn)起飛，同時超聲波測高裝置開始工作，不斷的把無人機離地面的高度信息反饋給無人機飛控，油門舵機根據(jù)所反饋的高度信息控制發(fā)動機油門大小，維持大旋翼一定的轉(zhuǎn)速使無人機穩(wěn)定在作業(yè)高度。
[0016]3)GPS裝置將實時位置信息反饋給無人機飛控處理單元，航路導航控制子模塊4個電子調(diào)速器根據(jù)反饋的路線信息控制輸出電流大小，使對應的4個小旋翼分別以不同的轉(zhuǎn)速和轉(zhuǎn)向開始轉(zhuǎn)動，帶動無人機沿著作業(yè)路線飛行。左右小旋翼控制無人機沿著作物行運動(由A到B)，前后小旋翼控制無人機橫向移動進行換行作業(yè)(由B到C)。
[0017]4)當無人機運行到指定高度和指定位置時，繼電器控制電動隔膜泵開始工作，噴頭開始噴藥，如果不符合噴藥位置則停止作業(yè)，直至無人機調(diào)整到作業(yè)位置再進行作業(yè)。
[0018]本實用新型一種驅(qū)動解耦植保無人機的控制系統(tǒng)及控制方法的有益效果是:
[0019]I)實現(xiàn)了驅(qū)動解耦植保無人機的飛行控制，鉛垂方向升力與水平推力的驅(qū)動解耦保證控制系統(tǒng)的簡單可靠。；
[0020]2)植保無人機的起飛、作業(yè)和降落整個過程實現(xiàn)了自主飛行，具備沿預設的飛行航路進行植保作業(yè)，能應對各種復雜地形，減輕遙操作人員的勞動強度，避免農(nóng)藥漏噴或重噴；
[0021]3)植保無人機能保持作業(yè)高度，降低噴霧作業(yè)中由于自然風的影響，從而產(chǎn)生的嚴重霧滴飄失，保證了作業(yè)效果；
[0022]4)作業(yè)過程中，噴藥控制比較嚴格，避免了藥液的浪費，同時也減少了對環(huán)境的污染。

【附圖說明】

[0023]圖1是本實用新型的控制流程圖；
[0024]圖2是本實用新型的高度控制環(huán)節(jié)；
[0025]圖3是本實用新型的航向控制環(huán)節(jié)；
[0026]圖4是本實用新型的速度控制環(huán)節(jié)；
[0027]圖5是本實用新型的姿態(tài)控制環(huán)節(jié)；
[0028]圖6是本實用新型的田間作業(yè)圖。
[0029]圖中:1、GPS裝置2、超聲波測高裝置3、電子羅盤4、六軸運動處理組件5、油門舵機6、發(fā)動機7、大旋翼8、繼電器9、電動隔膜泵10、噴頭組

【具體實施方式】
[0030]下面結(jié)合附圖對本實用新型專利進行進一步描述。本實用新型一種植保無人機專用飛控系統(tǒng)采用的技術方案:包括無人機植保綜合管理模塊、高度控制子模塊、航路導航控制子模塊，噴霧控制子模塊。所述無人機植保綜合管理模塊作為整個無人機控制的控制核心，管理航路導航控制子模塊、噴霧作業(yè)控制子模塊、飛行高度控制子模塊的信息交換以及實現(xiàn)作業(yè)參數(shù)設定等人機交互功能。所述高度控制子模塊可以測量無人機距離作物冠層的距離，并且實時調(diào)整無人機鉛垂方向升力使之穩(wěn)定在作業(yè)高度上。所述航路導航控制子模塊使無人機沿預設作業(yè)航路飛行，同時可以隨時調(diào)整飛行過程中出現(xiàn)的航路誤差，做到精確導航。所述噴霧控制子模塊依據(jù)植保無人機的作業(yè)位置實時控制植保作業(yè)開關，有效避免農(nóng)藥的漏噴和重噴。
[0031]所述的無人機植保綜合管理模塊，包括飛控處理單元、信息接收單元、控制信息輸出單元。所述的飛控處理單元選用DSP處理器，該芯片集成有豐富的外圍接口，具備浮點運算能力、計算精度高、能提高控制輸出精度。所述的信息接收單元包括高度信息輸入接口、飛行信息輸入接口、無線傳輸模塊和無線信息輸入接口。所述的控制信息輸出單元包括高度控制信息輸出接口、飛行姿態(tài)調(diào)整信息輸出接口和噴藥控制信息輸出接口。所述的高度信息輸入接口采用UART接口與飛控處理單元通訊。所述的飛行信息輸入接口的SPI接口與飛控處理單元通訊。所述的無線傳輸模塊經(jīng)無線信息輸入接口與飛控處理單元進行遠程通信。
[0032]所述的高度控制子模塊包括超聲波測高裝置(2)和高度控制單元。所述的超聲波測高裝置(2)測量無人機與作物冠層的實際距離，也即是測量出無人機的飛行高度。所述的高度控制單元包括油門舵機(5)、發(fā)動機(6)、大旋翼(7)。所述油門舵機(5)利用測高傳感單元反饋的信息調(diào)整發(fā)動機(6)油門大小，控制輸出動力大小，進而控制大旋翼(7)的旋轉(zhuǎn)速度，調(diào)整無人機鉛垂向的升力。測高傳感單元經(jīng)過高度信息輸入接口進入飛控處理單元，經(jīng)飛控處理單元計算后，再經(jīng)高度控制信息輸出接口輸出控制參數(shù)，控制油門舵機(5)的油門大小，以控制大旋翼(7)速度，進而調(diào)整無人機高度。
[0033]所述的航路導航控制子模塊包括飛行參數(shù)傳感單元和飛行姿態(tài)調(diào)整單元。所述的飛行參數(shù)傳感單元包括GPS裝置(I)、6軸運動處理組件(4)和電子羅盤(3)。所述的GPS裝置(I)通過飛行信息輸入接口送入飛控處理單元，GPS裝置(I)獲取無人機的空間位置和飛行速度信息，用于控制無人機沿著預定航路進行作業(yè)。所述的6軸運動處理組件(4)為3軸陀螺儀和3軸加速器儀組合模塊，用于測量無人機空間三個旋轉(zhuǎn)自由度的偏轉(zhuǎn)角度和三個平移自由度的加速度值。所述電子羅盤(3)利用內(nèi)置磁阻效應傳感器，用于確定無人機相對地磁場的絕對航向角。所述的6軸運動處理組件(4)和電子羅盤(3)采用MEMS傳感器，各傳感器信號通過AD轉(zhuǎn)換后由飛行信息輸入接口送入飛控處理單元。所述飛行姿態(tài)調(diào)整單元分為前后向姿態(tài)調(diào)整模塊和左右向姿態(tài)調(diào)整模塊，每個模塊均包括機身兩側(cè)與其相應的電子調(diào)速器、電機和小旋翼。所述電子調(diào)速器與電機連接，電機隨著電子調(diào)速器輸出的電機驅(qū)動電流的大小和方向變化改變電機的轉(zhuǎn)速和轉(zhuǎn)向，小旋翼和電機共軸連接，產(chǎn)生不同推力帶動無人機調(diào)整飛行姿態(tài)。所述的飛行參數(shù)傳感單元經(jīng)過飛行信息輸入接口進入飛控處理單元，飛控處理單元依據(jù)飛行參數(shù)傳感單元獲取的無人機GPS位置和姿態(tài)信息與飛控處理單元計算的無人機姿態(tài)調(diào)整參數(shù)，再經(jīng)飛行姿態(tài)調(diào)整信息輸出接口輸出控制參數(shù)，改變電子調(diào)速器的輸出電流大小和方向，以控制小旋翼速度，進而調(diào)整無人機的飛行姿態(tài)和水平速度。
[0034]所述的噴霧控制子模塊包括繼電器⑶、電動隔膜泵(9)和噴頭組(10)。所述的繼電器⑶與電動隔膜泵(9)連接，用于控制電動隔膜泵(9)開關。所述的電動隔膜泵(9)通過藥液管與噴頭組(10)連接，用于將藥液從藥液箱中泵出。所述的噴頭組(10)用于將藥液霧化噴灑到空中，再由無人機的下洗氣流夾帶霧滴到作物表面。所述的噴藥控制信息輸出接口與繼電器(8)連接，飛控處理單元依據(jù)是否到達噴霧區(qū)域進行繼電器(8)開關的控制，從而控制電動隔膜泵(9)是否進行噴霧作業(yè)。
[0035]一種針對驅(qū)動解耦植保無人機平臺的控制系統(tǒng)的控制方法:
[0036]I)所述的高度控制子模塊將預設飛行高度信息與測高傳感單元獲得的實際飛行高度信息進行比較，通過采用PID控制算法產(chǎn)生高度控制指令，改變高度控制單元的油門舵機(5)控制參數(shù)，從而控制大旋翼(7)的旋轉(zhuǎn)速度，調(diào)整無人機鉛垂方向的升力。
[0037]2)植保無人機平臺在作業(yè)開始前，通過無線信息輸入接口接收地面站預先設定的飛行高度和規(guī)劃的噴霧航路數(shù)據(jù)，存儲在飛控處理單元中。所述的航路導航控制子模塊將規(guī)劃的噴霧航路中的目標位置信息與GPS裝置(I)或飛行參數(shù)傳感單元獲得的實際位置信息進行比較，產(chǎn)生姿態(tài)控制指令和水平速度控制指令，使無人機隨時調(diào)整飛行過程中出現(xiàn)的航路誤差，使實際的航跡符合預定航路，做到精確導航。
[0038]依據(jù)植保作業(yè)路徑與作物行對齊的特點，所述的驅(qū)動解耦無人機平臺的水平速度控制僅涉及相對機身前后方向和左右方向的直線運動控制；所述的驅(qū)動解耦無人機平臺的姿態(tài)控制僅涉及相對鉛垂軸的旋轉(zhuǎn)運動控制，以便將機身前后方向調(diào)整到對準規(guī)劃航向方向。
[0039]所述的驅(qū)動解耦無人機平臺相對機身前后方向的水平速度控制僅由左右兩個小旋翼提供水平方向的前后向推力控制；所述的驅(qū)動解耦無人機平臺相對機身左右方向的水平速度控制僅由前后兩個小旋翼提供水平方向的左右向推力控制；所述的航路導航控制子模塊將設定水平速度與飛行參數(shù)傳感單元中的GPS裝置(I)和3軸加速器儀獲得的實際水平速度進行比較，通過采用PID控制算法產(chǎn)生水平速度控制指令，改變電子調(diào)速器的電流大小，從而改變前后方向或左右方向的小旋翼推力，最終調(diào)整水平飛行速度。
[0040]所述的驅(qū)動解耦無人機平臺相對鉛垂軸的旋轉(zhuǎn)運動可由左右小旋翼以相反的轉(zhuǎn)向提供的旋轉(zhuǎn)扭矩控制。所述的航路導航控制子模塊將設定的無人機的飛行航向與飛行參數(shù)傳感單元中的3軸陀螺儀和電子羅盤(3)獲得的實際航向角進行比較，通過采用PID控制算法產(chǎn)生姿態(tài)調(diào)整控制指令，改變機身左右兩側(cè)對應的電子調(diào)速器的電流大小，從而改變左右兩側(cè)小旋翼的推力，最終調(diào)整無人機飛行的實際航向。
[0041]當驅(qū)動解耦無人機平臺受到擾動風的干擾或水平飛行加速時會出現(xiàn)機身稍稍失去平衡，即機身重心不在大旋翼(7)軸線上，所述的航路導航控制子模塊將依據(jù)飛行參數(shù)傳感單元的3軸陀螺儀的監(jiān)測數(shù)據(jù)與無人機垂直面傾角比較，若其值超過設定閾值，則通過采用PID控制算法，產(chǎn)生姿態(tài)調(diào)整控制指令，改變機身左右兩側(cè)對應的電子調(diào)速器的電流大小，從而改變前后或左右兩側(cè)小旋翼的推力，最終調(diào)整其垂直面傾角回到正常范圍。
[0042]3)所述的噴霧控制子模塊依據(jù)GPS裝置(I)所獲取的無人機的定位信息和高度信息判斷無人機到達指定的噴藥高度和位置時，通過噴藥控制信息輸出接口導通繼電器(8)，電動隔膜泵(9)開始工作，噴頭開始噴藥作業(yè)。
[0043]—種針對驅(qū)動解耦植保無人機平臺的控制系統(tǒng)的控制流程如下:
[0044]I)植保無人機平臺通過無線信息輸入接口接收地面站預先設定的飛行高度和規(guī)劃的噴霧航路數(shù)據(jù)，存儲在飛控處理單元中。
[0045]2)啟動發(fā)動機(6)，油門舵機(5)控制油門大小，大旋翼(7)加速旋轉(zhuǎn)，無人機平穩(wěn)起飛，同時超聲波測高裝置(2)開始工作，不斷的把無人機離地面的高度信息反饋給無人機飛控，油門舵機(5)根據(jù)所反饋的高度信息控制發(fā)動機(6)油門大小，維持大旋翼(7)一定的轉(zhuǎn)速使無人機穩(wěn)定在作業(yè)高度。
[0046]3)GPS裝置將實時位置信息反饋給無人機飛控處理單元，航路導航控制子模塊4個電子調(diào)速器根據(jù)反饋的路線信息控制輸出電流大小，使對應的4個小旋翼分別以不同的轉(zhuǎn)速和轉(zhuǎn)向開始轉(zhuǎn)動，帶動無人機沿著作業(yè)路線飛行。左右小旋翼控制無人機沿著作物行運動(由A到B)，前后小旋翼控制無人機橫向移動進行換行作業(yè)(由B到C)。
[0047]4)當無人機運行到指定高度和指定位置時，繼電器⑶控制電動隔膜泵(9)開始工作，噴頭開始噴藥，如果不符合噴藥位置則停止作業(yè)，直至無人機調(diào)整到作業(yè)位置再進行作業(yè)。
【權(quán)利要求】
1.一種植保無人機專用飛控系統(tǒng)，其特征在于:包括無人機植保綜合管理模塊、高度控制子模塊、航路導航控制子模塊，噴霧控制子模塊；所述無人機植保綜合管理模塊作為整個無人機控制的控制核心，管理航路導航控制子模塊、噴霧作業(yè)控制子模塊、飛行高度控制子模塊的信息交換以及實現(xiàn)作業(yè)參數(shù)設定等人機交互功能；所述高度控制子模塊可以測量無人機距離作物冠層的距離，并且實時調(diào)整無人機鉛垂方向升力使之穩(wěn)定在作業(yè)高度上；所述航路導航控制子模塊使無人機沿預設作業(yè)航路飛行，同時可以隨時調(diào)整飛行過程中出現(xiàn)的航路誤差，做到精確導航；所述噴霧控制子模塊依據(jù)植保無人機的作業(yè)位置實時控制植保作業(yè)開關，有效避免農(nóng)藥的漏噴和重噴； 所述的無人機植保綜合管理模塊，包括飛控處理單元、信息接收單元、控制信息輸出單元；所述的飛控處理單元選用DSP處理器；所述的信息接收單元包括高度信息輸入接口、飛行信息輸入接口、無線傳輸模塊和無線信息輸入接口 ；所述的控制信息輸出單元包括高度控制信息輸出接口、飛行姿態(tài)調(diào)整信息輸出接口和噴藥控制信息輸出接口 ；所述的高度信息輸入接口采用UART接口與飛控處理單元通訊；所述的飛行信息輸入接口的SPI接口與飛控處理單元通訊；所述的無線傳輸模塊經(jīng)無線信息輸入接口與飛控處理單元進行遠程通Is ; 所述的高度控制子模塊包括超聲波測高裝置和高度控制單元；所述的超聲波測高裝置測量無人機與作物冠層的實際距離；所述的高度控制單元包括油門舵機、發(fā)動機、大旋翼；所述油門舵機利用測高傳感單元反饋的信息調(diào)整發(fā)動機油門大小，控制輸出動力大小，進而控制大旋翼的旋轉(zhuǎn)速度，調(diào)整無人機鉛垂向的升力；測高傳感單元經(jīng)過高度信息輸入接口進入飛控處理單元，經(jīng)飛控處理單元計算后，再經(jīng)高度控制信息輸出接口輸出控制參數(shù)，控制油門舵機的油門大小，以控制大旋翼速度，進而調(diào)整無人機高度； 所述的航路導航控制子模塊包括飛行參數(shù)傳感單元和飛行姿態(tài)調(diào)整單元；所述的飛行參數(shù)傳感單元包括GPS裝置、6軸運動處理組件和電子羅盤；所述的GPS裝置通過飛行信息輸入接口送入飛控處理單元，GPS裝置獲取無人機的空間位置和飛行速度信息，用于控制無人機沿著預定航路進行作業(yè)；所述的6軸運動處理組件為3軸陀螺儀和3軸加速器儀組合模塊，用于測量無人機空間三個旋轉(zhuǎn)自由度的偏轉(zhuǎn)角度和三個平移自由度的加速度值；所述電子羅盤利用內(nèi)置磁阻效應傳感器，用于確定無人機相對地磁場的絕對航向角；所述的6軸運動處理組件和電子羅盤采用MEMS傳感器，各傳感器信號通過AD轉(zhuǎn)換后由飛行信息輸入接口送入飛控處理單元；所述飛行姿態(tài)調(diào)整單元分為前后向姿態(tài)調(diào)整模塊和左右向姿態(tài)調(diào)整模塊，每個模塊均包括機身兩側(cè)與其相應的電子調(diào)速器、電機和小旋翼；所述電子調(diào)速器與電機連接，電機隨著電子調(diào)速器輸出的電機驅(qū)動電流的大小和方向變化改變電機的轉(zhuǎn)速和轉(zhuǎn)向，小旋翼和電機共軸連接，產(chǎn)生不同推力帶動無人機調(diào)整飛行姿態(tài)；所述的飛行參數(shù)傳感單元經(jīng)過飛行信息輸入接口進入飛控處理單元，飛控處理單元根據(jù)飛行參數(shù)傳感單元獲取無人機GPS位置信息和姿態(tài)信息進行計算，得出無人機姿態(tài)調(diào)整參數(shù)，再經(jīng)飛行姿態(tài)調(diào)整信息輸出接口輸出控制參數(shù)，改變電子調(diào)速器的輸出電流大小和方向，以控制小旋翼速度，進而調(diào)整無人機的飛行姿態(tài)和水平速度； 所述的噴霧控制子模塊包括繼電器、電動隔膜泵和噴頭組；所述的繼電器與電動隔膜泵連接，用于控制電動隔膜泵開關；所述的電動隔膜泵通過藥液管與噴頭組連接；所述的噴藥控制信息輸出接口與繼電器連接，飛控處理單元依據(jù)是否到達噴霧區(qū)域進行繼電器開關的控制，從而控制電動隔膜泵是否進行噴霧作業(yè)。
【文檔編號】G05B19-418GK204270115SQ201420685049
【發(fā)明者】苑進, 劉雪美, 陳榮康, 王公成, 張翼, 張文碩 [申請人]山東農(nóng)業(yè)大學