TWI806318B - 無人機及其控制方法 - Google Patents
無人機及其控制方法 Download PDFInfo
- Publication number
- TWI806318B TWI806318B TW110149130A TW110149130A TWI806318B TW I806318 B TWI806318 B TW I806318B TW 110149130 A TW110149130 A TW 110149130A TW 110149130 A TW110149130 A TW 110149130A TW I806318 B TWI806318 B TW I806318B
- Authority
- TW
- Taiwan
- Prior art keywords
- air pressure
- pressure value
- data
- barometer
- external reference
- Prior art date
Links
Images
Landscapes
- Polymers With Sulfur, Phosphorus Or Metals In The Main Chain (AREA)
- Medicines Containing Material From Animals Or Micro-Organisms (AREA)
- Measuring Fluid Pressure (AREA)
Abstract
無人機包括:一第一氣壓計,提供一第一氣壓值;一處理單元,耦接至該第一氣壓計,該處理單元接收該第一氣壓計所提供的該第一氣壓值,且對該第一氣壓計之該第一氣壓值與一外部參考氣壓計所提供之一外部參考氣壓值進行時間同步以得到時間同步校正後的該第一氣壓值,並重新計算時間同步校正後的該第一氣壓值以產生一補償後氣壓值,該處理單元對該第一氣壓值、該補償後氣壓值與一感測器資料進行資訊融合計算,以得到一目標融合後資料,該處理單元根據該目標融合後資料,對該無人機進行實時高度與姿態控制。
Description
本發明是有關於一種無人機及其控制方法。
無人航空載具(unmanned aerial vehicle,UAV)或稱無人飛行器系統(unmanned aircraft system,UAS),俗稱無人機、蜂型機(drone)等,廣義上為不需要駕駛員登機駕駛的各式飛行器。
無人機通常使用遙控、導引或自動駕駛來控制。無人機可應用於科學研究、場地探勘、軍事、休閒娛樂、農業、救災等領域。故而,導致無人機的全球市場在近年大幅增長。
根據本案一實例,提出一種無人機,包括:一第一氣壓計,提供一第一氣壓值;一處理單元,耦接至該第一氣壓計,該處理單元接收該第一氣壓計所提供的該第一氣壓值,且對該第一氣壓計之該第一氣壓值與一外部參考氣壓計所提供之一外部參考氣壓值進行時間同步以得到時間同步校正後的該第一氣壓值,並重新計算時間同步校正後的該第一氣壓值以產生一補償後氣壓值,該處理單元對該第一氣壓值、該補償後氣壓值與一感測器資
料進行資訊融合計算,以得到一目標融合後資料,該處理單元根據該目標融合後資料,對該無人機進行實時高度與姿態控制。
根據本案另一實例,提出一種無人機控制方法,用以控制包括一第一氣壓計之一無人機,該無人機控制方法包括:接收該第一氣壓計所提供的一第一氣壓值;對該第一氣壓計之該第一氣壓值與一外部參考氣壓計所提供之一外部參考氣壓值進行時間同步以得到時間同步校正後的該第一氣壓值,並重新計算時間同步校正後的該第一氣壓值以產生一補償後氣壓值;對該第一氣壓值、該補償後氣壓值與一感測器資料進行資訊融合計算,以得到一目標融合後資料;以及根據該目標融合後資料,對該無人機進行實時高度與姿態控制。
為了對本發明之上述及其他方面有更佳的瞭解,下文特舉實施例,並配合所附圖式詳細說明如下:
100:無人機
110:第一氣壓計
130:處理單元
151:定位感測器
153:慣性量測元件
155:距離感測器
190:通訊單元
50:外部輔助裝置
51:外部參考氣壓計
53:外部控制模組
131:氣壓計數值處理模組
133A、133B:資料融合單元
135:資料融合切換單元
137:高度與姿態控制模組
132:資料融合模組
210~218:步驟
310:資料時序同步單元
320:資料校正與分離單元
330:氣壓計數值重算單元
340:運算單元
405~420:步驟
510:橋
520:控制中心
610-640:步驟
第1圖繪示根據本案一實施例的無人機之功能方塊圖。
第2圖顯示根據本案一實施例之外部控制模組53之控制示意圖。
第3圖顯示根據本案一實施例之氣壓計數值處理模組的功能方塊圖。
第4圖顯示根據本案一實施例的資料融合切換單元之操作示意圖。
第5A圖與第5B圖顯示根據本案一實施例的2種操作例。
第6圖顯示根據本案一實施例之無人機控制方法之流程圖。
本說明書的技術用語係參照本技術領域之習慣用語,如本說明書對部分用語有加以說明或定義,該部分用語之解釋係以本說明書之說明或定義為準。本揭露之各個實施例分別具有一或多個技術特徵。在可能實施的前提下,本技術領域具有通常知識者可選擇性地實施任一實施例中部分或全部的技術特徵,或者選擇性地將這些實施例中部分或全部的技術特徵加以組合。
無人機憑藉機上氣壓計數值和全球定位系統(Global Positioning System,GPS)來計算本身當時高度。當無人機於橋樑下飛行進行檢測任務時,GPS信號可能會被橋樑所阻擋。此時,如果起風的話,風造成氣壓計數值的變化。這些情況(GPS被橋樑所阻擋,且風造成氣壓計數值的變化)可能使無人機的飛行高度難以保持,造成飛行困難與危險。
本案實施例提出無人機及其控制方法,以對無人機的飛行與高度姿態控制上有良好控制,且能節省硬體成本和軟體開發成本又能得到理想的控制結果。
第1圖繪示根據本案一實施例的無人機之功能方塊圖。如第1圖所示,根據本案一實施例的無人機100包括:第一氣壓計110、處理單元130、定位感測器151、慣性量測元件(Inertial measurement unit,IMU)153、距離感測器155與通
訊單元190。無人機100更可與外部輔助裝置50無線通訊。外部輔助裝置50包括至少一外部參考氣壓計51與外部控制模組53。
第一氣壓計110用以提供第一氣壓值P1至處理單元130。在底下,亦可將第一氣壓計110稱為無人機氣壓計,因為第一氣壓計110乃是位於無人機100之上。
處理單元130耦接至該第一氣壓計110。處理單元130接收第一氣壓計110所提供的第一氣壓值P1,且對該第一氣壓計110之該第一氣壓值P1與外部參考氣壓計51所提供之一外部參考氣壓值P2進行時間同步以得到時間同步校正後的第一氣壓值P1,並重新計算時間同步校正後的第一氣壓值P1以產生一補償後氣壓值P3。處理單元130對該補償後氣壓值P3與感測器資料SD進行資訊融合計算,以得到一目標融合後資料。處理單元130根據該目標融合後資料,對無人機100進行高度與姿態控制。
在一實施例中,處理單元130包括:氣壓計數值處理模組131、第一資料融合單元133A、第二資料融合單元133B、資料融合切換單元135與高度與姿態控制模組137。處理單元130例如但不受限於為一般用途中央處理器(central processing unit,CPU)、特殊應用積體電路(Application Specific Integrated Circuit,ASIC)、微控制器(microcontroller)、微處理器(microprocessor)、處理器(processor)、數位訊號處理器(digital signal processor,DSP)、數位邏輯電路、現場可程式
邏輯閘陣列(field programmable gate array,FPGA)及/或其它具有運算處理功能的硬體元件或電路等。第一資料融合單元133A、第二資料融合單元133B、資料融合切換單元135亦可合稱為資料融合模組132。
氣壓計數值處理模組131對第一氣壓計110之第一氣壓值P1與外部參考氣壓計51所提供之外部參考氣壓值P2進行時間同步,並重新計算時間同步校正後的第一氣壓值P1以產生補償後氣壓值P3。
資料融合模組132對第一氣壓值P1、補償後氣壓值P3與感測器資料SD進行資訊融合計算,以得到目標融合後資料。
第一資料融合單元133A接收補償後氣壓值P3與感測器資料SD並進行資訊融合計算,以得到第一融合後資料FD1。
第二資料融合單元133B接收第一氣壓計110之第一氣壓值P1與感測器資料SD並進行資訊融合計算,以得到第二融合後資料FD2。在本案一實施例中,第二資料融合單元133B可為一選擇性單元。
第一資料融合單元133A與第二資料融合單元133B例如但不受限於,使用延伸卡曼濾波器(Extended Kalman Filter,EKF)作為資料融合(Data Fusion,DF)之用。延伸卡曼濾波器(EKF)基於IMU(例如陀螺儀、加速度計或電子羅盤)、GPS、空速和氣壓計等資訊來估計無人機的實時位置、速度和角方向。
資料融合切換單元135用以切換或選擇第一融合後資料FD1或第二融合後資料FD2以得到一目標融合後資料,並將該目標融合後資料傳送至高度與姿態控制模組137。在本案一實施例中,資料融合切換單元135可為一選擇性單元。
高度與姿態控制模組137根據資料融合切換單元135所選擇的目標融合後資料來進行無人機100的高度及/或姿態控制。而且,高度與姿態控制模組137更可回授控制資料融合模組132的第一資料融合單元133A與第二資料融合單元133B。
定位感測器151提供定位資訊。例如但不受限於,定位感測器151可提供衛星定位資訊及/或超寬頻定位資訊等。
慣性量測元件153(IMU)提供慣性量測資料。例如但不受限於,慣性量測元件153包括:重力感測器、電子陀螺儀、電子羅盤等。
距離感測器155提供距離感測資料。例如但不受限於,距離感測器155包括光達(light detection and ranging,Lidar)、超音波感測器、飛時測距感測器(ToF(time-of-flight)Sensor)等。
感測器群組可包括下列之任意組合:定位感測器151、慣性量測元件153與距離感測器155。由感測器群組所發出給處理單元130的資料亦可稱為感測器資料SD。
外部參考氣壓計51提供外部參考氣壓值P2給通訊單元190。通訊單元190將外部參考氣壓值P2傳送給處理單元
130。如果外部輔助裝置50包括多個外部參考氣壓計51的話,則可傳送多個外部參考氣壓值P2給處理單元130。於另一實施例中,外部參考氣壓值P2也可以是該些多個外部參考氣壓計51的平均值。
外部控制模組53用以判定外部輔助裝置50是否已固定不動或處於穩定狀態(亦即,外部輔助裝置50無大幅移動)。當外部控制模組53判定外部輔助裝置50已固定不動或處於穩定狀態時,外部控制模組53輸出一通知信號至無人機100的通訊單元190。通訊單元190將外部控制模組53所輸出的通知信號傳送給處理單元130,以使得處理單元130可以參考該外部參考氣壓計51的外部參考氣壓值P2來進行姿態與高度控制。
第2圖顯示根據本案一實施例之外部控制模組53之控制示意圖。如第2圖所示,外部控制模組53可以得到外部輔助裝置50的高度值(可為對地高度、對海平面高度或外部輔助裝置50相對於一已知高度物體之相對高度等)。外部控制模組53可以設定為全作動情況或部分作動情況。於全作動情況中,外部控制模組53可提供較精確貼近真實環境的資料,以供後續計算,對各氣壓計感測值的出廠差異,提供較完整的相互校正能力。於部分作動情況中,可讓本案實施例的無人機100運作於較快速布建的狀態。
於感測高度資訊步驟210中,使用超聲波或光學(光達、紅外光、可見光、或ToF攝影機等)設備來感測並取得高度資
訊。
於擷取高度資訊步驟212中,由外部給定或手動設定高度資訊。
於得到高度資訊步驟214中,可以使用感測高度資訊步驟210或擷取高度資訊步驟212所提供的高度資訊。
於判定步驟216中,根據所得到的高度資訊,判斷外部輔助裝置50是否已固定不動或處於穩定狀態,例如若一段時間(或數次量測間)內的高度資訊的變化皆小於一特定值,則判斷為外部輔助裝置50為固定不動或處於穩定狀態。如果步驟216為是,代表外部輔助裝置50無大幅移動,外部控制模組53輸出通知信號至無人機100;以及,外部輔助裝置50上的外部參考氣壓計51的外部參考氣壓值P2可供無人機100的處理單元130參考使用。
如果步驟216為否,則流程接至步驟218。於判斷步驟218中,判斷外部輔助裝置50可能處於高度值未知(但外部輔助裝置50有可能處於已固定不動或穩定狀態,不會大幅移動狀態,如無人機的懸停狀態)。
在本案一實施例中,當外部輔助裝置50的高度資訊已知時,外部輔助裝置50可輔助無人機100來設定目標飛行高度和對當前飛行高度進行相對高度之增加或減少的調整;以及,當外部輔助裝置50的高度資訊未知時,外部輔助裝置50可輔助無人機100對當前飛行高度進行相對高度之增加或減少的調整。至
於高度變化與氣壓的對應變化關係,可參考相關之當地氣象研究資訊。
第3圖顯示根據本案一實施例之氣壓計數值處理模組131的功能方塊圖。如第3圖所示,氣壓計數值處理模組131包括:資料時序同步單元310、資料校正與分離單元320、氣壓計數值重算單元330與運算單元340。
於本案一實施例中,第一氣壓計110提供第一氣壓值P1與相關的第一時間標記;同樣地,外部參考氣壓計51提供外部參考氣壓值P2與相關的第二時間標記。其中,第一與第二時間標記可使用真實世界時間(但非一定必要)。或者是,可用以協助標記該些氣壓計數值的同步資訊,即可當作第一與第二時間標記。
資料時序同步單元310根據該些時間標記,來同步排列第一氣壓值P1與外部參考氣壓值P2以得到時間同步校正後的第一氣壓值P1。例如但不受限於,於本案一實施例中,當第一時間標記與第二時間標記的時間值相同或相差小於一誤差值時,將對應的第一氣壓值P1與外部參考氣壓值P2判斷為同一時間的氣壓值。
於初始狀態時,資料校正與分離單元320校正經同步排列後的第一氣壓值P1與外部參考氣壓值P2的相互偏差值,使第一氣壓計110與外部參考氣壓計51於後續使用時,對各氣壓計所提供的數值和氣壓值,能有一致性的解讀。在一實施例中,
校正方式例如為但不受限於,量測每個高度的第一氣壓值P1與外部參考氣壓值P2,以得知在各個高度下的經同步排列後的第一氣壓值P1與外部參考氣壓值P2的相互偏差值,以在運作時消除誤差。於運作狀態時,資料校正與分離單元320輸出校正後的標的氣壓計(即第一氣壓計110)的共模氣壓數值B_COM和差模氣壓數值B_DIFF。
在本案一實施例中,對於外部參考氣壓計51進行校正,例如校正外部參考氣壓計51以符合第一氣壓計110的數值,校正後的外部參考氣壓計51的輸出值能夠對該環境的高度和隨高度變化產生的數值變化與第一氣壓計110有一致性(例如相同或相似)的認知。也就是說,即便氣壓計(例如外部參考氣壓值P2)於出廠時就有量測上的偏移誤差,在本案一實施例中,進行校正可使各氣壓計在鄰近的使用環境裡,對於所使用的各氣壓計的所量測到的各氣壓值,可有一致性的解讀。雖然在此以校正外部參考氣壓計51為例,但本揭露並不以此為限,在另一實施例中,也可校正第一氣壓計110,或第一氣壓計110和外部參考氣壓計51皆校正。
當第一氣壓值P1與外部參考氣壓值P2都經過時間同步和校正後,第一氣壓值P1與外部參考氣壓值P2對空間中的氣壓值感測與氣壓隨高度變化有相同或相近的認知,例如但不受限於,在同高度下,第一氣壓值P1與外部參考氣壓值P2量測到一樣的氣壓。
當第一氣壓計110與外部參考氣壓計51的相對高度為已知,在計算共模氣壓數值B_COM之前,資料校正與分離單元320更進行「映射」,將外部參考氣壓值P2映射至與第一氣壓值P1相同高度,得到一映射後外部參考氣壓值P2remap,以該映射後外部參考氣壓值P2remap作為與第一氣壓值P1同高度的氣壓值,例如,若無人機100的高度是H2(外部輔助裝置50的高度)+h(無人機100與外部輔助裝置50之間的相對高度),映射後外部參考氣壓值P2remap是外部參考氣壓計51在“H2+h”應有的氣壓計值。透過映射,共模氣壓數值B_COM可表示如下式(1-1)所示:B_COM=(P1+P2remap)/2 (1-1)
此外,差模氣壓數值B_DIFF可如底下式(1-2)所述:B_DIFF=P1-B_COM (1-2)
在一實施例中,氣壓計數值重算單元330消除或減少風的造成的氣壓值變化。例如,在無風的情形下,第一氣壓計110的第一氣壓值為P1_0,外部參考氣壓計51在校正後的氣壓值為P2_cal;在一實施例中,第一氣壓計110及外部參考氣壓計51的位置接近,在有風時,第一氣壓計110及外部參考氣壓計51皆受到風的影響,造成相同或近似的氣壓值變化,若風造成氣壓值變化為P_wind,使得第一氣壓計110的第一氣壓值成為P1=P1_0+P_wind,外部參考氣壓計51的外部參考氣壓值
P2=P2_cal+P_wind。可將P2減去P2_cal以得到P_wind;在另一實施例中,也可使用校正前的數值得到氣壓值變化P_wind,例如,在無風的情形下,外部參考氣壓計51在校正後的氣壓值為P2_0,風造成外部參考氣壓計51的的外部參考氣壓值P2=P2_0+P_wind,可將P2減去P2_0以得到P_wind,也可以P1做相同或近似算法得知P_wind。氣壓計數值重算單元330則可減去風造成的氣壓值變化P_wind如式(2):B_COM’=B_COM-P_wind (2)
在減去風造成的氣壓值變化後,調整第一氣壓計110的氣壓值為補償後氣壓值P3如式(3):P3=B_COM’+B_DIFF (3)
在本案一實施例中,當第一氣壓計110與外部參考氣壓計51的相對高度為未知,可不進行映射,式(1-1)的P2_remap可以校正後的氣壓值P2_cal計算,其他計算與上述說明相同或近似。在另一實施例中,當第一氣壓計110與外部參考氣壓計51的相對高度為已知,亦可不進行映射,式(1-1)的P2_remap可以校正後的氣壓值P2_cal計算。
資料校正與分離單元320所進行的「映射」之一例如後所述,但當知本案並不受限於此。譬如在相同的環境與高度時,第一氣壓值P1的氣壓值是980帕斯卡(Pa),而外部參考氣壓值P2的氣壓計讀值是965帕斯卡,並且在改變相同高度時,第一氣壓值P1與外部參考氣壓值P2的氣壓值改變量相同或相近;
因此資料校正與分離單元320可將原先兩氣壓計的差值(980Pa-965Pa)補入外部參考氣壓值P2,校正外部參考氣壓值P2,再將第一氣壓計110與外部參考氣壓計51的相對高度的氣壓計的差值(此差值可事先量測而得)補入外部參考氣壓值P2的量測值,以得到映射後的外部參考氣壓值P2remap。或者是,可以無人機在各個高度量測第一氣壓值,以建立一映射數值表,讓本案實施例的無人機控制機制在實施時,知道第一氣壓值P1與外部參考氣壓值P2的量測有已知的差異,之後進行數值處理時,可補償此差異值以校正外部參考氣壓值P2,再根據映射數值表,以得到外部參考氣壓計51在第一氣壓計110高度的映射後的外部參考氣壓值P2remap。在這種情況中,因為已經知道每個氣壓計在各種高度與氣壓值的對應關係,因此可以得到映射後的資料。
在一實施例中,可根據式(4)或者其它的高度與氣壓換算公式得到無人機100的高度調整值,以在高度與姿態控制模組137調整無人機的高度。
Z2-Z1=18400(1+a*t)*log(P1/P3) (4)
其中,Z2-Z1代表第一氣壓計110與無人機100應調整到之高度的相對高度,a為常數(例如但不受限於,1/273),t代表攝氏溫度。
在另一實施例中,映射數值表的時也可利用式(4)計算得知,例如修改式(4)如下式(5):ZX-Z1=18400(1+a*t)*log(P1/PX) (5)
ZX為第一氣壓計110所處的各個高度,PX則為第一氣壓計110在各個高度量測到的氣壓值,當第一氣壓計110與外部參考氣壓計51的相對高度已知,透過上述式(5)也可計算出映射後外部參考氣壓值P2。因為第一氣壓值P1與外部參考氣壓值P2經過校準,對於真實世界的氣壓和高度變化,第一氣壓值P1與外部參考氣壓值P2的值有一致性。
或者是,若第一氣壓計110與外部參考氣壓計51的相對高度未知(亦即Z2-Z1未知),則在第一氣壓計110與外部參考氣壓計51的高度穩定時,透過第一氣壓計110與外部參考氣壓計51的氣壓計數值去計算出第一氣壓計110與外部參考氣壓計51之間的高度差。於無風情況下,第一氣壓計110與外部參考氣壓計51的個別氣壓值代表個別高度。於有風情況,第一氣壓計110與外部參考氣壓計51配置在鄰近的環境中,讓第一氣壓計110與外部參考氣壓計51被風的影響盡量接近。
此外,如果外部參考氣壓計51包括多台參考氣壓計的話,則可對每台參考氣壓計的氣壓計數值進行上述的映射步驟。
在本案一實施例中,關於如何消弭風的影響可如後所述,當然,本案並不受限於此。氣壓計用來量測大氣壓力,出廠的時候,氣壓計的輸出是電壓值,但此輸出電壓值會隨著氣壓的不同而不同。所以,氣壓計原廠會給出電壓與氣壓的對應關係表。其次,關於氣壓與高度的關係,在氣象領域也有一些研究成
果(如上述式(3)便是其一),以目前平均海平面的氣壓是1013.25百帕(hPa),當高度上升,氣壓下降,則高度和氣壓有換算對應表。
此外,若無人機100有奇怪的高度變化,高度變化所導致的額外氣壓差可在參數B_DIFF中呈現,然後無人機100透過高度調整把此參數B_DIFF抵消。
在一實施例中,氣壓計數值重算單元330可以是已知的大氣研究相關模型,例如但不受限於,挪威氣旋模型(Norwegian Cyclone Model)。
運算單元340例如但不受限於為加法器。運算單元340將B_COM’與差模氣壓數值B_DIFF運算(如相加)以得到補償後氣壓值P3。
第4圖顯示根據本案一實施例的資料融合切換單元135之操作示意圖。資料融合切換單元135用以切換與選擇第一融合後資料FD1與第二融合後資料FD2,並將所選擇的目標融合後資料傳送至高度與姿態控制模組137。
於步驟405中,資料融合切換單元135進行手動設定,由使用者手動選擇第一融合後資料FD1或第二融合後資料FD2。
於步驟407中,資料融合切換單元135進行自動設定。自動設定(自動切換設定)可設定至少一切換條件,該至少一切換條件包括下列之任意組合(但當知本案並不受限於此):
無線定位精準度判斷(RF localization precision
judgment):根據無線電定位精準度來判定是否要進行資料融合切換。無線電定位包含衛星定位、超寬頻定位、或其它無線電定位方式等。以衛星定位為例,可設定當衛星定位失效或是定位精準度低於一設定值時,選擇第一融合後資料FD1與第二融合後資料FD2之一,而當衛星定位精準度高於設定值時,選擇第一融合後資料FD1與第二融合後資料FD2之另一。例如當定位感測器151提供衛星定位資訊的衛星定位精準度低於設定值時,選擇第一融合後資料FD2,而當衛星定位精準度高於設定值時,選擇第二融合後資料FD1。
定位資訊觸發(Localization information triggering):根據定位資訊來做為觸發切換依據。譬如無人機100位於定位區A時,選擇第一融合後資料FD1與第二融合後資料FD2之一,而當無人機100在定位區B或離開定位區A時,選擇第一融合後資料FD1與第二融合後資料FD2之另一。
感測資訊觸發(Sensing information triggering):使用感測器來做為觸發切換的依據。當距離感測器或照度感測器的感測數值在範圍P內時,選擇第一融合後資料FD1與第二融合後資料FD2之一;以及,當距離感測器或照度感測器數值在另一範圍Q內或離開範圍P時,選擇第一融合後資料FD1與第二融合後資料FD2之另一。
於步驟410中,判斷目前是處於手動設定或自動設定。於一實施例中,可預設為自動設定,於使用者判斷需要時,
設定為手動設定或自動設定。
於步驟420中,根據目前是處於手動設定或自動設定,選擇第一融合後資料FD1與第二融合後資料FD2之一以當成目標融合後資料。
第5A圖與第5B圖顯示根據本案一實施例的2種操作例。第5A圖的第一操作例可應用於外部參考氣壓計51與無人機100之相對高度差是已知的情況下。第5B圖的第二操作例可應用於外部參考氣壓計51與無人機100之相對高度差是未知的情況下。
第5A圖顯示將本案一實施例的無人機100應用於橋下檢測的情境之一。飛行中的無人機100(內建或搭載第一氣壓計110)由橋510的外側保持特定高度,緩緩橫移至橋510的下方。無人機地面控制中心520可控制無人機100及/或外部輔助裝置50。
無人機100的第一氣壓計110與外部輔助裝置50的外部參考氣壓計51在相同或相似的環境中,所以,第一氣壓計110與外部參考氣壓計51感測到類似氣壓變化。由於第一氣壓計110與外部參考氣壓計51的相對高度已知,無人機100便可透過比對第一氣壓計110與外部參考氣壓計51的氣壓計數值P1與P2,來得知因風對氣壓計數值P1所導致的氣壓數值變化,進而重新計算以產生補償後氣壓值P3。藉此可以降低或消弭無人機因時變氣壓(風)的變化而做出不必要的高度調整行為,或是產生飛行的危
險(如往上爬升可能會碰觸到橋體)。
於第5A圖中,無人機100使用本身的GPS模組時間,外部參考氣壓計51則連線至控制中心520使用控制中心的時間,並進行時間同步。在進行氣壓計校正、計算映射後外部參考氣壓值P2remap時,由控制中心520發送「外部參考氣壓計51與無人機100之已知相對高度差」給無人機100。
於第5B圖中,外部輔助裝置50為另一台無人機,可為一般常規無人機,具備衛星定位模組,可於戶外實現良好的懸停。當外部輔助裝置50起飛爬升至適當位置後,進行懸停,此時無人機100與外部輔助裝置50之間維持相對垂直高度關係,無人機100便可參考外部輔助裝置50之外部參考氣壓計51之氣壓計數值,以進行對應的氣壓補償計算,使無人機100保持穩定物理高度,降低或消弭無人機因時變氣壓(風)的變化而做出不必要的高度調整行為。
於第5B圖中,無人機100使用本身的GPS模組時間,外部參考氣壓計51則連線至控制中心520使用控制中心的時間,並進行時間同步。在進行氣壓計校正、計算映射後外部參考氣壓值P2remap時,無人機100參考外部參考氣壓計51的外部參考氣壓值P2來進行高度與姿態控制。
第6圖顯示根據本案一實施例之無人機控制方法之流程圖。於步驟610中,接收第一氣壓計所提供的一第一氣壓值。於步驟620中,對該第一氣壓計之該第一氣壓值與一外部參考氣
壓計所提供之一外部參考氣壓值進行時間同步以得到時間同步校正後的第一氣壓值P1,並重新計算時間同步校正後的第一氣壓值P1以產生一補償後氣壓值。於步驟630中,對該第一氣壓值、該補償後氣壓值與一感測器資料進行資訊融合計算,以得到一目標融合後資料。於步驟640中,根據該目標融合後資料,對該無人機進行實時高度與姿態控制。
本發明一實施例係有關於一種無人機及控制方法,用於協助無人機計算實時高度。參考該外部參考氣壓計的參考氣壓數值,使無人機在時變風環境中,仍能保持較穩定的飛行高度。藉以提高無人機應用於橋架檢測的可用性與安全性。
本發明一實施例係有關於一種無人機及控制方法,應用於無人機橋下檢測等無衛星定位環境,用以降低或消弭環境時變的氣壓(風)影響,避免無人機對實時飛行高度的誤判,避免錯誤的高度調整行為,避免飛行危險。
本發明一實施例係提供低成本的無人機及其控制方法,解決在橋樑檢查場景下,衛星訊號不良或被遮蔽,且時變氣壓(風)造成無人機飛行高度變動過大的問題。
綜上所述,雖然本發明已以實施例揭露如上,然其並非用以限定本發明。本發明所屬技術領域中具有通常知識者,在不脫離本發明之精神和範圍內,當可作各種之更動與潤飾。因此,本發明之保護範圍當視後附之申請專利範圍所界定者為準。
100:無人機
110:第一氣壓計
130:處理單元
151:定位感測器
153:慣性量測元件
155:距離感測器
190:通訊單元
50:外部輔助裝置
51:外部參考氣壓計
53:外部控制模組
131:氣壓計數值處理模組
133A、133B:資料融合單元
135:資料融合切換單元
137:高度與姿態控制模組
132:資料融合模組
Claims (15)
- 一種無人機,包括:一第一氣壓計,提供一第一氣壓值;一處理單元,耦接至該第一氣壓計,該處理單元接收該第一氣壓計所提供的該第一氣壓值,且對該第一氣壓計之該第一氣壓值與一外部參考氣壓計所提供之一外部參考氣壓值進行時間同步以得到時間同步校正後的該第一氣壓值,並重新計算時間同步校正後的該第一氣壓值以產生一補償後氣壓值;以及一感測器群組,耦接至該處理單元,於該感測器群組被觸發時產生一感測器資料而使該處理單元對該第一氣壓值、該補償後氣壓值與該感測器資料進行資訊融合計算,以得到一目標融合後資料,並根據該目標融合後資料,對該無人機進行實時高度與姿態控制。
- 如請求項1所述之無人機,其中,該處理單元執行以下步驟:於該處理單元執行一氣壓計數值處理模組之步驟時,對該第一氣壓計之該第一氣壓值與該外部參考氣壓計所提供之該外部參考氣壓值進行時間同步,並重新計算時間同步校正後的該第一氣壓值以產生該補償後氣壓值;於該處理單元執行一資料融合模組之步驟時,接收該第一氣壓值、該補償後氣壓值與該感測器資料並進行資訊融合計算,以得到該目標融合後資料,其中該資料融合模組包括一第一資料融合單元、一第二資料融合單元及一資料融合切換單元;以及 於該處理單元執行一高度與姿態控制模組之步驟時,以該目標融合後資料來進行高度與姿態控制,該高度與姿態控制模組更回授控制該資料融合模組而使該處理單元執行該資料融合模組之步驟,其中該高度與姿態控制模組包括一慣性量測元件。
- 如請求項2所述之無人機,其中,該第一資料融合單元及該第二資料融合單元包括一延伸卡曼濾波器,該處理單元執行包括以下步驟:於該處理單元執行該第一資料融合單元之步驟時,以該延伸卡曼濾波器接收該補償後氣壓值與該感測器資料並進行資訊融合計算,以得到一第一融合後資料;以及於該處理單元執行該第二資料融合單元之步驟時,以該延伸卡曼濾波器接收該第一氣壓計之該第一氣壓值與該感測器資料並進行資訊融合計算,以得到一第二融合後資料;以及於該處理單元執行該資料融合切換單元之步驟時,以至少一自動設定的切換條件選擇該第一融合後資料或該第二融合後資料以得到該目標融合後資料,並將該目標融合後資料傳送至該高度與姿態控制模組,致使該高度與姿態控制模組對該無人機進行實時高度與姿態控制;其中,該高度與姿態控制模組根據該目標融合後資料來進行高度與姿態控制,該高度與姿態控制模組更回授控制該第一資料融合單元與該第二資料融合單元,以修正對該無人機進行實時高度與姿態控制。
- 如請求項3所述之無人機,其中,該氣壓計數值處理模組包括: 一資料時序同步單元,根據複數個時間標記,同步排列該第一氣壓值與該外部參考氣壓值;一資料校正與分離單元,於一運作狀態時,該資料校正與分離單元輸出一共模氣壓數值和一差模氣壓數值;一氣壓計數值重算單元,根據該共模氣壓數值,產生一重算後第一氣壓值;以及一運算單元,根據該重算後第一氣壓值與該差模氣壓數值得到該補償後氣壓值。
- 如請求項4所述之無人機,其中,於一初始狀態時,該資料校正與分離單元校正經同步排列後的該第一氣壓值與該外部參考氣壓值的一相互偏差值。
- 如請求項4所述之無人機,其中,在計算該共模氣壓數值之前,該資料校正與分離單元將該外部參考氣壓值映射為一映射後外部參考氣壓值,該映射後外部參考氣壓值作為與該第一氣壓值同高度的一氣壓值。
- 如請求項5所述之無人機,其中,該感測器群組包括一定位感測器及、一距離感測器及一照度感測器,於該資料融合切換單元執行該自動設定的至少一切換條件以選擇該第一融合後資料或該第二融合後資料以得到該目標融合後資料之步驟時,該自動設定的該至少一切換條件包括下列之任意組合:該資料融合切換單元於接收該感測器資料時,執行一無線定位精準度判斷之步驟以識別該無線電定位精準度是否高於一預設值來選擇該第一融合後資料或該第二融合後資料,以修正對該無人機進行無線電定位; 該資料融合切換單元於接收該感測器資料時,判斷該無人機是否在一預設的定位區內以執行一定位資訊觸發之步驟而產生一定位資訊來選擇該第一融合後資料或該第二融合後資料以修正對該無人機進行實時高度與姿態控制;以及該資料融合切換單元於該距離感測器或該照度感測器被觸發時接收該感測器資料以執行一感測資訊觸發之步驟,並當該距離感測器或該照度感測器所產生的一感測數值在一預設的範圍內時選擇該第一融合後資料或該第二融合後資料的其中之一以修正對該無人機進行實時高度與姿態控制。
- 一種無人機控制方法,用以控制一無人機,該無人機包括一第一氣壓計及耦接該第一氣壓計的一處理單元,該無人機控制方法包括:由該處理單元接收該第一氣壓計所提供的一第一氣壓值;由該處理單元對該第一氣壓計之該第一氣壓值與一外部參考氣壓計所提供之一外部參考氣壓值進行時間同步以得到時間同步校正後的該第一氣壓值,並重新計算時間同步校正後的該第一氣壓值以產生一補償後氣壓值;由該處理單元對該第一氣壓值、該補償後氣壓值與一感測器資料進行資訊融合計算,以得到一目標融合後資料;以及由該處理單元根據該目標融合後資料,對該無人機進行實時高度與姿態控制。
- 如請求項8所述之無人機控制方法,其中,該無人機更包括耦接該處理單元的一感測器群組,其中該感測器群組包括一定位感測器、一距離感測器與一照度感測器之任意組合,於該 感測器群組被觸發時產生一感測器資料而使該處理單元於得到該目標融合後資料時執行以下步驟:對該補償後氣壓值與該感測器資料進行資訊融合計算,以得到一第一融合後資料,對該第一氣壓計之該第一氣壓值與該感測器資料進行資訊融合計算,以得到一第二融合後資料;以及切換與選擇該第一融合後資料與該第二融合後資料以得到該目標融合後資料。
- 如請求項9所述之無人機控制方法,其中,產生該補償後氣壓值之該步驟包括:根據複數個時間標記,同步排列該第一氣壓值與該外部參考氣壓值;於一運作狀態時,輸出一共模氣壓數值和一差模氣壓數值;根據該共模氣壓數值,產生一重算後第一氣壓值;以及根據該重算後第一氣壓值與該差模氣壓數值得到該補償後氣壓值。
- 如請求項10所述之無人機控制方法,其中,產生該補償後氣壓值之該步驟更包括:於一初始狀態時,校正經同步排列後的該第一氣壓值與該外部參考氣壓值的一相互偏差值。
- 如請求項10所述之無人機控制方法,其中,在計算該共模氣壓數值之前,將該外部參考氣壓值映射為一映射後外部參考氣壓值,該映射後外部參考氣壓值作為與該第一氣壓值同高度的一氣壓值。
- 如請求項11所述之無人機控制方法,其中,該感測器群組包括一定位感測器、一慣性量測元件、一距離感測器與一照度感測器之任意組合,於該處理單元執行該自動設定的一至少一切換條件之步驟中,該自動設定的該至少一切換條件包括下列之任意組合:該處理單元於接收該感測器資料時,執行一無線定位精準度判斷之步驟以識別該一無線電定位精準度是否高於一預設值來選擇該第一融合後資料或該第二融合後資料,以修正對該無人機進行無線電定位;該處理單元於接收該感測器資料時,判斷該無人機是否在一預設的定位區內之步驟以執行而產生一定位資訊觸發,根據一定位資訊來選擇該第一融合後資料或該第二融合後資料以修正對該無人機進行實時高度與姿態控制;以及該處理單元於該距離感測器或該照度感測器被觸發時接收該感測器資料之步驟以執行一感測資訊觸發,並當該距離感測器或該照度感測器所產生的一感測數值在一預設的範圍內時選擇該第一融合後資料或該第二融合後資料的其中之一以修正對該無人機進行實時高度與姿態控制。
- 如請求項12所述之無人機控制方法,其中,當該外部參考氣壓計與該無人機之一相對高度差是已知時,該無人機透過比對該第一氣壓值與該外部參考氣壓值以得知因風對該第一氣壓值所導致的一氣壓數值變化,進而重新計算該氣壓數值變化以產生該補償後氣壓值, 在進行氣壓計校正時,由一控制中心發送該外部參考氣壓計與該無人機之該已知相對高度差給該無人機。
- 如請求項12所述之無人機控制方法,其中,於進行氣壓補償時,當該外部參考氣壓計與該無人機之一相對高度差是未知時,當具有該外部參考氣壓計之一外部輔助裝置起飛爬升至一既定位置後,該外部輔助裝置懸停以使得該無人機與該外部輔助裝置之間維持一相對垂直高度關係,該無人機參考該外部輔助裝置之該外部參考氣壓計之該外部參考氣壓值,以進行氣壓補償。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
TW110149130A TWI806318B (zh) | 2021-12-28 | 2021-12-28 | 無人機及其控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
TW110149130A TWI806318B (zh) | 2021-12-28 | 2021-12-28 | 無人機及其控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
TWI806318B true TWI806318B (zh) | 2023-06-21 |
TW202326332A TW202326332A (zh) | 2023-07-01 |
Family
ID=87803086
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
TW110149130A TWI806318B (zh) | 2021-12-28 | 2021-12-28 | 無人機及其控制方法 |
Country Status (1)
Country | Link |
---|---|
TW (1) | TWI806318B (zh) |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
TWI628113B (zh) * | 2017-08-29 | 2018-07-01 | 財團法人工業技術研究院 | 無人飛行器、判斷無人飛行器降落狀況的系統與方法 |
TW201925033A (zh) * | 2017-11-30 | 2019-07-01 | 財團法人工業技術研究院 | 無人機、無人機控制系統及控制方法 |
US20190310658A1 (en) * | 2016-12-22 | 2019-10-10 | SZ DJI Technology Co., Ltd. | Unmanned aerial vehicle |
CN111459187A (zh) * | 2020-04-20 | 2020-07-28 | 清华大学 | 无人机状态监管方法、装置、系统及可读存储介质 |
US20200272144A1 (en) * | 2019-02-21 | 2020-08-27 | Hangzhou Zero Zero Technology Co., Ltd. | One-handed remote-control device for aerial system |
US20210163133A1 (en) * | 2018-07-27 | 2021-06-03 | SZ DJI Technology Co., Ltd. | Compensation method for barometer-based height measurement and uav |
-
2021
- 2021-12-28 TW TW110149130A patent/TWI806318B/zh active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20190310658A1 (en) * | 2016-12-22 | 2019-10-10 | SZ DJI Technology Co., Ltd. | Unmanned aerial vehicle |
TWI628113B (zh) * | 2017-08-29 | 2018-07-01 | 財團法人工業技術研究院 | 無人飛行器、判斷無人飛行器降落狀況的系統與方法 |
TW201912512A (zh) * | 2017-08-29 | 2019-04-01 | 財團法人工業技術研究院 | 無人飛行器、判斷無人飛行器降落狀況的系統與方法 |
TW201925033A (zh) * | 2017-11-30 | 2019-07-01 | 財團法人工業技術研究院 | 無人機、無人機控制系統及控制方法 |
US20210163133A1 (en) * | 2018-07-27 | 2021-06-03 | SZ DJI Technology Co., Ltd. | Compensation method for barometer-based height measurement and uav |
US20200272144A1 (en) * | 2019-02-21 | 2020-08-27 | Hangzhou Zero Zero Technology Co., Ltd. | One-handed remote-control device for aerial system |
CN111459187A (zh) * | 2020-04-20 | 2020-07-28 | 清华大学 | 无人机状态监管方法、装置、系统及可读存储介质 |
Also Published As
Publication number | Publication date |
---|---|
TW202326332A (zh) | 2023-07-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6132981B2 (ja) | 飛行機の状態をリアルタイムに修正する方法および装置 | |
AU2016339451B2 (en) | Method for controlling small-size unmanned aerial vehicle | |
US9057627B2 (en) | Low cost flight instrumentation system | |
EP2919018B1 (en) | Airspeed calculation system for an aircraft | |
US9714100B2 (en) | Method for detecting a failure of at least one sensor onboard an aircraft implementing a baro-inertial loop, and associated system | |
KR20140123835A (ko) | 무인 항공기 제어 장치 및 그 방법 | |
US11512953B2 (en) | Altitude estimation for aerial vehicles | |
US9108745B2 (en) | Method for detecting a failure of at least one sensor onboard an aircraft implementing an anemo-inertial loop, and associated system | |
JP6375504B2 (ja) | 経緯度誤差共有システム | |
JP7111869B2 (ja) | 機首方位測定システムにおけるセンサ測定の欠如を補償するシステムと方法 | |
WO2018058288A1 (zh) | 用于检测飞行高度的方法、装置及无人机 | |
US20040267444A1 (en) | Hybrid intertial navigation unit with improved altitude integrity | |
JP2018112445A (ja) | 演算装置、演算方法、演算システムおよびプログラム | |
JP2011141262A (ja) | 高度測定装置および方法 | |
RU2635821C1 (ru) | Интегрированная система резервных приборов | |
JP3852842B2 (ja) | 飛翔体の位置姿勢計測装置 | |
TWI806318B (zh) | 無人機及其控制方法 | |
US20210216071A1 (en) | Mapping and Control System for an Aerial Vehicle | |
ES2651369T3 (es) | Sistema y proceso para medición y evaluación de datos aéreos e inerciales | |
AU2021273629A1 (en) | Aircraft sensor system synchronization | |
US11867529B2 (en) | Altitude initialization and monitoring system and method for remote identification systems (remote Id) monitoring and tracking unmanned aircraft systems (UAS) in the national airspace system (NAS) | |
US20230202644A1 (en) | Uav and control method thereof | |
JP2010214979A (ja) | 計算機及び着陸経路計算プログラム及び記録媒体 | |
WO2021217329A1 (zh) | 高度检测方法、补偿量的确定方法、装置和无人机 | |
CN116360478A (zh) | 无人机及其控制方法 |