TWI745156B

TWI745156B - 定位方法與系統

Info

Publication number: TWI745156B
Application number: TW109139213A
Authority: TW
Inventors: 容丕達; 陳冠佑; 林承汶; 郭承宗; 康智閔; 謝興達; 黃聰文
Original assignee: 財團法人金屬工業研究發展中心
Priority date: 2020-11-10
Filing date: 2020-11-10
Publication date: 2021-11-01
Also published as: TW202219542A

Abstract

本揭露提出一種定位方法，適用於一無人機。此無人機具有多個距離感測器且行進在一裝置的內部，此裝置具有至少一轉動軸。定位方法包括：取得裝置的姿態角，根據姿態角取得裝置的內部的一目前輪廓模型；取得距離感測器的感測器資訊；在裝置的內部設定多個預設位置，並且模擬無人機在每一個預設位置上距離感測器所量測的數值以取得每一個預設位置上的多個預設距離值；以及透過距離感測器取得多個目前距離值，比對目前距離值與預設距離值以取得無人機在裝置內的位置。

Description

定位方法與系統

本揭露是關於使用無人機的定位方法。

風力機葉片外殼與內部抗剪腹板之黏合在其20~25年之運轉週期內是否有分離，對風力機之壽命極其重要，黏合處之檢查無法由人力自葉片外目視檢測，僅能依賴人力敲打，再由聲音判斷黏合處是否已分離。因此目前市場上具有自葉片內部檢測之需求。

葉片內部僅能待風力機停機時由軸轂透過內部開口往下進入，僅適合以儀器檢測，而不適合人員進入。葉片內部由於缺乏照明及定位參考物，因此移動載具或飛行載具進行各種檢測時，操作者難以得悉受檢測部位之精確位置。因此，如何提供葉片內部的定位方法，為此領域技術人員所關心的議題。

本揭露的實施例提出一種定位方法，適用於一無人機。此無人機具有多個距離感測器且行進在一裝置的內部，此裝置具有至少一轉動軸。定位方法包括：取得裝置的姿態角，根據姿態角取得裝置的內部的一目前輪廓模型；取得距離感測器的感測器資訊；在裝置的內部設定多個預設位置，並且根據目前輪廓模型與感測器資訊模擬無人機在每一個預設位置上距離感測器所量測的數值以取得每一個預設位置上的多個預設距離值；以及透過距離感測器取得多個目前距離值，比對目前距離值與每一預設位置上的預設距離值以取得無人機在裝置內的位置。

在一些實施例中，上述的裝置為風力機，姿態角包括方位角與槳距角，感測器資訊包括距離感測器的數量。

在一些實施例中，上述的定位方法，還包括：建立一資料庫，此資料庫儲存有風力機在特定的方位角與特定的槳距角時的輪廓模型，輪廓模型包括風力機的葉片在多個剖面的多個座標點。

在一些實施例中，無人機包括慣性量測單元，無人機包括多個環狀元件，環狀元件的兩個交點形成方向軸，距離感測器設置在環狀元件上。上述的定位方法還包括：根據慣性量測單元所讀取的數值維持方向軸的方向不變。

在一些實施例中，上述比對目前距離值與每一個預設位置上的預設距離值以取得無人機在裝置內的位置的步驟包括：從預設距離值中取得最近似目前距離值的預設距離值，並取得所對應的第一預設位置；如果第一預設位置的數量大於1，則取最靠近先前位置的第一預設位置以作為無人機在裝置內的位置；以及如果第一預設位置的數量等於1，將第一預設位置設定為無人機在裝置內的位置。

以另一個角度來說，本發明的實施例提出一種定位系統，包括裝置、無人機與計算模組。裝置具有至少一個轉動軸。無人機具有多個距離感測器且用以行進在裝置的內部。計算模組用以取得裝置的姿態角，根據姿態角取得裝置的內部的目前輪廓模型。計算模組還用以取得距離感測器的感測器資訊，在裝置的內部設定多個預設位置，並且根據目前輪廓模型與感測器資訊模擬無人機在每一個預設位置上距離感測器所量測的數值以取得每一個預設位置上的多個預設距離值。計算模組還用以透過距離感測器取得多個目前距離值，比對目前距離值與每一個預設位置上的預設距離值以取得無人機在裝置內的位置。

