JP7194217B2 - 障害物速度確定方法、装置、電子機器、記憶媒体およびコンピュータプログラム - Google Patents
障害物速度確定方法、装置、電子機器、記憶媒体およびコンピュータプログラム Download PDFInfo
- Publication number
- JP7194217B2 JP7194217B2 JP2021043325A JP2021043325A JP7194217B2 JP 7194217 B2 JP7194217 B2 JP 7194217B2 JP 2021043325 A JP2021043325 A JP 2021043325A JP 2021043325 A JP2021043325 A JP 2021043325A JP 7194217 B2 JP7194217 B2 JP 7194217B2
- Authority
- JP
- Japan
- Prior art keywords
- point cloud
- data
- grid
- cloud data
- determining
- Prior art date
- Legal status (The legal status 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 status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims description 49
- 238000004590 computer program Methods 0.000 title claims description 9
- 238000006073 displacement reaction Methods 0.000 claims description 30
- 230000015654 memory Effects 0.000 claims description 20
- 230000005484 gravity Effects 0.000 claims description 11
- 238000004364 calculation method Methods 0.000 claims description 9
- 230000001131 transforming effect Effects 0.000 claims description 7
- 238000004891 communication Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 4
- 230000008569 process Effects 0.000 description 3
- 238000012545 processing Methods 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 230000003993 interaction Effects 0.000 description 2
- 239000004973 liquid crystal related substance Substances 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000013500 data storage Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000010295 mobile communication Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000006798 recombination Effects 0.000 description 1
- 238000005215 recombination Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
- G01P3/00—Measuring linear or angular speed; Measuring differences of linear or angular speeds
- G01P3/36—Devices characterised by the use of optical means, e.g. using infrared, visible, or ultraviolet light
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
- G01P3/00—Measuring linear or angular speed; Measuring differences of linear or angular speeds
- G01P3/64—Devices characterised by the determination of the time taken to traverse a fixed distance
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T7/00—Image analysis
- G06T7/30—Determination of transform parameters for the alignment of images, i.e. image registration
- G06T7/33—Determination of transform parameters for the alignment of images, i.e. image registration using feature-based methods
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
- G01P3/00—Measuring linear or angular speed; Measuring differences of linear or angular speeds
- G01P3/64—Devices characterised by the determination of the time taken to traverse a fixed distance
- G01P3/68—Devices characterised by the determination of the time taken to traverse a fixed distance using optical means, i.e. using infrared, visible, or ultraviolet light
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
- G01P3/00—Measuring linear or angular speed; Measuring differences of linear or angular speeds
- G01P3/64—Devices characterised by the determination of the time taken to traverse a fixed distance
- G01P3/80—Devices characterised by the determination of the time taken to traverse a fixed distance using auto-correlation or cross-correlation detection means
-
- 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
- G01S13/00—Systems 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/88—Radar or analogous systems specially adapted for specific applications
- G01S13/89—Radar or analogous 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
- G01S13/00—Systems 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/88—Radar or analogous systems specially adapted for specific applications
- G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
- G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
-
- 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/50—Systems of measurement based on relative movement of target
- G01S17/58—Velocity or trajectory determination systems; Sense-of-movement determination systems
-
- 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
- G01S17/931—Lidar systems specially adapted for specific applications for anti-collision purposes of land vehicles
-
- 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
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T7/00—Image analysis
- G06T7/60—Analysis of geometric attributes
- G06T7/66—Analysis of geometric attributes of image moments or centre of gravity
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
- G06V20/00—Scenes; Scene-specific elements
- G06V20/50—Context or environment of the image
- G06V20/56—Context or environment of the image exterior to a vehicle by using sensors mounted on the vehicle
- G06V20/58—Recognition of moving objects or obstacles, e.g. vehicles or pedestrians; Recognition of traffic objects, e.g. traffic signs, traffic lights or roads
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
- G01P21/00—Testing or calibrating of apparatus or devices covered by the preceding groups
- G01P21/02—Testing or calibrating of apparatus or devices covered by the preceding groups of speedometers
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T2207/00—Indexing scheme for image analysis or image enhancement
- G06T2207/10—Image acquisition modality
- G06T2207/10028—Range image; Depth image; 3D point clouds
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Electromagnetism (AREA)
- Computer Networks & Wireless Communication (AREA)
- Theoretical Computer Science (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Geometry (AREA)
- Power Engineering (AREA)
- Multimedia (AREA)
- Image Analysis (AREA)
- Optical Radar Systems And Details Thereof (AREA)
- Radar Systems Or Details Thereof (AREA)
Description
現在の無人運転システムは、障害物追跡を行う際に、障害物の重心(centroid)位置の変化に基づいて障害物の観測速度を算出することが多い。遮蔽等の理由により点群座標を用いて算出された重心位置の変動が大きく、該方法により算出された観測速度の誤差が大きい。
障害物の、第1時刻における第1点群データ及び第2時刻における第2点群データを取得するステップと、
前記第1点群データ又は前記第2点群データを移動することにより、前記第1点群データと前記第2点群データを位置合わせ(registration)するステップと、
位置合わせされたデータ点ペアにおける2つのデータ点の間の距離に基づいて前記障害物の移動速度を確定するステップであって、前記位置合わせされたデータ点ペアのうちの一方のデータ点は前記第1点群データに属し、他方のデータ点は前記第2点群データに属する、ステップと、を含む。
前記第1点群データの第1点群分布情報及び前記第2点群データの第2点群分布情報を確定するステップと、
前記第1点群分布情報及び前記第2点群分布情報に基づいて、前記第1点群データと前記第2点群データを位置合わせするステップと、を含む。
前記第1点群データの第1投影面を確定するステップと、
前記第1点群データを前記第1投影面における所定サイズのグリッド内に投影し、第1グリッド投影データを得るステップと、
前記第1グリッド投影データに基づいて前記第1点群分布情報を確定するステップと、を含む。
前記移動速度の少なくとも1つの方向に基づいて、少なくとも1つの投影方向を確定するステップと、
地面に垂直な方向と前記少なくとも1つの投影方向とをそれぞれ組み合わせるステップと、
組み合わせによる方向ペアに基づいて、少なくとも1つの前記第1投影面を作成するステップと、を含む。
前記第1点群データを前記第1点群データの重心を原点とする三次元座標系に変換するステップであって、前記座標系の2つの座標軸からなる平面が前記第1投影面である、ステップと、
前記座標系の原点を中心として、前記第1投影面を所定サイズのグリッドに分割するステップと、
変換後の第1点群データを分割されたグリッドに投影し、前記第1グリッド投影データを得るステップと、を含む。
前記第1点群データのサイズ及び前記グリッドのサイズに応じて、前記第1点群データの前記グリッドにおける表示割合を確定するステップと、
前記表示割合に従って、前記第1点群データを前記グリッドに投影し、前記第1グリッド投影データを得るステップと、を含む。
グリッド内に投影されたデータ点の個数が0より大きい場合、該グリッドと障害物境界との間の距離パラメータを0とするステップと、
グリッド内に投影されたデータ点の個数が0以下である場合、行方向に沿って該グリッドに最も近く、且つ投影されたデータ点の個数が0より大きい目標グリッドを検索するステップと、
前記グリッドと前記目標グリッドとの間のグリッド数に応じて、前記グリッドの前記距離パラメータを確定するステップと、
確定された前記距離パラメータを前記第1点群分布情報とするステップと、を含む。
前記障害物の向きに応じて、前記第1点群データ又は前記第2点群データを移動するステップと、
前記第1点群分布情報及び前記第2点群分布情報に基づいて、移動後の前記第1点群データと前記第2点群データとの間のマッチング度を算出するステップと、
算出されたマッチング度に基づいて、前記第1点群データと前記第2点群データの位置合わせ位置を確定するステップと、を含む。
少なくとも2回移動した後に算出されたマッチング度を正規化し、毎回の移動が実際の変位に該当する確率を得るステップと、
前記確率に基づいて変位期待値を算出し、算出された変位期待値を最適移動距離とするステップと、
前記最適移動距離だけ移動した位置を前記位置合わせ位置とするステップとを含む。
位置合わせされたデータ点ペアにおける2つのデータ点の間の距離に基づいて、前記障害物の、前記第1時刻と前記第2時刻との間にわたる目標移動距離を確定するステップと、
前記目標移動距離に基づいて、前記障害物の移動速度を確定するステップと、を含む。
障害物の第1時刻における第1点群データ及び第2時刻における第2点群データを取得するためのデータ取得モジュールと、
前記第1点群データ又は前記第2点群データを移動することにより、前記第1点群データと前記第2点群データを位置合わせするための点群位置合わせモジュールと、
位置合わせされたデータ点ペアにおける2つのデータ点の間の距離に基づいて前記障害物の移動速度を確定するための速度確定モジュールであって、前記位置合わせされたデータ点ペアのうちの一方のデータ点は前記第1点群データに属し、他方のデータ点は前記第2点群データに属する、速度確定モジュールと、を含む。
前記第1点群データの第1点群分布情報及び前記第2点群データの第2点群分布情報を確定するための分布情報確定ユニットと、
前記第1点群分布情報及び前記第2点群分布情報に基づいて、前記第1点群データと前記第2点群データを位置合わせするための点群位置合わせユニットと、を含む。
前記第1点群データの第1投影面を確定するステップと、
前記第1点群データを前記第1投影面における所定サイズのグリッド内に投影し、第1グリッド投影データを得るステップと、
前記第1グリッド投影データに基づいて前記第1点群分布情報を確定するステップと、を行うように構成される。
前記移動速度の少なくとも1つの方向に基づいて、少なくとも1つの投影方向を確定するステップと、
地面に垂直な方向と前記少なくとも1つの投影方向とをそれぞれ組み合わせるステップと、
組み合わせによる方向ペアに基づいて、少なくとも1つの前記第1投影面を作成するステップと、を含む。
前記第1点群データを前記第1点群データの重心を原点とする三次元座標系に変換するステップであって、前記座標系の2つの座標軸からなる平面が前記第1投影面である、ステップと、
前記座標系の原点を中心として、前記第1投影面を所定サイズのグリッドに分割するステップと、
変換後の第1点群データを分割されたグリッドに投影し、前記第1グリッド投影データを得るステップと、を含む。
前記第1点群データのサイズ及び前記グリッドのサイズに応じて、前記第1点群データの前記グリッドにおける表示割合を確定するステップと、
前記表示割合に従って、前記第1点群データを前記グリッドに投影し、前記第1グリッド投影データを得るステップと、を含む。
グリッド内に投影されたデータ点の個数が0より大きい場合、該グリッドと障害物境界との間の距離パラメータを0とするステップと、
グリッド内に投影されたデータ点の個数が0以下である場合、行方向に沿って該グリッドに最も近く、且つ投影されたデータ点の個数が0より大きい目標グリッドを検索するステップと、
前記グリッドと前記目標グリッドとの間のグリッド数に応じて、前記グリッドの前記距離パラメータを確定するステップと、
確定された前記距離パラメータを前記第1点群分布情報とするステップと、を含む。
前記障害物の向きに応じて、前記第1点群データ又は前記第2点群データを移動するための点群移動ユニットと、
前記第1点群分布情報及び前記第2点群分布情報に基づいて、移動後の前記第1点群データと前記第2点群データとの間のマッチング度を算出するためのマッチング度計算ユニットと、
算出されたマッチング度に基づいて、前記第1点群データと前記第2点群データの位置合わせ位置を確定するための位置合わせ位置確定ユニットと、を含む。
少なくとも2回移動した後に算出されたマッチング度を正規化し、毎回の移動が実際の変位に該当する確率を得るステップと、
前記確率に基づいて変位期待値を算出し、算出された変位期待値を最適移動距離とするステップと、
前記最適移動距離だけ移動した位置を前記位置合わせ位置とするステップとを行うように構成される。
位置合わせされたデータ点ペアにおける2つのデータ点の間の距離に基づいて、前記障害物の、前記第1時刻と前記第2時刻との間にわたる目標移動距離を確定するための距離確定ユニットと、
前記目標移動距離に基づいて、前記障害物の移動速度を確定するための速度確定ユニットと、を含む。
少なくとも1つのプロセッサと、
前記少なくとも1つのプロセッサと通信可能に接続されたメモリとを備える電子機器において、
前記メモリには、前記少なくとも1つのプロセッサによって実行可能な指令が格納されており、前記指令が前記少なくとも1つのプロセッサによって実行されると、前記少なくとも1つのプロセッサに本出願の実施例のいずれかに記載の方法が実行される電子機器を提供する。
前記第1点群データ又は前記第2点群データを移動するステップと、
前記第1点群データにおける各データ点と前記第2点群データにおける各データ点との間の位置関係に基づいて、移動後の前記第1点群データと前記第2点群データとの間のマッチング度を算出するステップと、
算出されたマッチング度に基づいて、前記第1点群データと前記第2点群データの位置合わせ位置を確定するステップと、を含む。
位置合わせされたデータ点ペアにおける2つのデータ点の間の距離に基づいて、前記障害物の、前記第1時刻と前記第2時刻との間にわたる目標移動距離を確定するステップと、
前記目標移動距離に基づいて、前記障害物の移動速度を確定するステップと、を含む。
前記第1時刻と前記第2時刻との間の時間差を確定するステップと、
前記目標移動距離と前記時間差に基づいて、前記障害物の移動速度を確定するステップと、を含む。
前記障害物の向きに応じて、前記第1点群データ又は前記第2点群データを移動するステップと、
前記第1点群分布情報、及び前記第2点群分布情報に基づいて、移動後の前記第1点群データと前記第2点群データとの間のマッチング度を算出するステップと、
算出されたマッチング度に基づいて、前記第1点群データと前記第2点群データの位置合わせ位置を確定するステップと、を含む。
点群データにおけるデータ点に対してグリッド分割を行い、各グリッド内に入るデータ点の個数を統計することと、
各グリッド内に入るデータ点の個数に基づいて、データ点の局所分布密度を確定することと、を含む。
点群データに基づいて障害物境界を確定することと、
障害物境界に基づいて、点群データにおけるデータ点と障害物境界との距離を確定することと、を含む。
点群データにおけるデータ点に対して列分割を行い、列ごとに含まれるデータ点の個数を統計することと、
統計された列ごとに含まれるデータ点の個数に基づいて、データ点の縦方向分布密度を確定することと、を含む。
投影後のデータ点に対して行分割を行い、行ごとに含まれるデータ点の個数を統計することと、
統計の結果のうちの最大値を障害物の横方向の長さとすることと、を含む。
少なくとも2回移動した後に算出されたマッチング度を正規化し、毎回の移動が実際の変位に該当する確率を得るステップと、
前記確率に基づいて変位期待値を算出し、算出された変位期待値を最適移動距離とするステップと、
前記最適移動距離だけ移動した位置を前記位置合わせ位置とするステップとを含む。
前記第1点群データの最小外接多角形を確定し、確定された最小外接多角形を前記第1点群データの第1点群分布情報とすることを含む。
前記第1点群データの第1投影面を確定することと、
前記第1点群データを前記第1投影面における所定サイズのグリッド内に投影し、第1グリッド投影データを得ることと、
前記第1グリッド投影データに基づいて前記第1点群分布情報を確定することと、を含む。
前記移動速度の少なくとも1つの方向に基づいて、少なくとも1つの投影方向を確定することと、
地面に垂直な方向と前記少なくとも1つの投影方向とをそれぞれ組み合わせることと、
組み合わせによる方向ペアに基づいて、少なくとも1つの前記第1投影面を作成することと、を含む。
前記第1点群データを前記第1点群データの重心を原点とする三次元座標系に変換することであって、前記座標系の2つの座標軸からなる平面は前記第1投影面である、ことと、
前記座標系の原点を中心として、前記第1投影面を所定サイズのグリッドに分割することと、
変換後の第1点群データを分割されたグリッドに投影し、前記第1グリッド投影データを得ることと、を含む。
グリッド内に投影されたデータ点の個数が0より大きい場合、該グリッドと障害物境界との間の距離パラメータを0とすることと、
グリッド内に投影されたデータ点の個数が0以下である場合、行方向に沿って該グリッドに最も近く、且つ投影されたデータ点の個数が0より大きい目標グリッドを検索することと、
前記グリッドと前記目標グリッドとの間のグリッド数に基づいて、前記グリッドの前記距離パラメータを確定することと、
確定された前記距離パラメータを前記第1点群分布情報とすることと、を含む。
前記第1点群データのサイズ及び前記グリッドのサイズに基づいて、前記第1点群データの前記グリッドにおける表示割合を確定することと、
前記表示割合に基づいて、前記第1点群データを前記グリッドに投影し、前記第1グリッド投影データを得ることと、を含む。
score_aはA特徴類似度スコアである。
score_bは、B特徴類似度スコアであり、具体的には
Score_cは、C特徴類似度スコアであり、具体的には、t0時刻のグリッドとt1時刻のグリッドの、行方向に交差する長さが0より大きければ、
前記第1点群データの第1点群分布情報及び前記第2点群データの第2点群分布情報を確定するための分布情報確定ユニットと、
前記第1点群分布情報及び前記第2点群分布情報に基づいて、前記第1点群データと前記第2点群データを位置合わせするための点群位置合わせユニットと、を含む。
前記第1点群データの第1投影面を確定することと、
前記第1点群データを前記第1投影面における所定サイズのグリッド内に投影し、第1グリッド投影データを得ることと、
前記第1グリッド投影データに基づいて前記第1点群分布情報を確定することと、を行うように構成される。
前記移動速度の少なくとも1つの方向に基づいて、少なくとも1つの投影方向を確定することと、
地面に垂直な方向と前記少なくとも1つの投影方向とをそれぞれ組み合わせることと、
組み合わせによる方向ペアに基づいて、少なくとも1つの前記第1投影面を作成することと、を含む。
前記第1点群データを前記第1点群データの重心を原点とする三次元座標系に変換することであって、前記座標系の2つの座標軸からなる平面は前記第1投影面である、ことと、
前記座標系の原点を中心として、前記第1投影面を所定サイズのグリッドに分割することと、
変換後の第1点群データを分割されたグリッドに投影し、前記第1グリッド投影データを得ることと、を含む。
前記第1点群データのサイズ及び前記グリッドのサイズに基づいて、前記第1点群データの前記グリッドにおける表示割合を確定することと、
前記表示割合に基づいて、前記第1点群データを前記グリッドに投影し、前記第1グリッド投影データを得ることと、を含む。
グリッド内に投影されたデータ点の個数が0より大きい場合、該グリッドと障害物境界との間の距離パラメータを0とすることと、
グリッド内に投影されたデータ点の個数が0以下である場合、行方向に沿って該グリッドに最も近く且つ投影されたデータ点の個数が0より大きい目標グリッドを検索することと、
前記グリッドと前記目標グリッドとの間のグリッド数に基づいて、前記グリッドの前記距離パラメータを確定することと、
確定された前記距離パラメータを前記第1点群分布情報とすることと、を含む。
前記障害物の向きに基づいて、前記第1点群データ又は前記第2点群データを移動するための点群移動ユニットと、
前記第1点群分布情報及び前記第2点群分布情報に基づいて、移動後の前記第1点群データと前記第2点群データとの間のマッチング度を算出するためのマッチング度計算ユニットと、
算出されたマッチング度に基づいて、前記第1点群データと前記第2点群データの位置合わせ位置を確定するための位置合わせ位置確定ユニットと、を含む。
少なくとも2回移動した後に算出されたマッチング度を正規化し、毎回の移動が実際の変位に該当する確率を得ることと、
前記確率に基づいて変位期待値を算出し、算出された変位期待値を最適移動距離とすることと、
前記最適移動距離だけ移動した位置を前記位置合わせ位置とすることとを行うように構成される。
位置合わせされたデータ点ペアにおける2つのデータ点の間の距離に基づいて、前記障害物の、前記第1時刻と前記第2時刻との間にわたる目標移動距離を確定するための距離確定ユニットと、
前記目標移動距離に基づいて、前記障害物の移動速度を確定するための速度確定ユニットと、を含む。
Claims (19)
- 障害物の、第1時刻における世界座標系の第1点群データ及び第2時刻における世界座標系の第2点群データを取得するステップと、
前記第1点群データの第1投影面及び前記第2点群データの第2投影面を確定するステップと、
前記第1点群データを前記第1投影面における所定サイズのグリッド内に投影し、第1グリッド投影データを得るステップと、
前記第1グリッド投影データに基づいて前記第1点群分布情報を確定するステップと、
前記第2点群データを前記第2投影面における所定サイズのグリッド内に投影し、第2グリッド投影データを得るステップと、
前記第2グリッド投影データに基づいて前記第2点群分布情報を確定するステップと、
前記第1点群分布情報及び前記第2点群分布情報に基づいて、前記第1点群データ又は前記第2点群データを移動することにより、前記第1点群データの投影と前記第1点群データの投影が重なるように、前記第1点群データと前記第2点群データを位置合わせするステップであって、前記点群分布情報は、グリッド内に投影されたデータ点の個数、グリッドと障害物境界との間の距離パラメータ、一列のグリッド内に投影されたデータ点の個数、及び前記障害物の行方向におけるグリッド長のうちの少なくとも一種を含む、ステップと、
前記位置合わせの際に変位したグリッド数と、第1投影面及び第2投影面のグリッドペアの表示割合とに基づいて、位置合わせされたデータ点ペアにおける2つのデータ点の間の距離を決定し、位置合わせされたデータ点ペアにおける2つのデータ点の間の距離に基づいて前記障害物の相対移動速度を確定するステップであって、前記位置合わせされたデータ点ペアは、位置合わせ後に重なったデータ点ペアであり、当該データ点ペアのうちの一方のデータ点は前記第1点群データに属し、他方のデータ点は前記第2点群データに属する、ステップと、を含むことを特徴とする障害物速度確定方法。 - 前記第1点群データの第1投影面を確定するステップは、
前記相対移動速度の少なくとも1つの方向に基づいて、少なくとも1つの投影方向を確定するステップと、
地面に垂直な方向と前記少なくとも1つの投影方向とをそれぞれ組み合わせるステップと、
組み合わせによる方向ペアに基づいて、少なくとも1つの前記第1投影面を作成するステップと、を含むことを特徴とする請求項1に記載の方法。 - 前記第1点群データを前記第1投影面における所定サイズのグリッド内に投影し、第1グリッド投影データを得るステップは、
前記第1点群データを前記第1点群データの重心を原点とする三次元座標系に変換するステップであって、前記座標系の2つの座標軸からなる平面が前記第1投影面である、ステップと、
前記座標系の原点を中心として、前記第1投影面を所定サイズのグリッドに分割するステップと、
変換後の第1点群データを分割されたグリッドに投影し、前記第1グリッド投影データを得るステップと、を含むことを特徴とする請求項1に記載の方法。 - 前記第1点群データを前記第1投影面における所定サイズのグリッド内に投影し、第1グリッド投影データを得るステップは、
前記第1点群データのサイズ及び前記グリッドのサイズに応じて、前記第1点群データの前記グリッドにおける表示割合を確定するステップと、
前記表示割合に従って、前記第1点群データを前記グリッドに投影し、前記第1グリッド投影データを得るステップと、を含むことを特徴とする請求項1または3に記載の方法。 - 前記第1グリッド投影データに基づいて前記第1点群分布情報を確定するステップは、
グリッド内に投影されたデータ点の個数が0より大きい場合、該グリッドと障害物境界との間の距離パラメータを0とするステップと、
グリッド内に投影されたデータ点の個数が0以下である場合、行方向に沿って該グリッドに最も近く、且つ投影されたデータ点の個数が0より大きい目標グリッドを検索するステップと、
前記グリッドと前記目標グリッドとの間のグリッド数に応じて、前記グリッドの前記距離パラメータを確定するステップと、
確定された前記距離パラメータを前記第1点群分布情報とするステップと、を含むことを特徴とする請求項1に記載の方法。 - 前記第1点群データ又は前記第2点群データを移動することにより、前記第1点群データと前記第2点群データを位置合わせするステップは、
前記障害物の向きに応じて、前記第1点群データ又は前記第2点群データを移動するステップと、
前記第1点群分布情報及び前記第2点群分布情報に基づいて、移動後の前記第1点群データと前記第2点群データとの間のマッチング度を算出するステップと、
算出されたマッチング度に基づいて、前記第1点群データと前記第2点群データの位置合わせ位置を確定するステップと、を含むことを特徴とする請求項1に記載の方法。 - 前記算出されたマッチング度に基づいて、前記第1点群データと前記第2点群データの位置合わせ位置を確定するステップは、
少なくとも2回移動した後に算出されたマッチング度を正規化し、毎回の移動が実際の変位に該当する確率を得るステップと、
前記確率に基づいて変位期待値を算出し、算出された変位期待値を最適移動距離とするステップと、
前記最適移動距離だけ移動した位置を前記位置合わせ位置とするステップと、を含むことを特徴とする請求項6に記載の方法。 - 前記位置合わせされたデータ点ペアにおける2つのデータ点の間の距離に基づいて前記障害物の相対移動速度を確定するステップは、
位置合わせされたデータ点ペアにおける2つのデータ点の間の距離に基づいて、前記障害物の、前記第1時刻と前記第2時刻との間にわたる目標移動距離を確定するステップと、
前記目標移動距離に基づいて、前記障害物の相対移動速度を確定するステップと、を含むことを特徴とする請求項1に記載の方法。 - 障害物の、第1時刻における世界座標系の第1点群データ及び第2時刻における世界座標系の第2点群データを取得するためのデータ取得モジュールと、
点群位置合わせモジュールであって、
前記第1点群データの第1投影面及び前記第2点群データの第2投影面を確定し、
前記第1点群データを前記第1投影面における所定サイズのグリッド内に投影し、第1グリッド投影データを得、
前記第1グリッド投影データに基づいて前記第1点群分布情報を確定し、
前記第2点群データを前記第2投影面における所定サイズのグリッド内に投影し、第2グリッド投影データを得、
前記第2グリッド投影データに基づいて前記第2点群分布情報を確定し、
前記第1点群分布情報及び前記第2点群分布情報に基づいて、前記第1点群データ又は前記第2点群データを移動することにより、前記第1点群データの投影と前記第1点群データの投影が重なるように、前記第1点群データと前記第2点群データを位置合わせするように構成され、前記点群分布情報は、グリッド内に投影されたデータ点の個数、グリッドと障害物境界との間の距離パラメータ、一列のグリッド内に投影されたデータ点の個数、及び前記障害物の行方向におけるグリッド長のうちの少なくとも一種を含む、点群位置合わせモジュールと、
前記位置合わせの際に変位したグリッド数と、第1投影面及び第2投影面のグリッドペアの表示割合とに基づいて、位置合わせされたデータ点ペアにおける2つのデータ点の間の距離を決定し、位置合わせされたデータ点ペアにおける2つのデータ点の間の距離に基づいて前記障害物の相対移動速度を確定するための速度確定モジュールであって、前記位置合わせされたデータ点ペアは、位置合わせ後に重なったデータ点ペアであり、当該データ点ペアのうちの一方のデータ点は前記第1点群データに属し、他方のデータ点は前記第2点群データに属する、速度確定モジュールと、を含むことを特徴とする障害物速度確定装置。 - 前記第1点群データの第1投影面を確定するステップは、
前記相対移動速度の少なくとも1つの方向に基づいて、少なくとも1つの投影方向を確定するステップと、
地面に垂直な方向と前記少なくとも1つの投影方向とをそれぞれ組み合わせるステップと、
組み合わせによる方向ペアに基づいて、少なくとも1つの前記第1投影面を作成するステップと、を含むことを特徴とする請求項9に記載の装置。 - 前記第1点群データを前記第1投影面における所定サイズのグリッド内に投影し、第1グリッド投影データを得るステップは、
前記第1点群データを前記第1点群データの重心を原点とする三次元座標系に変換するステップであって、前記座標系の2つの座標軸からなる平面が前記第1投影面である、ステップと、
前記座標系の原点を中心として、前記第1投影面を所定サイズのグリッドに分割するステップと、
変換後の第1点群データを分割されたグリッドに投影し、前記第1グリッド投影データを得るステップと、を含むことを特徴とする請求項9に記載の装置。 - 前記第1点群データを前記第1投影面における所定サイズのグリッド内に投影し、第1グリッド投影データを得るステップは、
前記第1点群データのサイズ及び前記グリッドのサイズに応じて、前記第1点群データの前記グリッドにおける表示割合を確定するステップと、
前記表示割合に従って、前記第1点群データを前記グリッドに投影し、前記第1グリッド投影データを得るステップと、を含むことを特徴とする請求項9または11に記載の装置。 - 前記第1グリッド投影データに基づいて前記第1点群分布情報を確定するステップは、
グリッド内に投影されたデータ点の個数が0より大きい場合、該グリッドと障害物境界との間の距離パラメータを0とするステップと、
グリッド内に投影されたデータ点の個数が0以下である場合、行方向に沿って該グリッドに最も近く、且つ投影されたデータ点の個数が0より大きい目標グリッドを検索するステップと、
前記グリッドと前記目標グリッドとの間のグリッド数に応じて、前記グリッドの前記距離パラメータを確定するステップと、
確定された前記距離パラメータを前記第1点群分布情報とするステップと、を含むことを特徴とする請求項9に記載の装置。 - 前記点群位置合わせモジュールは、
前記障害物の向きに応じて、前記第1点群データ又は前記第2点群データを移動するための点群移動ユニットと、
前記第1点群分布情報及び前記第2点群分布情報に基づいて、移動後の前記第1点群データと前記第2点群データとの間のマッチング度を算出するためのマッチング度計算ユニットと、
算出されたマッチング度に基づいて、前記第1点群データと前記第2点群データの位置合わせ位置を確定するための位置合わせ位置確定ユニットと、を含むことを特徴とする請求項9に記載の装置。 - 前記位置合わせ位置確定ユニットは、
少なくとも2回移動した後に算出されたマッチング度を正規化し、毎回の移動が実際の変位に該当する確率を得るステップと、
前記確率に基づいて変位期待値を算出し、算出された変位期待値を最適移動距離とするステップと、
前記最適移動距離だけ移動した位置を前記位置合わせ位置とするステップとを行うように構成されることを特徴とする請求項14に記載の装置。 - 前記速度確定モジュールは、
位置合わせされたデータ点ペアにおける2つのデータ点の間の距離に基づいて、前記障害物の、前記第1時刻と前記第2時刻との間にわたる目標移動距離を確定するための距離確定ユニットと、
前記目標移動距離に基づいて、前記障害物の相対移動速度を確定するための速度確定ユニットと、を含むことを特徴とする請求項9に記載の装置。 - 少なくとも1つのプロセッサと、
前記少なくとも1つのプロセッサと通信可能に接続されたメモリとを備える電子機器であって、
前記メモリには、前記少なくとも1つのプロセッサによって実行可能な指令が格納されており、前記指令が前記少なくとも1つのプロセッサによって実行されると、前記少なくとも1つのプロセッサに請求項1~8のいずれか1項に記載の方法が実行される、ことを特徴とする電子機器。 - コンピュータ指令が格納されている非一時的コンピュータ可読記憶媒体であって、
前記コンピュータ指令は前記コンピュータに請求項1~8のいずれか1項に記載の方法を実行させるために用いられることを特徴とする非一時的コンピュータ可読記憶媒体。 - プロセッサにより実行されると、請求項1~8のいずれか1項に記載の方法を実現する、コンピュータプログラム。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010188560.X | 2020-03-17 | ||
CN202010188560.XA CN111402308B (zh) | 2020-03-17 | 2020-03-17 | 障碍物速度的确定方法、装置、设备和介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2021119458A JP2021119458A (ja) | 2021-08-12 |
JP7194217B2 true JP7194217B2 (ja) | 2022-12-21 |
Family
ID=71428868
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2021043325A Active JP7194217B2 (ja) | 2020-03-17 | 2021-03-17 | 障害物速度確定方法、装置、電子機器、記憶媒体およびコンピュータプログラム |
Country Status (5)
Country | Link |
---|---|
US (1) | US11353476B2 (ja) |
EP (1) | EP3919930B1 (ja) |
JP (1) | JP7194217B2 (ja) |
KR (1) | KR102568948B1 (ja) |
CN (1) | CN111402308B (ja) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112001287B (zh) * | 2020-08-17 | 2023-09-12 | 禾多科技(北京)有限公司 | 障碍物的点云信息生成方法、装置、电子设备和介质 |
CN114972826A (zh) * | 2021-02-25 | 2022-08-30 | 淘宝(中国)软件有限公司 | 目标状态的确定方法、装置、电子设备及计算机存储介质 |
CN113838112A (zh) * | 2021-09-24 | 2021-12-24 | 东莞市诺丽电子科技有限公司 | 图像采集系统的触发信号确定方法及触发信号确定系统 |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20180341263A1 (en) | 2017-05-25 | 2018-11-29 | GM Global Technology Operations LLC | Methods and systems for moving object velocity determination |
Family Cites Families (27)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102564393A (zh) * | 2011-12-28 | 2012-07-11 | 北京工业大学 | 隧道全断面三维激光监控量测方法 |
US9043069B1 (en) | 2012-11-07 | 2015-05-26 | Google Inc. | Methods and systems for scan matching approaches for vehicle heading estimation |
US9355462B2 (en) * | 2013-05-08 | 2016-05-31 | Caterpillar Inc. | Motion estimation system utilizing point cloud registration |
US10139493B1 (en) * | 2016-07-06 | 2018-11-27 | Near Earth Autonomy, Inc. | Rotor safety system |
CN106199558A (zh) * | 2016-08-18 | 2016-12-07 | 宁波傲视智绘光电科技有限公司 | 障碍物快速检测方法 |
US10962647B2 (en) * | 2016-11-30 | 2021-03-30 | Yujin Robot Co., Ltd. | Lidar apparatus based on time of flight and moving object |
CN106651926A (zh) * | 2016-12-28 | 2017-05-10 | 华东师范大学 | 一种基于区域配准的深度点云三维重建方法 |
CN106997049B (zh) * | 2017-03-14 | 2020-07-03 | 奇瑞汽车股份有限公司 | 一种基于激光点云数据的检测障碍物的方法和装置 |
WO2018196000A1 (en) | 2017-04-28 | 2018-11-01 | SZ DJI Technology Co., Ltd. | Methods and associated systems for grid analysis |
US10255480B2 (en) * | 2017-05-15 | 2019-04-09 | The Boeing Company | Monitoring object shape and deviation from design |
CN108152831B (zh) * | 2017-12-06 | 2020-02-07 | 中国农业大学 | 一种激光雷达障碍物识别方法及系统 |
CN108257163B (zh) * | 2017-12-08 | 2020-04-07 | 西安电子科技大学 | 一种已知扫描点位置下的两点点云配准方法 |
CN108195359B (zh) * | 2017-12-12 | 2020-02-07 | 北京建筑大学 | 空间数据的采集方法及系统 |
CN108198145B (zh) * | 2017-12-29 | 2020-08-28 | 百度在线网络技术(北京)有限公司 | 用于点云数据修复的方法和装置 |
EP3525000B1 (en) | 2018-02-09 | 2021-07-21 | Bayerische Motoren Werke Aktiengesellschaft | Methods and apparatuses for object detection in a scene based on lidar data and radar data of the scene |
CN109001748B (zh) * | 2018-07-16 | 2021-03-23 | 北京旷视科技有限公司 | 目标对象与物品的关联方法、装置及系统 |
US11435479B2 (en) | 2018-08-06 | 2022-09-06 | Luminar, Llc | Determining relative velocity based on an expected configuration |
CN109446886B (zh) * | 2018-09-07 | 2020-08-25 | 百度在线网络技术(北京)有限公司 | 基于无人车的障碍物检测方法、装置、设备以及存储介质 |
CN109360239B (zh) * | 2018-10-24 | 2021-01-15 | 长沙智能驾驶研究院有限公司 | 障碍物检测方法、装置、计算机设备和存储介质 |
US10809073B2 (en) * | 2018-12-05 | 2020-10-20 | Here Global B.V. | Local window-based 2D occupancy grids for localization of autonomous vehicles |
CN109993780B (zh) * | 2019-03-07 | 2021-09-24 | 深兰科技(上海)有限公司 | 一种三维高精度地图生成方法及装置 |
CN110136426A (zh) * | 2019-04-15 | 2019-08-16 | 武汉环宇智行科技有限公司 | 一种还车招车系统及方法 |
CN110799989A (zh) * | 2019-04-20 | 2020-02-14 | 深圳市大疆创新科技有限公司 | 一种障碍物检测方法、设备、可移动平台及存储介质 |
CN109986563B (zh) * | 2019-05-01 | 2022-03-15 | 湖南大学 | 一种多移动机器人协同作业方法及系统 |
CN110286387B (zh) * | 2019-06-25 | 2021-09-24 | 深兰科技(上海)有限公司 | 应用于自动驾驶系统的障碍物检测方法、装置及存储介质 |
CN110471422A (zh) * | 2019-08-29 | 2019-11-19 | 南京理工大学 | 智能轮椅的障碍物检测与自主避障方法 |
CN110687549B (zh) * | 2019-10-25 | 2022-02-25 | 阿波罗智能技术(北京)有限公司 | 障碍物检测方法和装置 |
-
2020
- 2020-03-17 CN CN202010188560.XA patent/CN111402308B/zh active Active
- 2020-09-24 US US17/030,838 patent/US11353476B2/en active Active
-
2021
- 2021-03-16 EP EP21162985.2A patent/EP3919930B1/en active Active
- 2021-03-17 KR KR1020210034626A patent/KR102568948B1/ko active IP Right Grant
- 2021-03-17 JP JP2021043325A patent/JP7194217B2/ja active Active
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20180341263A1 (en) | 2017-05-25 | 2018-11-29 | GM Global Technology Operations LLC | Methods and systems for moving object velocity determination |
Also Published As
Publication number | Publication date |
---|---|
JP2021119458A (ja) | 2021-08-12 |
EP3919930A1 (en) | 2021-12-08 |
US20210293844A1 (en) | 2021-09-23 |
US11353476B2 (en) | 2022-06-07 |
EP3919930B1 (en) | 2023-05-10 |
CN111402308A (zh) | 2020-07-10 |
KR20210037633A (ko) | 2021-04-06 |
CN111402308B (zh) | 2023-08-04 |
KR102568948B1 (ko) | 2023-08-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP7262545B2 (ja) | 車両位置の判定方法、車両位置の判定装置、電子機器、コンピュータ可読記憶媒体及びコンピュータプログラム | |
JP7194217B2 (ja) | 障害物速度確定方法、装置、電子機器、記憶媒体およびコンピュータプログラム | |
US11615605B2 (en) | Vehicle information detection method, electronic device and storage medium | |
JP7258066B2 (ja) | 測位方法、測位装置及び電子機器 | |
CN111462029B (zh) | 视觉点云与高精地图融合方法、装置和电子设备 | |
JP2023510198A (ja) | 車両姿勢を検出するための方法及び装置 | |
US20210319261A1 (en) | Vehicle information detection method, method for training detection model, electronic device and storage medium | |
CN111079079B (zh) | 数据修正方法、装置、电子设备及计算机可读存储介质 | |
CN112184914B (zh) | 目标对象三维位置的确定方法、装置和路侧设备 | |
JP7242738B2 (ja) | 点群を更新するための方法、点群を更新するための装置、電子機器、非一時的コンピュータ可読記憶媒体及びコンピュータプログラム | |
JP2021107822A (ja) | 位置決め方法及び装置 | |
CN111797745B (zh) | 一种物体检测模型的训练及预测方法、装置、设备及介质 | |
JP7228623B2 (ja) | 障害物検出方法、装置、設備、記憶媒体、及びプログラム | |
CN112101209A (zh) | 用于路侧计算设备的确定世界坐标点云的方法和装置 | |
JP7337121B2 (ja) | 環状交差点のナビゲーション方法、装置、デバイス及び記憶媒体 | |
US11866064B2 (en) | Method and apparatus for processing map data | |
JP2021192041A (ja) | 建築物の測位方法、装置、電子デバイス、記憶媒体、プログラム、及び端末デバイス | |
CN111949816A (zh) | 定位处理方法、装置、电子设备和存储介质 | |
CN111462072A (zh) | 点云图质量检测方法、装置以及电子设备 | |
CN111260722B (zh) | 车辆定位方法、设备及存储介质 | |
US20220003566A1 (en) | Vehicle position determining method, apparatus and electronic device | |
CN111968071B (zh) | 车辆的空间位置生成方法、装置、设备及存储介质 | |
CN115658833A (zh) | 高精地图生成方法、装置、电子设备和存储介质 | |
CN112037316A (zh) | 映射的生成方法、装置和路侧设备 | |
CN117746388A (zh) | 点云标注方法、装置、电子设备和存储介质 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20210514 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20220531 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20220826 |
|
TRDD | Decision of grant or rejection written | ||
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20221115 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20221209 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 7194217 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |