TWI712327B - 超寬頻輔助精確定位系統及方法 - Google Patents

超寬頻輔助精確定位系統及方法 Download PDF

Info

Publication number
TWI712327B
TWI712327B TW108111089A TW108111089A TWI712327B TW I712327 B TWI712327 B TW I712327B TW 108111089 A TW108111089 A TW 108111089A TW 108111089 A TW108111089 A TW 108111089A TW I712327 B TWI712327 B TW I712327B
Authority
TW
Taiwan
Prior art keywords
mobile base
base stations
ultra
distance
wideband
Prior art date
Application number
TW108111089A
Other languages
English (en)
Other versions
TW202037205A (zh
Inventor
吳瑞北
陳昱志
Original Assignee
英屬維爾京群島商飛思捷投資股份有限公司
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 英屬維爾京群島商飛思捷投資股份有限公司 filed Critical 英屬維爾京群島商飛思捷投資股份有限公司
Priority to TW108111089A priority Critical patent/TWI712327B/zh
Priority to US16/548,673 priority patent/US11002824B2/en
Publication of TW202037205A publication Critical patent/TW202037205A/zh
Application granted granted Critical
Publication of TWI712327B publication Critical patent/TWI712327B/zh

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S5/00Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/02Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
    • G01S5/14Determining absolute distances from a plurality of spaced points of known location
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/02Systems using reflection of radio waves, e.g. primary radar systems; Analogous systems
    • G01S13/0209Systems with very large relative bandwidth, i.e. larger than 10 %, e.g. baseband, pulse, carrier-free, ultrawideband
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/87Combinations of radar systems, e.g. primary radar and secondary radar
    • G01S13/878Combination of several spaced transmitters or receivers of known location for determining the position of a transponder or a reflector
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42Determining position
    • G01S19/48Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S5/00Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/02Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
    • G01S5/0205Details
    • G01S5/0221Receivers
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S5/00Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/02Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
    • G01S5/0205Details
    • G01S5/0226Transmitters
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S2205/00Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S2205/01Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations specially adapted for specific applications
    • G01S2205/06Emergency
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S5/00Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/02Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
    • G01S5/0205Details
    • G01S5/0242Determining the position of transmitters to be subsequently used in positioning

Abstract

本發明公開一種超寬頻輔助精確定位系統,其包括多個移動式基站及中控基地台。中控基地台及該些移動式基站經配置以:通過該超寬頻通訊模組量測該些移動式基站之間的距離,使該移動模組控制該些移動式基站彼此之間具有預定距離並形成預定圖樣;配置全球衛星定位模組進行定位,以取得多個初始位置;執行模式搜索演算法以產生多個修正位置;產生多個預測位置並輸入代價函數,找出誤差相對最小的多個最終預測位置,並通過超寬頻通訊模組量測待測物相對移動式基站的距離,並計算待測物的位置。

Description

超寬頻輔助精確定位系統及方法
本發明涉及一種定位系統及方法,特別是涉及一種超寬頻輔助精確定位系統及方法。
隨著科技的進步,人們越來越頻繁地在廣大海洋上從事各種活動,例如:獨木舟、海釣、浮潛、潛水...等。在從事前述各種活動時,人員如果要進入海中,例如潛水,須要設法標示其位置資訊,以免遭海面船隻碰撞;如果萬一海上氣象發生激烈變化,可能會造成人員的失聯,而嚴重威脅生命安全,有必要及時發送求救信號,以通知附近船隻或救難單位展開救援行動。
此外,台灣地形多高山丘陵,尤其是高山區域雲霧裊繞、多懸崖峭壁及斷崖深谷等地形,每當發生登山客遭遇意外或失蹤的狀況,常導致搜救困難,也會因而延誤搜救進度。
一般收到災難通知後,通常由當地警察局受理,並且安排地面搜救隊以大量人力進行地毯式搜尋,或依需求出動空中警察搜救隊進行高空巡視搜救。而且由於地形崎嶇,氣候不佳,常會發生通訊不良的狀況,因而增加了搜救的困難度。
當無法準確定位受難人員的位置時,在大範圍的山區進行搜尋,除了搜救難度極高,甚至也會影響搜救人員安危,在新聞報導中也常見 各種意外事件層出不窮。
故,如何通過定位的改良,來獲得目標物的精確定位位置,來克服上述的缺陷,已成為該項事業所欲解決的重要課題之一。
本發明所要解決的技術問題在於,針對現有技術的不足提供一種超寬頻輔助精確定位系統及方法。
為了解決上述的技術問題,本發明所採用的其中一技術方案是,提供一種超寬頻輔助精確定位系統,其包括多個移動式基站及中控基地台。多個移動式基站,各包括處理電路、移動模組、超寬頻通訊模組、全球衛星定位模組及第一廣域網路通訊模組。移動模組用於接收控制訊號以控制該移動式基站進行移動。超寬頻通訊模組,經配置以接收及發送超寬頻訊號。全球衛星定位模組,經配置以產生全球衛星定位資訊。第一廣域網路通訊模組,經配置以連接於廣域網路。中控基地台,包括第二廣域網路通訊模組、伺服控制器、儲存單元及中控處理器。第二廣域網路通訊模組,用於與該些基站通過該廣域網路進行通訊。伺服控制器,用於傳送該控制訊號以控制該些移動式基站進行移動。儲存單元,用於儲存一定位演算法。中控處理器,用於執行該定位演算法。其中,該中控基地台及該些移動式基站經配置以:通過該超寬頻通訊模組量測該些移動式基站之間的距離,使該移動模組控制該些移動式基站彼此之間具有一預定距離,且該些移動式基站形成一預定圖樣;配置該些移動式基站的該全球衛星定位模組進行定位,以取得該些移動式基站的多個初始位置;依據該預定圖樣及該預定距離,執行一模式搜索演算法以修正該些初始位置,以產生多個修正位置;產生多個預測位置並輸入一代價函數,用於找出誤差相對最小的多個最終預測位置,其中該代價函數 包括與該預定距離的一距離誤差相關聯的一經驗權重值;以及通過該些移動式基站的各該超寬頻通訊模組量測一待測物相對各該移動式基站的距離,並配置該中控處理器計算該待測物的位置。
為了解決上述的技術問題,本發明所採用的另外一技術方案是,提供一種超寬頻輔助精確定位方法,其包括:配置多個移動式基站,各包括處理電路、移動模組、超寬頻通訊模組、全球衛星定位模組及第一廣域網路通訊模組。移動模組用於接收控制訊號以控制該移動式基站進行移動。超寬頻通訊模組,經配置以接收及發送超寬頻訊號。全球衛星定位模組,經配置以產生全球衛星定位資訊。第一廣域網路通訊模組,經配置以連接於廣域網路。配置中控基地台,包括第二廣域網路通訊模組、伺服控制器、儲存單元及中控處理器。第二廣域網路通訊模組,用於與該些基站通過該廣域網路進行通訊。伺服控制器,用於傳送該控制訊號以控制該些移動式基站進行移動。儲存單元,用於儲存一定位演算法。中控處理器,用於執行該定位演算法。配置該些移動式基站的各該超寬頻通訊模組量測該些移動式基站之間的距離,使該移動模組控制該些移動式基站彼此之間具有一預定距離,且該些移動式基站形成一預定圖樣;配置該些移動式基站的該全球衛星定位模組進行定位,以取得該些移動式基站的多個初始位置;執行一模式搜索演算法,依據該預定圖樣及該預定距離修正該些初始位置,以產生多個修正位置;產生多個預測位置並輸入一代價函數,用於找出誤差相對最小的多個最終預測位置,其中該代價函數與該預定距離相關聯的誤差的一經驗權重值;以及配置該些移動式基站的各該超寬頻通訊模組量測一待測物相對各該移動式基站的距離,並配置該中控處理器計算該待測物的位置。
本發明的其中一有益效果在於,本發明所提供的超寬頻輔助精確定位系統及方法,其能通過使用UWB量測無人機彼此之間距離,並且同時 量測無人機上GPS訊號,再透過UWB改善無人機上的GPS絕對位置。改善後再利用四台無人機定內外位地面上物品,可大幅提昇定位精準度。
為使能更進一步瞭解本發明的特徵及技術內容,請參閱以下有關本發明的詳細說明與圖式,然而所提供的圖式僅用於提供參考與說明,並非用來對本發明加以限制。
1:超寬頻輔助精確定位系統
10、11、12、13:移動式基站
14:廣域網路
100:處理電路
101:移動模組
102:超寬頻通訊模組
103:全球衛星定位模組
104:第一廣域網路通訊模組
15:中控基地台
150:第二廣域網路通訊模組
151:伺服控制器
152:儲存單元
153:中控處理器
ALG:定位演算法
圖1為本發明實施例的超寬頻輔助精確定位系統的方塊圖。
圖2為本發明實施例的移動式基站的方塊圖。
圖3為本發明實施例的中控基地台的方塊圖。
圖4為本發明實施例的超寬頻輔助精確定位方法的流程圖。
圖5為本發明實施例的多個移動式基站的測量示意圖。
圖6為本發明實施例的經驗權重值α對誤差值作圖。
圖7為本發明實施例的預測位置與真實目標位置的示意圖。
圖8為本發明實施例的超寬頻輔助精確定位方法的另一流程圖。
圖9為本發明實施例的經驗權重值α對誤差值另一作圖。
以下是通過特定的具體實施例來說明本發明所公開有關“超寬頻輔助精確定位系統及方法”的實施方式,本領域技術人員可由本說明書所公開的內容瞭解本發明的優點與效果。本發明可通過其他不同的具體實施例加以施行或應用,本說明書中的各項細節也可基於不同觀點與應用,在不悖離本發明的構思下進行各種修改與變更。另外,本發明的附圖僅為簡單示意 說明,並非依實際尺寸的描繪,事先聲明。以下的實施方式將進一步詳細說明本發明的相關技術內容,但所公開的內容並非用以限制本發明的保護範圍。
應當可以理解的是,雖然本文中可能會使用到“第一”、“第二”、“第三”等術語來描述各種元件或者信號,但這些元件或者信號不應受這些術語的限制。這些術語主要是用以區分一元件與另一元件,或者一信號與另一信號。另外,本文中所使用的術語“或”,應視實際情況可能包括相關聯的列出項目中的任一個或者多個的組合。
參閱圖1至圖3,圖1為本發明實施例的超寬頻輔助精確定位系統的方塊圖,圖2為本發明實施例的移動式基站的方塊圖,圖3為本發明實施例的中控基地台的方塊圖。如圖所示,本發明實施例提供一種超寬頻輔助精確定位系統1,其包括多個移動式基站10、11、12、13及中控基地台15。
多個移動式基站10、11、12、13,例如移動式基站10,包括處理電路100、移動模組101、超寬頻通訊模組102、全球衛星定位模組103及第一廣域網路通訊模組104。在本實施例中,移動式基站10、11、12、13的數量為4,但本發明不以此為限。
移動式基站10可為無人飛行載具(Unmanned Aerial Vehicle,UAV),廣義上為不需要駕駛員登機駕駛的各式遙控飛行器。其具有移動模組,例如螺旋槳控制器,用於接收外部控制訊號以控制該移動式基站10進行移動。此外,無人飛行載具亦可結合可遙控的機器性通訊(MTC)元件,如多軸陀螺儀、氣壓計/紅外線測距、超音波測距、相機等。
超寬頻通訊模組102,經配置以接收及發送超寬頻訊號。超寬頻(Ultra-wideband,UWB)是一種具備低耗電與高速傳輸的無線個人區域網路通訊技術,適合需要高質量服務的無線通信應用,可以用在無線個人區域網路(WPAN)、家庭網絡連接和短距離雷達等領域,其利用脈衝訊號來接收 及發送超寬頻訊號。
全球衛星定位模組103,經配置以產生全球衛星定位資訊。第一廣域網路通訊模組104可例如為遠距(Long range,LoRa)廣域網路通訊模組,經配置以連接於廣域網路14。在本發明中,採用了無線感測網路(Wireless sensor network,WSN)技術使無人機群在空中動態組網形成網狀(Mesh)網路架構,並結合LoRa長距離傳輸的優勢,以大幅擴張無人機航管(Unmanned Aircraft System Traffic Management,UTM)系統的涵蓋距離及運作效能。此一網路利用無人機群上的LoRa,依彼此間訊號強度採用最佳路徑演算法開發組成WSN的Mesh拓樸,遠距離傳輸到閘道,再往後連接至中控基地台15整合。此外,移動式基站10、11、12、13彼此之間亦可通過廣域網路14進行傳輸通訊。
中控基地台15,包括第二廣域網路通訊模組150、伺服控制器15、儲存單元152及中控處理器153。詳細來說,第二廣域網路通訊模組150,用於與該些移動式基站10、11、12、13通過該廣域網路14進行通訊。
伺服控制器151用於向移動式基站10、11、12、13傳送控制訊號,以分別控制該些移動式基站10、11、12、13進行移動。在中控基地台15可以得知無人機群彼此之間傳輸距離,使無人機群動態調整慢飛槳(Spreading Factor,SF)參數,以達到最有效率且功耗最大的資料傳輸。
儲存單元152,用於儲存定位演算法ALG,其細節將在下文中描述。中控處理器153,用於執行定位演算法ALG。
其中,請參考圖4,其為本發明實施例的超寬頻輔助精確定位方法的流程圖。
如圖所示,中控基地台15及該些移動式基站10、11、12、13經配置以執行以下步驟:
步驟S100:通過超寬頻通訊模組102量測該些移動式基站10、11、12、13之間的距離,使移動模組101控制該些移動式基站10、11、12、13彼此之間具有預定距離,且該些移動式基站10、11、12、13形成預定圖樣。
步驟S101:配置該些移動式基站10、11、12、13的全球衛星定位模組103進行定位,以取得該些移動式基站10、11、12、13的多個初始位置。
步驟S102:依據預定圖樣及預定距離,執行模式搜索演算法以修正該些初始位置,以產生多個修正位置。模式搜索演算法又稱作直接搜索、無導數搜索或黑盒搜索,是一系列不需要漸變的數值優化方法。因此,其可用於不連續或可微分的功能。這樣的模式搜索方法是在基於正基礎理論的收斂為最終目的,並嘗試在可能性的多維分析空間中找到最佳匹配以進行優化,同時可作為尋找最低誤差值的解決方案。舉例而言,假設一個平面初始值為x0,以初始值x0為基準點,取四個方向計算四個方向的縱軸分量y,並將初始值x0朝向縱軸分量y最小的方向移動,依此類推,再取四個方向隨之移動,直到最終值收斂。模式搜索方法的收斂值可調整,其優勢在於能夠迅速產生結果,但缺點是容易找到局部最小值(local minimum),而並非是系統最佳解。
步驟S103:產生多個預測位置並輸入代價函數,用於找出誤差相對最小的多個最終預測位置。其中,代價函數包括與該預定距離的距離誤差相關聯的經驗權重值。
步驟S104:通過該些移動式基站的各超寬頻通訊模組量測待測物相對各移動式基站的距離,並配置中控處理器計算該待測物的位置。
以下將進一步詳細說明本發明的超寬頻輔助精確定位系統及方法的基礎。首先,建制系統前,須先判定誤差來源並進行修正,因此,大致上分為四個階段,說明如下。
階段一,通過地面真實參考位置實際量測GPS經緯度及高度誤差。其中,在不同時間點,由於衛星的位置隨時間而變化,因此會有不同的誤差,如下表1所示。95%信心水準下的精準度為5.76m,且由於低軌道衛星繞地球一圈約90分鐘,因此有可能導致GPS經緯度隨時間變化大。
Figure 108111089-A0305-02-0011-1
接著,請參考圖5,其為本發明實施例的多個移動式基站的測量示意圖。如圖所示,四個移動式基站10、11、12、13之間溝通進行校正程序,其目的在於利用基站與基站之間的預定距離來自動校正超寬頻通訊模組的硬體誤差。首先,四個基站之間互相量測距離,每個距離量測10次,假設每個移動式基站10、11、12、13的硬體誤差是e i ,i=0~3,則移動式基站10、11、12、13彼此之間量測距離為
Figure 108111089-A0305-02-0011-3
,其中
Figure 108111089-A0305-02-0011-4
為真實距離。因此,利用移動式基站10、11、12、13彼此之間距離的六個距離方程式,可求得移動式基站10、11、12、13的四個未知硬體誤差。計算如下式(1):
Figure 108111089-A0305-02-0011-5
,其中
Figure 108111089-A0305-02-0011-2
因此,利用
Figure 108111089-A0305-02-0011-6
,以及最小平方法,可算出
Figure 108111089-A0305-02-0011-7
(僅為舉例),並且硬體誤差如下表2所示:
Figure 108111089-A0305-02-0012-8
因此,可進一步校正移動式基站10、11、12、13之間的距離如下表3:
Figure 108111089-A0305-02-0012-9
接著,以代價函數計算總誤差,代價函數包括距離誤差及位置誤差,表示如下式(2):
Figure 108111089-A0305-02-0012-10
其中,α為經驗權重值,
Figure 108111089-A0305-02-0012-11
為修正位置,
Figure 108111089-A0305-02-0012-12
為UWB量測值,其固定為預定距離,
Figure 108111089-A0305-02-0012-14
為全球衛星定位模組103產生的初始位置,
Figure 108111089-A0305-02-0012-13
為預測位置。因此,距離誤差為該些預測位置與該些修正位置的多個相對距離及預定距離之間的誤差,位置誤差為該些預測位置與該些修正位置之間的誤差。通過調整經驗權重值α,與地面真實位置比較,可找到誤差最小的經驗權重值α。例如,可參考圖6,其為本發明實施例的經驗權重值α對誤差值作圖。
α從0.05開始到1,每0.05計算一次誤差,找到誤差值最小值。因此,可得到α=0.25時,平均誤差為1.73m。其中,誤差值計算為修正位置與地面真實位置的誤差值。
因此,可進一步參考圖7,其為本發明實施例的預測位置與真實目標位置的示意圖。在本發明的實施例中,採用的全球衛星定位模組在在95%信心水準下精準度為3m,且在此量測環境中,代價函數的經驗權重值α調整至”0.25”為最佳解,經改善後95%信心水準下,預測位置的精準度 為1.8m。
請進一步參考圖8,其為本發明實施例的超寬頻輔助精確定位方法的另一流程圖。
如圖所示,中控基地台15及該些移動式基站10、11、12、13經配置以執行以下步驟:
步驟S200:配置該些移動式基站10、11、12、13的全球衛星定位模組103進行定位,以取得該些移動式基站10、11、12、13的多個初始高度。
步驟S201:依據預定圖樣及預定距離,執行模式搜索演算法以修正該些初始高度,以產生多個修正高度。
步驟S202:產生多個預測高度並輸入代價函數,用於找出誤差相對最小的多個最終預測高度。
步驟S203:通過該些移動式基站10、11、12、13的各該超寬頻通訊模組102量測待測物相對移動式基站10、11、12、13的距離,並配置中控處理器153計算待測物的高度。
類似於位置的修正方式,在本實施例中,將高度誤差納入考量,並引用式(2),其不同之處在於,
Figure 108111089-A0305-02-0013-15
為[X i ,Y i ,Z i ],其包括了初始高度Z i
其中,控制移動式基站10、11、12、13位在相同高度,並通過GPS測量海平面高度,如下表4:
Figure 108111089-A0305-02-0013-16
在相同高度下量測GPS海平面高度,可知彼此相對高度誤差大於6.1m,因此需要使用UWB來改善GPS高度誤差。
類似的,通過調整經驗權重值α,與地面真實高度比較,可找到誤差最小的經驗權重值α。例如,可參考圖9,其為本發明實施例的經驗權重值α對誤差值另一作圖。
α從0.05開始到1,每0.05計算一次誤差,找到誤差值最小值。因此,可得到α=1.45時,平均誤差由11.9m降為9.8m。其中,誤差值計算為修正高度與地面真實高度的誤差值。
因此,可進一步校正移動式基站10、11、12、13的高度如下表5:
Figure 108111089-A0305-02-0014-17
在本發明的實施例中,採用的全球衛星定位模組在95%信心水準下測量高度的精準度為11.9m,且在此量測環境中,代價函數的經驗權重值α調整至”1.45”為最佳解,經改善後95%信心水準下,預測位置的精準度為9.8m。另一方面,相對高度原本相差6.1m,改善後相差3.1m。
[實施例的有益效果]
本發明的其中一有益效果在於,本發明所提供的超寬頻輔助精確定位系統及方法,其能通過使用UWB量測無人機彼此之間距離,並且同時量測無人機上GPS訊號,再透過UWB改善無人機上的GPS絕對位置及相對高度。改善後再利用四台無人機定內外位地面上物品,可大幅提昇定位精準度。
更進一步來說,UAV結合可遙控的機器性通訊(MTC)元件,如多軸陀螺儀、氣壓計/紅外線測距、超音波測距、相機等,預將對物聯網產生 突破性加值應用,本發明應用GPS定位、UWB精準定高、影像精準定位加上LoRa長距離傳輸技術於無人機群的飛航管理(UTM)上,建立符合航空法以及禁飛區域並搭配偵蒐、追蹤及長距離連網技術,並且利用無人機組成可移動式無線感測網(WSN),可以有效分配貨物運輸、緊急救難、物品協尋等諸多應用。
以上所公開的內容僅為本發明的優選可行實施例,並非因此侷限本發明的申請專利範圍,所以凡是運用本發明說明書及圖式內容所做的等效技術變化,均包含於本發明的申請專利範圍內。
1:超寬頻輔助精確定位系統
10、11、12、13:移動式基站
14:廣域網路
15:中控基地台

Claims (10)

  1. 一種超寬頻輔助精確定位系統,其包括:多個移動式基站,各包括:一處理電路;一移動模組,用於接收控制訊號以控制該移動式基站進行移動;一超寬頻通訊模組,經配置以接收及發送超寬頻訊號;一全球衛星定位模組,經配置以產生全球衛星定位資訊;及一第一廣域網路通訊模組,經配置以連接於一廣域網路,一中控基地台,包括:一第二廣域網路通訊模組,用於與該些移動式基站通過該廣域網路進行通訊;一伺服控制器,用於傳送該控制訊號以控制該些移動式基站進行移動;一儲存單元,用於儲存一定位演算法;及一中控處理器,用於執行該定位演算法;其中,該中控基地台及該些移動式基站經配置以:通過該超寬頻通訊模組量測該些移動式基站之間的距離,使該移動模組控制該些移動式基站彼此之間具有一預定距離,且該些移動式基站形成一預定圖樣;配置該些移動式基站的該全球衛星定位模組進行定位,以取得該些移動式基站的多個初始位置;依據該預定圖樣及該預定距離,執行一模式搜索演算法以修正該些初始位置,以產生多個修正位置;產生多個預測位置並輸入一代價函數,用於找出誤差相對最小的多個最終預測位置,其中該代價函數包括與該預定距離的一距離誤差相關聯的一經驗權重值;以及 通過該些移動式基站的各該超寬頻通訊模組量測一待測物相對各該移動式基站的距離,並配置該中控處理器執行該定位演算法計算該待測物的位置。
  2. 如申請專利範圍第1項所述的超寬頻輔助精確定位系統,其中該些移動式基站的數量為4或以上。
  3. 如申請專利範圍第1項所述的超寬頻輔助精確定位系統,其中該些移動式基站更經配置以執行一校正程序,包括:通過該超寬頻通訊模組量測該些移動式基站之間的距離,以產生多個距離方程式,各該距離方程式包括該些移動式基站的多個硬體誤差;以及以該些距離方程式求得該些硬體誤差。
  4. 如申請專利範圍第1項所述的超寬頻輔助精確定位系統,其中該代價函數包括該距離誤差及一位置誤差,該距離誤差為該些預測位置與該些修正位置的多個相對距離及該預定距離之間的誤差,該位置誤差為該些預測位置與該些修正位置之間的誤差。
  5. 如申請專利範圍第1項所述的超寬頻輔助精確定位系統,其中該中控基地台及該些移動式基站經配置以:配置該些移動式基站的該全球衛星定位模組進行定位,以取得該些移動式基站的多個初始高度;依據該預定圖樣及該預定距離,執行一模式搜索演算法以修正該些初始高度,以產生多個修正高度;產生多個預測高度並輸入該代價函數,用於找出誤差相對最小的多個最終預測高度;以及通過該些移動式基站的各該超寬頻通訊模組量測該待測物相對各該移動式基站的距離,並配置該中控處理器計算該待測物的高度。
  6. 一種超寬頻輔助精確定位方法,其包括:配置多個移動式基站,各包括:一處理電路;一移動模組,用於接收控制訊號以控制該移動式基站進行移動;一超寬頻通訊模組,經配置以接收及發送超寬頻訊號;一全球衛星定位模組,經配置以產生全球衛星定位資訊;及一第一廣域網路通訊模組,經配置以連接於一廣域網路,配置一中控基地台,包括:一第二廣域網路通訊模組,用於與該些移動式基站通過該廣域網路進行通訊;一伺服控制器,用於傳送該控制訊號以控制該些移動式基站進行移動;一儲存單元,用於儲存一定位演算法;及一中控處理器;配置該些移動式基站的各該超寬頻通訊模組量測該些移動式基站之間的距離,使該移動模組控制該些移動式基站彼此之間具有一預定距離,且該些移動式基站形成一預定圖樣;配置該些移動式基站的該全球衛星定位模組進行定位,以取得該些移動式基站的多個初始位置;執行一模式搜索演算法,依據該預定圖樣及該預定距離修正該些初始位置,以產生多個修正位置;產生多個預測位置並輸入一代價函數,用於找出誤差相對最小的多個最終預測位置,其中該代價函數包括與該預定距離的一距離誤差相關聯的一經驗權重值;以及配置該些移動式基站的各該超寬頻通訊模組量測一待測物相對各該移動式基站的距離,並配置該中控處理器執行該定位演 算法計算該待測物的位置。
  7. 如申請專利範圍第6項所述的超寬頻輔助精確定位方法,其中該些移動式基站的數量為4。
  8. 如申請專利範圍第6項所述的超寬頻輔助精確定位方法,更包括:配置該些移動式基站以執行一校正程序,包括:通過該超寬頻通訊模組量測該些移動式基站之間的距離,以產生多個距離方程式,各該距離方程式包括該些移動式基站的多個硬體誤差;以及以該些距離方程式求得該些硬體誤差。
  9. 如申請專利範圍第6項所述的超寬頻輔助精確定位方法,其中該代價函數包括該距離誤差及一位置誤差,該距離誤差為該些預測位置與該些修正位置的多個相對距離及該預定距離之間的誤差,該位置誤差為該些預測位置與該些修正位置之間的誤差。
  10. 如申請專利範圍第6項所述的超寬頻輔助精確定位方法,更包括:配置該些移動式基站的該全球衛星定位模組進行定位,以取得該些移動式基站的多個初始高度;依據該預定圖樣及該預定距離,執行一模式搜索演算法以修正該些初始高度,以產生多個修正高度;產生多個預測高度並輸入該代價函數,用於找出誤差相對最小的多個最終預測高度;以及通過該些移動式基站的各該超寬頻通訊模組量測該待測物相對各該移動式基站的距離,並配置該中控處理器計算該待測物的高度。
TW108111089A 2019-03-28 2019-03-28 超寬頻輔助精確定位系統及方法 TWI712327B (zh)

Priority Applications (2)

Application Number Priority Date Filing Date Title
TW108111089A TWI712327B (zh) 2019-03-28 2019-03-28 超寬頻輔助精確定位系統及方法
US16/548,673 US11002824B2 (en) 2019-03-28 2019-08-22 Ultra-wideband assisted precise positioning system and method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
TW108111089A TWI712327B (zh) 2019-03-28 2019-03-28 超寬頻輔助精確定位系統及方法

Publications (2)

Publication Number Publication Date
TW202037205A TW202037205A (zh) 2020-10-01
TWI712327B true TWI712327B (zh) 2020-12-01

Family

ID=72607116

Family Applications (1)

Application Number Title Priority Date Filing Date
TW108111089A TWI712327B (zh) 2019-03-28 2019-03-28 超寬頻輔助精確定位系統及方法

Country Status (2)

Country Link
US (1) US11002824B2 (zh)
TW (1) TWI712327B (zh)

Families Citing this family (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TWI745153B (zh) * 2020-11-06 2021-11-01 英屬維爾京群島商飛思捷投資股份有限公司 超寬頻定位方法、裝置及系統
CN112832152A (zh) * 2020-12-31 2021-05-25 山西省交通科技研发有限公司 一种基于融合定位技术的智慧锥桶
CN113286360A (zh) * 2021-05-12 2021-08-20 重庆菲莫科技有限公司 一种地下矿用uwb定位系统和定位方法
CN113253203A (zh) * 2021-06-02 2021-08-13 常州市工业互联网研究院有限公司 基于uwb的室内定位系统
CN113709662B (zh) * 2021-08-05 2023-12-01 北京理工大学重庆创新中心 一种基于超宽带的自主式三维反演定位方法
CN113766626A (zh) * 2021-08-24 2021-12-07 国网思极神往位置服务(北京)有限公司 基于北斗授时的uwb定位系统时隙同步控制方法、设备、存储介质和程序产品
CN113891245B (zh) * 2021-11-17 2024-04-26 西安邮电大学 一种火场消防员协同接力定位方法
CN114222365B (zh) * 2021-12-24 2024-03-05 杭州海康威视数字技术股份有限公司 一种基于单基站的超宽带定位方法、装置、计算单元、系统
CN114430524B (zh) * 2021-12-30 2023-09-01 杭州海康威视数字技术股份有限公司 一种超宽带基站的标定方法、装置及电子设备
CN116132917B (zh) * 2023-01-05 2023-10-20 深圳大学 一种面向狭长空间的室内定位装置及方法

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20050267677A1 (en) * 2002-09-06 2005-12-01 Sami Poykko Method and system for estimating the position of a mobile device
US20160353238A1 (en) * 2015-05-29 2016-12-01 Verity Studios Ag Methods and systems for scheduling the transmission of localization signals and operating self-localizing apparatus
US9538328B1 (en) * 2007-02-28 2017-01-03 Polaris Wireless, Inc. Estimating whether or not a wireless terminal is in a geographic zone using pattern classification

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20180045807A1 (en) * 2016-08-12 2018-02-15 5D Robotics, Inc. Global Positioning System and Ultra Wide Band Universal Positioning Node Consellation integration

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20050267677A1 (en) * 2002-09-06 2005-12-01 Sami Poykko Method and system for estimating the position of a mobile device
US9538328B1 (en) * 2007-02-28 2017-01-03 Polaris Wireless, Inc. Estimating whether or not a wireless terminal is in a geographic zone using pattern classification
US20160353238A1 (en) * 2015-05-29 2016-12-01 Verity Studios Ag Methods and systems for scheduling the transmission of localization signals and operating self-localizing apparatus

Also Published As

Publication number Publication date
TW202037205A (zh) 2020-10-01
US20200309895A1 (en) 2020-10-01
US11002824B2 (en) 2021-05-11

Similar Documents

Publication Publication Date Title
TWI712327B (zh) 超寬頻輔助精確定位系統及方法
US20210293977A1 (en) Systems and methods for positioning of uav
US10771923B2 (en) Methods and systems for the location and monitoring of mobile units
CN103869822B (zh) 多旋翼无人机感知与规避系统及其规避方法
US20230324562A1 (en) Stratospheric position, navigation, and timing system
US20070099628A1 (en) Determining relative elevation using gps and ranging
US10732259B2 (en) Thresholds for transmitting weather data
Kim et al. A UWB positioning network enabling unmanned aircraft systems auto land
Bamberger et al. Autonomous geolocation of RF emitters using small, unmanned platforms
JP2019007964A (ja) Uavの位置を推定するシステム及び方法
CN107087441B (zh) 一种信息处理方法及其装置
Martinez-Heredia et al. Development of an emergency radio beacon for small unmanned aerial vehicles
CN104501828B (zh) 一种通用航空机载监视系统
Zeng et al. A UAV localization system based on double UWB tags and IMU for landing platform
Huff et al. Assured relative and absolute navigation of a swarm of small UAS
GB2593121A (en) Deployable location system
US11499827B2 (en) Multi-aircraft vision and datalink based navigation system and method
Tian et al. Improvement of RSS-based measurement based on adaptive Kalman filter considering the anisotropy on antenna in dynamic environment
KR102488642B1 (ko) Gnss 오차 공유를 이용한 드론 협동 항법
Kelner et al. Portable beacon system for emergency mountain landing pad
CN114928812B (zh) 一种航空器应急搜寻装置、系统及方法
Oh et al. Airborne-relay-based algorithm for locating crashed UAVs in GPS-denied environments
Wang et al. Distributed collaborative navigation based on rank-defect free network
US20240106742A1 (en) Spatial awareness navigation techniques on unmanned aerial vehicles (spatial awareness)
Cramer et al. Enhanced UAS Availability via Vehicle to Vehicle Routing Scaled Experiments