在一些實施例中，計算模組還用以建立一資料庫，此資料庫儲存有風力機在特定的方位角與特定的槳距角時的輪廓模型，輪廓模型包括風力機的葉片在多個剖面的多個座標點。

在一些實施例中，無人機包括慣性量測單元，無人機包括多個環狀元件，環狀元件的兩個交點形成一方向軸，距離感測器設置在環狀元件上。無人機還用以根據慣性量測單元所讀取的數值維持方向軸的方向不變。

在一些實施例中，計算模組還用以：從預設距離值中取得最近似目前距離值的預設距離值，並取得所對應的至少第一預設位置；如果第一預設位置的數量大於1，則取最靠近一先前位置的第一預設位置以作為無人機在裝置內的位置；以及如果第一預設位置的數量等於1，將第一預設位置設定為無人機在裝置內的位置。

在上述的系統與方法中，即使裝置會轉動也可以定位無人機在裝置內部的位置。

關於本文中所使用之「第一」、「第二」等，並非特別指次序或順位的意思，其僅為了區別以相同技術用語描述的元件或操作。

在此提出一種定位方法，用於一無人機與一裝置。在此，無人機是指可自動駕駛之無人飛行載具(Unmanned Aerial Vehicle，UAV)，可搭載攝影機作為高空取像用途。上述的裝置具有轉動軸，裝置可繞著轉動軸轉動。無人機是用以行進在裝置內部，在裝置無變形的情形下，雖然裝置內部的幾何形狀大致相同，但由於裝置會轉動，在不同的轉動角度時裝置內部的環境皆不同，本揭露提出的方法可以計算出無人機在裝置內部的位置。

在一些實施例中，上述的裝置為風力機，圖1是根據一實施例繪示風力機的示意圖。請參照圖1，風力機100包括了機艙110、軸轂120與多個葉片131~133。軸轂120繞著轉動軸(亦稱第一軸)XB轉動，此轉動軸XB與水平線的夾角稱為偏航角度Ψ。葉片131~133也繞著轉動軸XB轉動，葉片131~133轉動時所形成的平面稱為旋轉平面。葉片132連接軸轂120的一端與相對的另一端形成第三軸ZB，另外第二軸YB垂直於第三軸ZB與第一軸XB。第三軸ZB與垂直地面的軸線Z之間的角度稱為方向角Φ。另外，槳距角的說明請參照圖2，風從第一軸XB的正方向吹來，葉片132的兩端之間的連線(亦稱翼型弦線)與旋轉平面210之間的角度稱為槳距角θ。葉片132中可具有一或多個抗剪腹板，圖2僅是一範例，本發明並不限制葉片132的形狀與內部結構。

在此風力機100、計算模組140與風力機100內部的無人機(未繪示於圖1)組成一個定位系統。計算模組140可以是筆記型電腦或任意有計算能力的電子裝置。計算模組140可與無人機通訊，協助無人機在風力機葉片內部的定位。

圖3A是根據一實施例繪示無人機的外部示意圖，圖3B是根據一實施例繪示無人機的電路示意圖。請參照圖3A與圖3B，無人機300包括控制器310、動力模組320、影像擷取模組330、慣性量測單元340、通訊模組350與距離感測器360。控制器310可為微控制器(MCU)、數位訊號處理器(DSP)、運算控制卡(Computing Control Cards)或工業電腦(IPC)等。動力模組320可為任何能使無人飛行載具移動之動力產生構造，例如螺旋槳動力模組等。影像擷取模組330可包括感光耦合元件(Charge-coupled Device，CCD)感測器、互補性氧化金屬半導體(Complementary Metal-Oxide Semiconductor)感測器或其他合適的感光元件。慣性量測單元340可包括加速度感測器、角速度感測器與磁力計等。通訊模組350可包括藍芽(Blue-tooth)、無線保真(WiFi)、行動通訊(mobile communication)等技術規格之通訊模組。距離感測器360可包括具有距離感測功能之裝置，例如光學測距儀或超音波測距儀等。

無人機300還包括兩個環狀元件371、372，這兩個環狀元件371、372之間的夾角例如為90度，環狀元件371、372上設置有多個距離感測器360。在一些實施例中，每個環狀元件上設置有至少4個距離感測器360，但在其他實施例中也可以在每個環狀元件上設置更多或更少個距離感測器，或者無人機300可包括更多的環狀元件，本發明並不在此限。在此實施例中，兩個環狀元件371、372的兩交點之間的連線形成一方向軸380。

圖4是根據一實施例繪示定位方法的流程圖。請參照圖4，此方法包括檢測作業準備階段410與檢測作業進行階段420。

在此先說明檢測作業準備階段410。請參照圖1與圖4，首先，在步驟411，計算模組140可取得風力機100的至少一個姿態角，此姿態角例如包括方向角Φ、偏航角度Ψ與槳距角θ。根據上述的姿態角，計算模組140可以計算出在此特定姿態角下風力機100內部的目前輪廓模型。具體來說，計算模組140可以事先取得葉片131~133的輪廓模型，輪廓模型包括了葉片在多個剖面的多個座標點，每個座標點都有X、Y、Z三個座標。舉例來說，請參照圖2，其中葉片132在第三軸ZB上的一個剖面上具有六個座標點，這些座標點分別是[X11,Y11,Z1]、[X12,Y12,Z1]、[X13,Y13,Z1]、[X14,Y14,Z1]、[X15,Y15,Z1]、[X16,Y16,Z1]，這些座標點上的Z座標皆相同。如果葉片有10個剖面，每個剖面上有20個座標點，則輪廓模型有200個座標點，然而剖面與座標點的數目並不在此限。由於葉片會轉動，因此上述的座標必須連帶地調整，在此可以先計算葉片在每個方向角Φ、偏航角度Ψ與槳距角θ時每個座標點為何，在此可以採用任意的座標轉換公式來對座標點進行位移或旋轉，本揭露並不在此限，這些調整後的座標點可事先儲存在資料庫412中。如果方向角共有360個，槳距角有10個，偏航角度為固定，資料庫412總共會有200*360*10個座標點。在步驟413中，可根據所取得的方向角Φ與槳距角θ從資料庫412中取得對應的輪廓模型(包括200個座標點)，稱為目前輪廓模型。

另外，在步驟414中，取得感測器資訊，這些感測器資訊可包括距離感測器360的數量、位置與感測方向。在步驟415中，計算相對座標的距離值。具體來說，圖5是根據一實施例繪示葉片內部的示意圖。在此可在風力機葉片132的內部設定多個預設位置510，為了簡化起見圖5並未繪示所有的預設位置，由於葉片132的目前輪廓模型是已知，也就是葉片132內部輪廓上的每個座標點是已知，因此可以根據感測器資訊模擬無人機在每個預設位置510上距離感測器360所量測的數值。舉例來說，根據感測器資訊可得知有一個距離感測器的感測方向是往上，在預設位置511上此距離感測器所量測的數值是距離d1；另一個距離感測器的感測方向是往下，在預設位置511上此距離感測器所量測的數值是距離d2，以此類推，這些量測到的數值稱為預設距離值。如果無人機上共有N個距離感測器，則每個預設位置上都可計算出N個預設距離值，這N個預設距離值可以組成一個向量，如果葉片132內部有M個預設位置，則總共會產生M個向量，其中N、M為正整數。

在一些實施例中，上述模擬時也可以用內插法來計算出預設距離值。請參照圖6，在此要計算預設位置610往右至內部輪廓上座標點[I,J,K]之間的預設距離值，預設位置610的座標點假設為[U,V,Z]，而內部輪廓上最近的兩個座標點分別是[X12,Y12,Z1]與[X22,Y22,Z2]。由於圖6所繪示的是轉動軸XB方向上的剖面，因此圖中所有的X座標皆相同，也就是說X12=I=X22=U，為了簡化起見，以下距離的計算只採用兩個維度。當方向角為Φ時，預設位置610往右至座標點[I,J,K]之間的預設距離值計算如以下數學式1，其中座標J的計算如數學式2，座標K的計算如數學式3。 [數學式1]

