TW202222640A - 船舶內河航運光達辨識系統及其運作方法 - Google Patents

船舶內河航運光達辨識系統及其運作方法 Download PDF

Info

Publication number
TW202222640A
TW202222640A TW109142362A TW109142362A TW202222640A TW 202222640 A TW202222640 A TW 202222640A TW 109142362 A TW109142362 A TW 109142362A TW 109142362 A TW109142362 A TW 109142362A TW 202222640 A TW202222640 A TW 202222640A
Authority
TW
Taiwan
Prior art keywords
point
point cloud
cloud set
lidar
map data
Prior art date
Application number
TW109142362A
Other languages
English (en)
Other versions
TWI792108B (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 TW109142362A priority Critical patent/TWI792108B/zh
Priority to EP20212063.0A priority patent/EP4009078A1/en
Priority to US17/307,977 priority patent/US20220171062A1/en
Priority to CN202110528006.6A priority patent/CN114594759A/zh
Priority to JP2021094157A priority patent/JP7174111B2/ja
Priority to KR1020210076534A priority patent/KR102627540B1/ko
Publication of TW202222640A publication Critical patent/TW202222640A/zh
Application granted granted Critical
Publication of TWI792108B publication Critical patent/TWI792108B/zh

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/0206—Control of position or course in two dimensions specially adapted to water vehicles
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/38—Electronic maps specially adapted for navigation; Updating thereof
    • G01C21/3804—Creation or updating of map data
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20—Instruments for performing navigational calculations
    • G01C21/203—Specially adapted for sailing ships
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/34—Route searching; Route guidance
    • G01C21/36—Input/output arrangements for on-board computers
    • G01C21/3667—Display of a road map
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO 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
    • G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/02—Systems using the reflection of electromagnetic waves other than radio waves
    • G01S17/06—Systems determining position data of a target
    • G01S17/08—Systems determining position data of a target for measuring distance only
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO 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
    • G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/88—Lidar systems specially adapted for specific applications
    • G01S17/89—Lidar systems specially adapted for specific applications for mapping or imaging
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO 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
    • G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/88—Lidar systems specially adapted for specific applications
    • G01S17/93—Lidar systems specially adapted for specific applications for anti-collision purposes
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO 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
    • G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
    • G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
    • G01S7/4808—Evaluating distance, position or velocity data
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO 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
    • G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
    • G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
    • G01S7/51—Display arrangements

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Electromagnetism (AREA)
  • Automation & Control Theory (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Navigation (AREA)
  • Optical Radar Systems And Details Thereof (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Image Analysis (AREA)
  • Position Fixing By Use Of Radio Waves (AREA)
  • Traffic Control Systems (AREA)
  • Instructional Devices (AREA)

Abstract

本發明目的在於提供一種船舶內河航運光達辨識系統，包括包含一接收器、一儲存器、一處理器以及一顯示器。其中，該處理器與該接收器和儲存器相連接；該顯示器與該處理器相連接。總而言之，本船舶內河航運光達辨識系統可利用預設的地圖資料，於前置程序中先確認可忽略不計算的點數據，故可省略傳統的對位步驟，進而提升計算速度。

Description

船舶內河航運光達辨識系統及其運作方法
本發明係至少一實施例係關於一種船舶航運光達辨識系統及其運作方法，特別係指一種用於內陸河道之船舶航運光達辨識系統及其運作方法。
航線規劃為無人水上載具控制中的基本問題。中央電腦完全指定無人水上載具自開始航行至到達目標可遵循的航線路徑，通常會選擇不與航行環境中的任何障礙物碰撞；或盡可能地降低產生碰撞的可能性。有鑑於水面干擾因素甚多(如風向、水域流向、光線反光等)，故航線規劃的挑戰將涉及以極快速度，甚至是即時隨著航行環境的特徵變化，而適時執行航線規劃之能力。
舉例來說，諸如航行環境中的一個或多個水上障礙物的位置或形狀特徵可能隨時間推移而變動(如大型漂浮物可能基於流向而位移)；並且，同樣地，諸如無人水上載具本身的位置亦可能隨時間推移而變動。因此，航線規劃的挑戰在於，偵測資料的處理速度必須即時且可連續執行方能克服偵測本體(無人水上載具)與受偵測物(水上障礙物)於運行時同時產生相對位置變動的問題，以能適時地對航道進行校正/調整。
為解決上述至少一問題，本發明部份實施例提出一種船舶航運光達辨識系統及其運作方法，特別係指一種用於內陸河道之船舶航運光達辨識系統及其運作方法，其具備可以即時且連續地對偵測資料進行計算的優點。具體而言，其利用預設的地圖資料於前置程序中先確認可忽略不計算的點數據，故可省略傳統的對位步驟(即確定點數據是否為目標偵測對象的步驟)；並且，提升所述系統的計算速度。
本發明至少一實施例為一種船舶內河航運光達辨識系統，其包括包含一接收器、一儲存器、一處理器以及一顯示器。其中，該處理器與該接收器和儲存器相連接；而該顯示器與該處理器相連接。
本發明至少一實施例為一種船舶內河航運光達辨識方法。所述的方法包含提供所述的船舶內河航運光達辨識系統；接收由一運輸工具上配備的至少一個感測器捕獲的複數個點雲；藉由處理器合併該複數個點雲為至少一第一點雲集；基於該至少一第一點雲集及一地圖資料，定義需要計算的至少一第二點雲叢集；基於一分群計算合併該至少一第二點雲集中的各點為至少一區塊；透過對該至少一區塊實施計算以在該地圖資料中植入至少一標記；以及藉由該顯示器顯示該地圖資料及其中的該至少一標記。如此一來，該地圖資料上將會顯示至少一水上障礙物，其中任一該標記唯一識別表示該水上障礙物。
本發明至少一實施例的特徵在於所述點雲的前置程序。在部份情況下，為定義需要計算的至少一第二點雲集，所述方法更包括：基於該至少一陸域資訊產生一高度，其中，如果該至少一第一點雲集中的任一點高於(或高於等於)該高度，則忽略該點；將該至少一第一點雲集投影到該地圖資料；基於該至少一水域資訊產生一邊界，其中，如果該至少一第一點雲集中的任一點越過(或僅跨過)該邊界，則忽略該點；以及將前述步驟中未被忽略的點，定義為該至少一第二點雲集。
以上對本發明之簡述，目的在於對本發明之數種面向和技術特徵作一基本說明，發明簡述並非對本發明的詳細表述，因此其目的不在特別列舉本發明的關鍵性或重要元件，也不是用來界定本發明的範圍，僅為以簡明的方式呈現本發明之數種概念而已。
為能更進一步瞭解本發明的特徵及技術內容，請參閱以下有關本發明的詳細說明與附圖。
本發明係至少一實施例係關於一種船舶航運光達辨識系統及其運作方法，特別係指一種用於內陸河道之船舶航運光達辨識系統及其運作方法。
請參見圖1為本發明船舶內河航運光達辨識系統部份實施例的示意圖。船舶內河航運光達辨識系統1包含一接收器10、一儲存器20、一處理器30以及一顯示器40，處理器30與接收器10及儲存器20相連接；顯示器40則與處理器30相連接。
圖1的接收器10係配置為接收經由至少一感測器12捕獲的點雲；及供選擇地將一個或多個點雲儲存至儲存器20/直接發送至處理器30。本實施例中，所述的感測器12被配置在一運輸工具100以沿著其移動軌跡適時捕獲所述點雲，其中點雲可以使用複數相機、視訊攝相機或深度感測器中的任意者來捕獲(諸如，光檢測和測距雷射掃描)，例如，可應用Velodyne公司的VLP-16、VLP-32 LiDAR感測器、Quanergy公司的S3或M8 LiDAR感測器；並且，可以使用一種或多種通信方案來發送/接收點雲，例如，使用用戶資料報協定(UDP)或其他協定。所述的點雲可以被表示成依照特定應用而裁製的不同格式，例如：xyz或las格式，但本發明並不限制需被表示成適用於所有應用程式的格式。
圖1中的儲存器20係被配置為儲存所述點雲及一地圖資料200。本實施例中，儲存器20可以是任何型態的大容量儲存器 (固定/可隨機移動)，例如，揮發性(volatile)或非揮發性(non-volatile)、磁性、半導體、磁帶、光學、可移式、不可移式或上述元件之組合的儲存器，其係被提供以儲存處理器30可能需要操作之任何類型的資訊；或者可能執行的一個或多個電腦程式。此處，所述地圖資料200可為電子航行圖(ENC)，但不以此為限，所述地圖資料200亦可為任何包含至少一陸域資訊(如建築物、或橋梁)及至少一水域資訊(如河道、航道)的衛星影像（Satellite imagery）、數值線繪圖形(Digital line graph, DLG)、數值網格圖(Digital raster graphics, DRG)、數位正射影像圖(Digital orthophoto quadrangle, DOQ)或其他可以儲存成電腦可讀取形式的地圖。
如圖1所示，處理器30係被組配成：基於所述點雲中代表一圖中的各點執行存取；建構代表所述點雲的至少一第一點雲集；決定第一點雲集中可忽略的點以確定至少一第二點雲集；及基於第二點雲集產生至少一區塊，以在顯示器40上顯示包括至少一水上障礙物標識的地圖資料200。應注意的是，處理器30在處理期間，被設計為可以與儲存器20通訊以儲存/擷取操作相關的資料，例如，一個或多個點雲、地圖資料200、或計算指令等。再者，此處並未特別定義處理器30及顯示器40的型號或種類，例如，處理器30可以是微處理器；也可以是任何習知的處理器、控制器或其他為實現計算的組件組合/配置。又例如，顯示器40可以是電腦顯示器/螢幕、電視裝置顯示器/螢幕或虛擬實境裝置顯示器/螢幕；也可以是具有投影映射功能的顯示器本身。
在其他可能的實施例中，為提升第二點雲集的判定精確度，接收器10可視情況包括一濾波器(圖未示)以提前濾除可能產生誤判的部份偵測資料。
為方便理解和說明前述操作內容實際應用於實施例的原理，下文將於圖2、圖3以及圖4-6依序說明。
首先，圖2為本發明船舶內河航運光達辨識方法部份實施例的流程圖。所述的方法包含提供一船舶內河航運光達辨識系統(步驟(A))，本實施例中使用的是前述圖1的船舶內河航運光達辨識系統1；接收由一運輸工具100上配備的至少一個感測器12捕獲的多個點雲(步驟(B))；藉由處理器30合併步驟(B)的點雲為一個第一點雲集(步驟(C))；基於前述的地圖資料200定義需要計算的一個第二點雲集(步驟(D))，此時所謂的第二點雲集係為忽略第一點雲集中部份點後的集合型態；基於一分群計算合併第二點雲集中的各點為一個或多個區塊(步驟(E))；對所述區塊實施計算以在前述的地圖資料200中植入至少一個標記300(步驟(F))；以及藉由顯示器40顯示植入所有標記300後的地圖資料200(步驟(G))，用於在地圖資料200中標識至少一個水上障礙物，其中一個標記300唯一識別表示一個水上障礙物。
其中，步驟(D)係涉及用於第一點雲集的忽略程序並包括步驟(D1)-(D4)。步驟(D1):基於前述的陸域資訊產生一高度，其中，假定如果第一點雲集中的任一點高於(或高於等於)該高度，則忽略該點，具體而言，此時係將針對該高度確定一高度閾值並應用簡單演算法判定高度閾值以上的任一點(即該點的z軸值高於等於高度閾值時)為欲忽略不參與計算的點；步驟(D2):將第一點雲集投影到前述的地圖資料200；步驟(D3):基於前述的水域資訊產生一邊界，其中，假定如果該至少一第一點雲集的任一點越過(或僅跨過)該邊界，則忽略該點；以及步驟(D4):根據步驟(D1)及(D3)中未被忽略的點，定義一個第二點雲集。一般來說，步驟(D1)-(D4)之執行亦可涉及形態學的疊代演算法，此時步驟(D1)及(D3)可包括本領域中通常知識者可理解的步驟。本實施例中，所述高度閾值係為一變動數值，將適時依陸域資訊而調整(如橋梁高度變化等)；同樣地，所述邊界係取決於水域資訊的內河河道(如河道之寬度、曲度等)。當然，於其他實施例中，所述高度閾值和所述邊界亦可為其他資訊之定義，並不以前述之例示為限。
且其中，從前面的敘述可以理解，步驟(D1)的「產生一高度」係涉及陸域資訊中物件資料的選定程序，例如，基於水域資訊選定陸域資訊中與其資訊重疊的一物件資料(如水面上的橋梁)；及設定物件資料與水面的最近距離為前述的高度，以確定前述的高度閾值。
其中，步驟(E)中所謂的分群計算可涉及Kd-tree(K-dimensional tree)的疊代演算法，並進一步包括步驟(E1)-(E3)。步驟(E1):提取第二點雲集中的一空間點；步驟(E2):基於Kd-tree(K-dimensional tree)方法計算第二點雲集中的任一點和空間點間的一距離值；步驟(E3):將第二點雲集中距離值小於等於一距離閾值的點歸類為一個區塊；以及步驟(E4):重複執行步驟(E1)-(E3)，直至第二點雲集的點全數歸類完成後(即產生複數個區塊後)，即執行步驟(F)。此處的距離閾值係為一預定數值，僅依實際應用需求而擇定，本發明並不對此限制。
且其中，步驟(E)更包括一介於步驟(E2)與步驟(E3)間的步驟(E21)：優先將所述第二點雲集中距離值小於等於一區域閾值的點指為同一區域，並重複執行步驟(E1)及(E21)，直至根據所述區域閾值分割所述第二點雲集為多個區域後，始依照個別區域來執行步驟(E3)，以將每個區域中的點依序歸類為所述區塊。此時區域閾值將等於全部可用的距離值的最大值，於實際應用中，所謂的可用的距離值係指相對於經辨識的離群值(outlier)的距離值估計量。如此，船舶內河航運光達辨識系統1將可較為準確地分選及歸類第二點雲集的高密度點區塊(即步驟(E3)中點密度較高的區塊)。
其中，步驟(F)進一步包括步驟(F1)-(F3)，以逐個計算前述的區塊。步驟(F1):計算任一該區塊中所有點的座標平均值以定義在該任一該區塊中的重心之一點座標，並重複執行計算直至完成每個該區塊之重心點座標的定義；步驟(F2):確定表示所有重心點座標的一物件訊息；以及步驟(F3):透過物件訊息產生對應的至少一個標記300。應注意的是，本實施例可以採用符合NEMA-0180、NEMA-0182或NEMA-0183規範的編碼格式來表徵所述物件訊息，舉例來說，假定定義參數係為包括「$OBS,＜1＞,＜2＞,＜3＞,＜4＞,＜2＞,＜3＞,＜4＞,…,＜2＞,＜3＞,＜4＞,*＜5＞」的，本領域中通常知識者依下表1的內容可以理解，此定義參數包括偵測當下的水上障礙物數量及其相應的至少一個座標分量，以即時地植入至少一個正確標記300於所述地圖資料200中；當然，本發明也可以採用其他適當的編碼格式來進行傳輸，並不依此為限。此外，有關區塊重心的計算僅為簡單演算法之通常應用；亦為本領域中通常知識者所習知之技藝，便不於此處贅述。
Figure 02_image001
表1
且其中，步驟(F3)中的標記300於實際應用時可包括一物件距離310及一物件資訊320，但不以此限定，於其他實際應用中，所述標記300亦可包括任何具有警示功能之物件標的(如物件顏色等)。其中，物件距離310係為水上障礙物和運輸工具100間的距離數值；物件資訊320係為具有輪廓的任一形狀集合，用於表示水上障礙物的空間位置。
值得一提的是，步驟(G)地圖資料200於實際顯示應用時，除一同呈現步驟(F3)中的標記300外，亦可以選擇性地呈現以線性表示之其他資訊，例如，感測器12之偵測範圍或水上障礙物之相對方位。其中為有效辨識所述地圖資料200中被植入的標記300，本發明於實際應用時，可進一步於執行步驟(G)前，將多個物件距離310及多個物件資訊320依照屬性給予填色，例如，物件距離310中近距離者給予紅色以提高警示效果；同樣地，物件資訊320中為大型水上障礙物者(即前述的形狀中輪廓較大者)則給予黃色；並依此類推。此時，所謂的屬性可為物件距離310及物件資訊320的進一步定義，例如：物件距離310的近距離、遠距離、或物件資訊320的小型、中型、大型水上障礙物，亦可為其他類型的定義型態，本發明對此並不予以限定。且其中，該屬性與該填色的對應關係可以是預定的一個標準查找表；或僅依實際操作需求隨機給予不相同的填色表示(即一個屬性對應一個填色)。
在可能的實施例中，當第一點雲集的點數量過大時，可選擇性地在步驟(B)及(C)之間進行步驟(B1)-(B2)。步驟(B1)：從第一點雲集中讀取一預設範圍內的一第一輪廓點；及讀取所述預設範圍外的多個第二輪廓點；步驟(B2)：計算第一輪廓點的任一點到第二輪廓點的任一點的距離，當所述距離的最小值大於一預設閾值時，則直接忽略該點及其所在的該第二輪廓點。此處的「過大」的解釋數量係取決於處理器30的處理速度。
在可能的實施例中，當第一點雲集的點數量足夠時，處理器30可以於步驟(B)及(C)之間進一步將第一點雲集與前述的地圖資料200進行匹配演算，例如，可以使用正態分布變換(Normal Distributions Transform, NDT)或疊代最近點(Iterative Closest Point, ICP)演算法。此處的「足夠」的解釋數量取決於演算法而變化。
在可能的實施例中，步驟(B)可涉及用於點雲的分割程序，以消除無效的資料點(如水面的反射點)；並且，所謂的分割程序可涉及隨機樣本共識(RANdom Sample Consensus, RANSAC) 的疊代演算法。
圖3為本發明船舶內河航運光達辨識系統部份實施例的配置示意圖。與前述實施例一致，如圖3所示，運輸工具100係配置為設置本發明的船舶內河航運光達辨識系統1，本實施例中，運輸工具100可以是快艇、漁船、觀光船等小型水上載具；當然，本發明的態樣不限於此，並且可以應用於其他無人船舶(例如戰艦、郵輪等大型水上載具)。此時，所述感測器12數量可為一個或多個，並設置在運輸工具100的船艏位置，而感測器12的數量係取決於運輸工具100運行時的水道寬度(例如：水道為1.8m時,感測器12數量為1個)。
請搭配圖2-3參照圖4-6，圖4-6為本發明船舶內河航運光達辨識方法部份實施例的地圖資料輸出示意圖，用於表示於顯示器40上顯示包括標記300的地圖資料200，以標識一運輸工具100；及該等標記300所代表的水上障礙物之當前空間位置。圖4係顯示將本發明適用在近距離偵測時的輸出型態；圖5係顯示將本發明適用在中距離偵測時的輸出型態；及圖6係顯示將本發明適用在遠距離偵測時的輸出型態，其中所謂的近距離、中距離及遠距離並無特別距離值限制，僅為水上障礙物與運輸工具在相對距離上的一個概念表示。本實施例所使用的感測器12為Velodyne公司製造的VLP-16 LiDAR感測器，以將偵測資料依用戶資料報協定(User Datagram Protocol, UDP)封包發送予接收器10以解析至少一特徵資訊(如偵測資料中任一射線與任一角度的點雲距離)；而處理器30則依特徵資訊建立前述的第一點雲集，其中第一點雲集係以卡氏座標系統來表示。
承上，為進一步的提升計算速度，本發明提出先確定點雲中需要被計算的點(即判定可忽略不計算的點)後再執行後續計算的前置程序。如此一來，在後續過程中，處理器30僅需要針對判定後的部份點進行計算即可，大幅降低計算量及其相關參數量。應注意的是，基於本實施例係應用於水上行駛的無人載具，考量水面干擾因素甚多，因此需要針對偵測資料進行即時地連續判斷方能適時進行航道調整，本發明將僅依計算鄰近關係(如Kd-tree(K-dimensional tree)演算)後的結果將第二點雲集分群，並直接針對每一個分群(區塊)中的重心點座標(進行提取，以適時取得前述地圖資料200上的一個標記300；而如圖4-6所示，於本實施例中，所述標記300係包括顯示水上障礙物距離(m)的物件距離310及為表示水上障礙物尺寸大小的物件資訊320；並且包括被標識以顯示一感測器12偵測範圍及水上障礙物相對方位的提示線330a、330b，其中處理器30將感測器12的可偵測空間邊界值對應地轉換為複數提示線330a；並將感測器12與任一該重心點座標的空間最短路徑也對應地轉換為至少一提示線330b。
綜上所述，雖然本發明已以實施例揭露如上，然其並非用以限定本發明。本發明所屬技術領域中具有通常知識者，在不脫離本發明之精神和範圍的基礎上，當可作各種的更動和潤飾。因此，本發明的保護範圍當視後附的申請專利範圍所界定者為準。
1:船舶內河航運光達辨識系統 10:接收器 12:感測器 20:儲存器 30:處理器 40:顯示器 100:運輸工具 200:地圖資料 300:標記 310:物件距離 320:物件資訊 330a、330b:提示線 (A)~(G):步驟
圖1為本發明船舶內河航運光達辨識系統部份實施例的示意圖。
圖2為本發明船舶內河航運光達辨識方法部份實施例的流程圖。
圖3為本發明船舶內河航運光達辨識系統部份實施例的配置示意圖。
圖4為本發明船舶內河航運光達辨識方法部份實施例的地圖資料輸出示意圖。
圖5為本發明船舶內河航運光達辨識方法部份實施例的地圖資料輸出示意圖。
圖6為本發明船舶內河航運光達辨識方法部份實施例的地圖資料輸出示意圖。
(A)~(G):步驟

Claims (9)

  1. 一種船舶內河航運光達辨識系統，包括： 一接收器，被配置以接收經由至少一感測器捕獲的複數個點雲； 一儲存器，被配置以儲存該複數個點雲及一地圖資料，該地圖資料包括至少一陸域資訊及至少一水域資訊； 一處理器，與該接收器及該儲存器相連接，該處理器係被配置為：將該複數個點雲合併成至少一第一點雲集；基於該地圖資料判定需要計算的至少一第二點雲集，而忽略該至少一第一點雲集中包括該至少一陸域資訊之部位；及透過該至少一第二點雲集產生至少一區塊；以及 一顯示器，與該處理器相連接，該顯示器被配置以顯示該地圖資料。
  2. 如請求項1所述之船舶內河航運光達辨識系統，其中該接收器更包括一濾波器。
  3. 如請求項1所述之船舶內河航運光達辨識系統，其中該至少一感測器係為光達(LiDAR)感測器。
  4. 如請求項1所述之船舶內河航運光達辨識系統，其中該地圖資料係為電子航行圖。
  5. 一種船舶內河航運光達辨識方法，包括以下步驟： (A)提供如請求項1所述之船舶內河航運光達辨識系統； (B) 接收由一運輸工具上配備的該至少一感測器捕獲的該複數個點雲； (C) 藉由該處理器合併該複數個點雲為該至少一第一點雲集； (D)基於該至少一第一點雲集及該地圖資料，定義需要計算的該至少一第二點雲集； (E) 基於一分群計算合併該至少一第二點雲集中的各點為至少一區塊； (F)  透過對該至少一區塊實施計算以在該地圖資料中植入至少一標記；以及 (G)藉由該顯示器顯示該地圖資料及其中的該至少一標記。
  6. 如請求項5所述之船舶內河航運光達辨識方法，其中步驟(D)進一步包括： (D1)基於該至少一陸域資訊產生一高度，其中，如果該至少一第一點雲集中的任一點高於或等於該高度，則忽略該點； (D2)將該至少一第一點雲集投影到該地圖資料； (D3)基於該至少一水域資訊產生一邊界，其中，如果該至少一第一點雲集中的任一點越過該邊界，則忽略該點；以及 (D4)根據步驟(D1)及(D2)中未被忽略的點，定義該至少一第二點雲集。
  7. 如請求項5所述之船舶內河航運光達辨識方法，其中步驟(E) 進一步包括： (E1)提取該至少一第二點雲集中的一空間點； (E2)計算該至少一第二點雲集中的任一點與該空間點間的一距離值； (E3)將其中距離值小於等於一距離閾值的點歸類為同一區塊；以及 (E4)重複執行步驟(E1)-(E3)，直至該至少一第二點雲集中的點全數歸類完成，以產生複數個區塊。
  8. 如請求項5所述之船舶內河航運光達辨識方法，其中步驟(F) 進一步包括： (F1)計算任一該區塊中所有點的座標平均值以定義在該任一該區塊中的重心點座標，並重複執行計算直至定義每個該區塊的重心點座標； (F2)確定表示該複數個重心點座標的一物件訊息；以及 (F3)透過該物件訊息產生對應的該至少一標記。
  9. 如請求項7所述之船舶內河航運光達辨識方法，其中步驟(E)更包括一介於步驟(E2)與步驟(E3)間的步驟(E21)：優先將該至少一第二點雲集中距離值小於等於一區域閾值的點指為同一區域，並重複執行步驟(E1)及(E21)，直至根據該區域閾值將該至少一第二點雲集分割為複數個區域為止。
TW109142362A 2020-12-02 2020-12-02 船舶內河航運光達辨識系統及其運作方法 TWI792108B (zh)

Priority Applications (6)

Application Number Priority Date Filing Date Title
TW109142362A TWI792108B (zh) 2020-12-02 2020-12-02 船舶內河航運光達辨識系統及其運作方法
EP20212063.0A EP4009078A1 (en) 2020-12-02 2020-12-04 Inland river lidar navigation system for vessels and operation method thereof
US17/307,977 US20220171062A1 (en) 2020-12-02 2021-05-04 Inland river lidar navigation system for vessels and operation method thereof
CN202110528006.6A CN114594759A (zh) 2020-12-02 2021-05-14 船舶内河航运光达辨识系统及其运作方法
JP2021094157A JP7174111B2 (ja) 2020-12-02 2021-06-04 内陸水運船舶ライダー識別システム及びその運用方法
KR1020210076534A KR102627540B1 (ko) 2020-12-02 2021-06-14 내륙하천 선박운항 라이다 식별 시스템 및 그 운용 방법

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
TW109142362A TWI792108B (zh) 2020-12-02 2020-12-02 船舶內河航運光達辨識系統及其運作方法

Publications (2)

Publication Number Publication Date
TW202222640A true TW202222640A (zh) 2022-06-16
TWI792108B TWI792108B (zh) 2023-02-11

Family

ID=73740203

Family Applications (1)

Application Number Title Priority Date Filing Date
TW109142362A TWI792108B (zh) 2020-12-02 2020-12-02 船舶內河航運光達辨識系統及其運作方法

Country Status (6)

Country Link
US (1) US20220171062A1 (zh)
EP (1) EP4009078A1 (zh)
JP (1) JP7174111B2 (zh)
KR (1) KR102627540B1 (zh)
CN (1) CN114594759A (zh)
TW (1) TWI792108B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TWI793477B (zh) * 2020-12-04 2023-02-21 財團法人船舶暨海洋產業研發中心 船舶輔助校正系統及其運作方法

Family Cites Families (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10431099B2 (en) * 2014-02-21 2019-10-01 FLIR Belgium BVBA Collision avoidance systems and methods
US10775177B2 (en) * 2014-10-21 2020-09-15 FLIR Belgium BVBA Simplified route extension systems and methods
CN106651786B (zh) 2016-11-04 2019-05-14 中科宇图科技股份有限公司 河岸区域点云数据的处理方法
JP6797730B2 (ja) * 2017-03-29 2020-12-09 本田技研工業株式会社 操船アシストシステムとその操船アシスト装置およびサーバ
WO2018201097A2 (en) * 2017-04-28 2018-11-01 FLIR Belgium BVBA Video and image chart fusion systems and methods
TWM554985U (zh) * 2017-08-31 2018-02-01 Institute Of Transportation Motc 船舶電子海圖顯示及安全警示系統
WO2020033967A1 (en) * 2018-08-10 2020-02-13 Buffalo Automation Group Inc. Training a deep learning system for maritime applications
WO2020050498A1 (ko) * 2018-09-04 2020-03-12 씨드로닉스㈜ 이미지 세그멘테이션을 이용한 주변 환경 감지 방법 및 장치
US20210357655A1 (en) * 2018-10-04 2021-11-18 Seadronix Corp. Ship and harbor monitoring device and method
CN109752727B (zh) 2019-01-11 2022-03-04 山东科技大学 一种机载LiDAR测深海气界面折射改正方法
TWI714040B (zh) * 2019-03-27 2020-12-21 財團法人船舶暨海洋產業研發中心 船舶導航系統及其導航方法
CN111830968B (zh) 2020-06-12 2024-02-06 江苏大学 一种多功能莼菜无人作业船及其导航控制方法

Also Published As

Publication number Publication date
JP2022088303A (ja) 2022-06-14
EP4009078A1 (en) 2022-06-08
TWI792108B (zh) 2023-02-11
JP7174111B2 (ja) 2022-11-17
KR20220077838A (ko) 2022-06-09
KR102627540B1 (ko) 2024-01-23
US20220171062A1 (en) 2022-06-02
CN114594759A (zh) 2022-06-07

Similar Documents

Publication Publication Date Title
US11632536B2 (en) Method and apparatus for generating three-dimensional (3D) road model
CN111583369B (zh) 一种基于面线角点特征提取的激光slam方法
US9625908B2 (en) Methods and systems for mobile-agent navigation
JP7138718B2 (ja) 地物検出装置、地物検出方法および地物検出プログラム
CN110930459A (zh) 灭点提取方法、相机标定方法以及存储介质
US20220083792A1 (en) Method and device for providing data for creating a digital map
KR20210090384A (ko) 카메라 및 라이다 센서를 이용한 3d 객체 검출방법 및 장치
CN112781599A (zh) 确定车辆的位置的方法
CN112673280A (zh) 用于装配有lidar传感器的机动车辆的道路检测方法
JP2022542082A (ja) ポーズ特定方法、ポーズ特定装置、コンピュータ可読記憶媒体、コンピュータ機器及びコンピュータプログラム
KR20210041305A (ko) 차선 추출 장치 및 방법
KR20230003803A (ko) 라이다 좌표계와 카메라 좌표계의 벡터 정합을 통한 자동 캘리브레이션 방법
CN112686951A (zh) 用于确定机器人位置的方法、装置、终端及存储介质
TWI792108B (zh) 船舶內河航運光達辨識系統及其運作方法
CN109490926B (zh) 一种基于双目相机和gnss的路径规划方法
CN110058263B (zh) 一种车辆行驶过程中的物体定位方法
CN111781606A (zh) 一种新型激光雷达和超声波雷达融合的小型化实现方法
JP7171825B2 (ja) 船舶の補助補正システム及びその運用方法
Velat et al. Vision based vehicle localization for autonomous navigation
Li et al. Visual localization and object tracking for the NAO robot in dynamic environment
CN114646317A (zh) 车辆视觉定位导航控制方法、装置及计算机设备、介质
CN112598736A (zh) 一种基于地图构建的视觉定位方法及装置
Li et al. Lane detection and road surface reconstruction based on multiple vanishing point & symposia
Jain et al. Deep Learning-Based AI model for Road Detection
KR102604408B1 (ko) 라이다 기반 지도 생성 방법 및 그 장치