[數學式2]

[數學式3]

請參照圖4與圖5，在檢測作業進行階段420中，首先在步驟421透過距離感測器360取得目前距離值，這些目前距離值可以組成長度為N的向量。在步驟422中，比對目前距離值與每一個預設位置上的預設距離值以取得無人機300在葉片132內的位置。舉例來說，如果無人機300位於預設位置511，則距離感測器360所量測的目前距離值應該也會包括距離d1與距離d2，因此透過比對的方式可以知道無人機300的位置。具體來說，可以計算目前距離值所組成的向量和預設距離值所組成的M個向量中每個向量之間的誤差，此誤差可以為歐基里得距離，但本揭露並不在此限。也就是說，在上述例子中共可計算出M個誤差，誤差越小表示兩個向量越相似，接著可以從預設距離值所組成的M個向量中取得最近似的向量，所對應的預設位置稱為第一預設位置。如果最近似的向量只有一個，則第一預設位置的數量等於1，此第一預設位置可設定為無人機300在葉片132內的位置。如果最近似的向量有多個，表示第一預設位置的數目大於1，則先取得無人機300在上一時間點的先前位置，然後取得最靠近先前位置的第一預設位置以作為無人機300在葉片132的位置。在一些實施例中，也可以採用卡爾曼濾波器(kalman filter)或是粒子濾波器(particle filter)等追蹤手段來決定無人機的位置。

在上述實施例中是比對距離感測器所量測的數值來計算無人機的位置，由於當無人機轉動時，距離感測器的感測方向也會跟著改變，因此在一些實施例中必須維持無人機的方向不變。在一些實施例中，檢測作業準備階段410還包括步驟416、417。在步驟416中，取得方向軸，在此實施例中是取得兩個環狀元件之間的交點所形成的方向軸380(如圖3A所示)，但在其他實施例中也可以採用其他的方向軸，本揭露並不在此限。在步驟417中，讀取慣性量測單元的數值，計算方向軸380目前的方向。另一方面，檢測作業進行階段420還包括步驟423、424。在步驟423中，讀取慣性量測單元的數值。在步驟424中，根據慣性量測單元所讀取的數值維持方向軸380不變。舉例來說，慣性量測單元中具有磁力計，因此可以得知方向軸380目前的方向，如果目前的方向軸偏離了步驟417決定的方向，則依照動力模組320改變無人機300的方向，使得方向軸的方向維持不變。

在一些實施例中，圖4的方法可應用於任意會轉動的裝置，此裝置也可以是太陽能模組等，本揭露並不在此限。在上述的定位方法與系統中，即使裝置會旋轉還是可以計算出無人機在裝置內部的位置，進而可以讓無人機進行檢查、維修等工作。

雖然本發明已以實施例揭露如上，然其並非用以限定本發明，任何所屬技術領域中具有通常知識者，在不脫離本發明的精神和範圍內，當可作些許的更動與潤飾，故本發明的保護範圍當視後附的申請專利範圍所界定者為準。

100:風力機 110:機艙 120:軸轂 XB:轉動軸 YB:第二軸 ZB:第三軸 131~133:葉片 140:計算模組 θ:槳距角 Ψ:領航角 Φ:方向角 Z:軸線 210:旋轉平面 300:無人機 310:控制器 320:動力模組 330:影像擷取模組 340:慣性量測單元 350:通訊模組 360:距離感測器 371,372:環狀元件 380:方向軸 410:檢測作業準備階段 420:檢測作業進行階段 411,413~417,421~424:步驟 412:資料庫 510,512:預設位置 d1,d2:距離 610:預設位置

為讓本發明的上述特徵和優點能更明顯易懂，下文特舉實施例，並配合所附圖式作詳細說明如下。 [圖1]是根據一實施例繪示風力機的示意圖。 [圖2]是根據一實施例繪示槳距角的示意圖。 [圖3A]是根據一實施例繪示無人機的外部示意圖。 [圖3B]是根據一實施例繪示無人機的電路示意圖。 [圖4]是根據一實施例繪示定位方法的流程圖。 [圖5]是根據一實施例繪示葉片內部的示意圖。 [圖6]是根據一實施例繪示用內插法來計算預設距離值的示意圖。

410:檢測作業準備階段

420:檢測作業進行階段

411,413~417,421~424:步驟

412:資料庫

Claims

一種定位方法，適用於一無人機，該無人機具有多個距離感測器且行進在一裝置的內部，該裝置具有至少一轉動軸，該定位方法包括：取得該裝置的至少一姿態角，根據該至少一姿態角取得該裝置的內部的一目前輪廓模型，其中該裝置為一風力機，該至少一姿態角包括一方位角與一槳距角；取得該些距離感測器的感測器資訊，該感測器資訊包括該些距離感測器的數量；在該裝置的內部設定多個預設位置，並且根據該目前輪廓模型與該感測器資訊模擬該無人機在每一該些預設位置上該些距離感測器所量測的數值以取得每一該些預設位置上的多個預設距離值；以及透過該些距離感測器取得多個目前距離值，比對該些目前距離值與每一該些預設位置上的該些預設距離值以取得該無人機在該裝置內的位置。
如請求項1所述之定位方法，還包括：建立一資料庫，其中該資料庫儲存有該風力機在特定的該方位角與特定的該槳距角時的輪廓模型，該輪廓模型包括該風力機的葉片在多個剖面的多個座標點。
如請求項1所述之定位方法，其中該無人機包括一慣性量測單元，該無人機包括多個環狀元件，該些環狀元件的兩個交點形成一方向軸，該些距離感測器設置在該些環狀元件上，該定位方法還包括：根據該慣性量測單元所讀取的數值維持該方向軸的方向不變。
如請求項1所述之定位方法，其中比對該些目前距離值與每一該些預設位置上的該些預設距離值以取得該無人機在該裝置內的位置的步驟包括：從該些預設位置上的該些預設距離值中取得最近似該些目前距離值的該些預設距離值，並取得所對應的至少一第一預設位置；如果該至少一第一預設位置的數量大於1，則取最靠近一先前位置的該第一預設位置以作為該無人機在該裝置內的位置；以及如果該至少一第一預設位置的數量等於1，將該第一預設位置設定為該無人機在該裝置內的位置。
一種定位系統，包括：一裝置，具有至少一轉動軸；一無人機，具有多個距離感測器且用以行進在該裝置的內部；以及一計算模組，用以取得該裝置的至少一姿態角，根據該至少一姿態角取得該裝置的內部的一目前輪廓模型，其中該裝置為一風力機，該至少一姿態角包括一方位角與一槳距角，其中該計算模組還用以取得該些距離感測器的感測器資訊，該感測器資訊包括該些距離感測器的數量，該計算模組還用以在該裝置的內部設定多個預設位置，並且根據該目前論括模型與該感測器資訊模擬該無人機在每一該些預設位置上該些距離感測器所量測的數值以取得每一該些預設位置上的多個預設距離值，其中該計算模組還用以透過該些距離感測器取得多個目前距離值，比對該些目前距離值與每一該些預設位置上的該些預設距離值以取得該無人機在該裝置內的位置。
如請求項5所述之定位系統，其中該計算模組還用以建立一資料庫，其中該資料庫儲存有該風力機在特定的該方位角與特定的該槳距角時的輪廓模型，該輪廓模型包括該風力機的葉片在多個剖面的多個座標點。
如請求項5所述之定位系統，其中該無人機包括一慣性量測單元，該無人機包括多個環狀元件，該些環狀元件的兩個交點形成一方向軸，該些距離感測器設置在該些環狀元件上，其中該無人機還用以根據該慣性量測單元所讀取的數值維持該方向軸的方向不變。
如請求項5所述之定位系統，其中該計算模組還用以：從該些預設位置上的該些預設距離值中取得最近似該些目前距離值的該些預設距離值，並取得所對應的至少一第一預設位置；如果該至少一第一預設位置的數量大於1，則取最靠近一先前位置的該第一預設位置以作為該無人機在該裝置內的位置；以及如果該至少一第一預設位置的數量等於1，將該第一預設位置設定為該無人機在該裝置內的位置。