(19)【発行国】日本国特許庁(JP)
(12)【公報種別】公開特許公報(A)
(11)【公開番号】P2022039906
(43)【公開日】2022-03-10
(54)【発明の名称】マルチセンサによる複合キャリブレーション装置及び方法
(51)【国際特許分類】
B25J 9/10 20060101AFI20220303BHJP
G06T 7/80 20170101ALI20220303BHJP
【FI】
B25J9/10 A
G06T7/80
【審査請求】有
【請求項の数】9
【出願形態】OL
(21)【出願番号】P 2021003139
(22)【出願日】2021-01-12
(31)【優先権主張番号】202010881818.4
(32)【優先日】2020-08-28
(33)【優先権主張国・地域又は機関】CN
(71)【出願人】
【識別番号】520022540
【氏名又は名称】中国計量大学
(74)【代理人】
【識別番号】100178434
【弁理士】
【氏名又は名称】李 じゅん
(72)【発明者】
【氏名】▲羅▼ 哉
(72)【発明者】
【氏名】江 文松
(72)【発明者】
【氏名】朱 志▲遠▼
(72)【発明者】
【氏名】▲趙▼ 洪楠
(72)【発明者】
【氏名】▲陳▼ ▲げい▼文
(72)【発明者】
【氏名】黄 杰伊
【テーマコード(参考)】
3C707
5L096
【Fターム(参考)】
3C707BS09
3C707CS08
3C707KT01
3C707KT06
3C707KT09
3C707LV19
3C707WA16
5L096AA09
5L096BA05
5L096CA02
5L096CA27
5L096FA06
5L096FA41
5L096FA67
5L096FA69
5L096FA76
5L096GA19
5L096GA32
5L096MA07
(57)【要約】 (修正有)
【課題】マルチセンサによる複合キャリブレーション装置及び方法を提供する。
【解決手段】ロボットアームを含み、前記ロボットアーム上にはセンサ融合フレームが設置され、センサ融合フレーム上にはレーザーレーダ、単眼カメラ、及びデータ処理のためのコンピュータが設置され、レーザーレーダ-カメラによる四キャリブレーションプレート複合キャリブレーションターゲットをさらに含み、前記レーザーレーダ-カメラによる四キャリブレーションプレート複合キャリブレーションターゲットは、一号キャリブレーションプレート、二号キャリブレーションプレート、三号キャリブレーションプレート、四号キャリブレーションプレートを含み、一号キャリブレーションプレート、二号キャリブレーションプレート、三号キャリブレーションプレートの中心位置はドットでマークされ、外部パラメータキャリブレーションの特徴点を提供するために使用される。
【選択図】
図1
【特許請求の範囲】
【請求項1】
ロボットアームを含み、前記ロボットアーム上にはセンサ融合フレームが設置され、センサ融合フレーム上にはレーザーレーダ、単眼カメラ、及びデータ処理のためのコンピュータが設置されるマルチセンサによる複合キャリブレーション装置であって、
レーザーレーダ-カメラによる四キャリブレーションプレート複合キャリブレーションターゲットをさらに含み、前記レーザーレーダ-カメラによる四キャリブレーションプレート複合キャリブレーションターゲットは、一号キャリブレーションプレート、二号キャリブレーションプレート、三号キャリブレーションプレート、四号キャリブレーションプレートを含み、
一号キャリブレーションプレート、二号キャリブレーションプレート、三号キャリブレーションプレートの中心位置はドットでマークされ、外部パラメータキャリブレーションの特徴点を提供するために使用され、
四号キャリブレーションプレート上には、カメラの内部パラメータキャリブレーションのために黒白の碁盤目模様が配列され、
4つのキャリブレーションプレートは、「田」字の形状に配置され、一号キャリブレーションプレートと二号キャリブレーションプレートは並列に配置され、三号キャリブレーションプレートと四号キャリブレーションプレートは一号キャリブレーションと二号キャリブレーションプレートの前方に並列に配置され、三号キャリブレーションプレートと四号キャリブレーションプレートは一号キャリブレーションプレートと二号キャリブレーションプレートより低く、
三号キャリブレーションプレート表面の法線ベクトルn3と四号キャリブレーションプレート表面の法線ベクトルn4との間の角度差は30°より大きく、
一号キャリブレーションプレート表面の法線ベクトルn1と二号キャリブレーションプレート表面の法線ベクトルn2との間の角度差は30°より大きい、
マルチセンサによる複合キャリブレーション装置。
【請求項2】
請求項1に記載のマルチセンサによる複合キャリブレーション装置の複合キャリブレーション方法であって、
カメラの内部パラメータキャリブレーションと、レーザーレーダ-カメラの外部パラメータキャリブレーションとを含み、
カメラの内部パラメータキャリブレーションの場合、異なる姿勢下でカメラが碁盤目キャリブレーションプレートに対して撮影を行うように、コンピュータユニットがロボットアームとカメラを制御し、張正友キャリブレーション方法を採用してカメラの内部パラメータKを計算し、
レーザーレーダ-カメラの外部パラメータキャリブレーションの場合、以下のステップを含む、
a)キャリブレーションプレートモジュールがレーザーレーダ及びカメラの視野範囲に現れるように、コンピュータユニットがロボットアームの姿勢を調整するとともに、
ロボットアームを制御して静止状態を維持し、レーザーレーダ及びカメラはデータ採集を行う、
b)レーザーレーダデータに対して分析及び処理を行い、点群特徴点を抽出し、
各点群の座標情報を記録し、異常点をフィルタリングし、点群分割法を採用して点群データを分割し、4つのキャリブレーションプレートの点群データを4つの異なるグループ{L
1}、{L
2}、{L
3},{L
4}へ分け、K-means方法を採用して点群のクラスタリング中心点を抽出し、
は、第i番目のキャリブレーションプレートの中心点位置のレーザーレーダの座標系における三次元座標値であり、
をマッチングのためのレーザー特徴点として選定する、
c)カメラデータに対して分析及び処理を行い、視覚特徴点を抽出し、
各ピクセルのグレー値を記録し、FASTキーポイント抽出アルゴリズムを採用し、キャリブレーションプレートのローカルピクセルのグレー値が明らかに変化された箇所を検出することにより、各キャリブレーションプレートの中心点位置を抽出し、
一号キャリブレーションプレート、二号キャリブレーションプレート、三号キャリブレーションプレートのドット中心点位置を抽出し、その座標値C
1、C
2、C
3を記録し、
碁盤目間の関係を分析することにより、四号キャリブレーションプレートの中心点座標値C
4を求め、
C
iは、第i番目のキャリブレーションプレートの中心点位置のカメラ座標系Cにおける二次元座標値であり、C
iをマッチングのための視覚特徴点として選定する、
d)レーザーレーダの特徴点
及びカメラの特徴点
によってマッチング関係
を確立し、
特徴点のマッチング関係によって最小再投影誤差を確立し、誤差方程式を構築し、誤差方程式によって最小二乗法による求解を行い、最適な外部パラメータ行列T
LCを取得する、
ことを特徴とするマルチセンサによる複合キャリブレーション方法。
【請求項3】
キャリブレーションプレートの中心位置特徴点に基づいて、キャリブレーションプレートのエッジ位置を採集して特徴点とする、
ことを特徴とする請求項2に記載のマルチセンサによる複合キャリブレーション方法。
【請求項4】
キャリブレーションプレートの角度を調整し、異なる角度の状態下で複数グループのキャリブレーションプレートのセンサデータを採集し、グループ毎のデータのキャリブレーションプレートの中心点座標値
をそれぞれ計算し、偏差の大きい中心点座標値を削除し、平均値策略を採用して残りの中心点座標を計算する、
ことを特徴とする請求項2に記載のマルチセンサによる複合キャリブレーション方法。
【請求項5】
前記カメラの内部パラメータキャリブレーションは、碁盤目キャリブレーション方法を採用しており、
前記碁盤目キャリブレーション方法は、異なる姿勢下でカメラが碁盤目キャリブレーションプレートに対して撮影を行うように、コンピュータユニットがロボットアーム及びカメラを制御し、20~30枚の画像のエッジ情報を抽出し、張正友キャリブレーション方法を採用してカメラの内部パラメータKを計算することである、
ことを特徴とする請求項2に記載のマルチセンサによる複合キャリブレーション方法。
【請求項6】
請求項1に記載のマルチセンサによる複合キャリブレーション装置の複合キャリブレーション方法であって、
センサ融合フレーム上に配置された慣性ナビゲーションシステムをさらに含み、
複合キャリブレーション方法には、レーザーレーダ及び慣性ナビゲーションシステムによる複合キャリブレーション方法を含んでおり、
ロボットアームの初期運動時刻をt
0として定義し、ロボットアームの運動終了時刻をt
nとして定義し、t
n時刻に走査されたレーザー点群をP
nとして定義し、t
0時刻でのレーザーレーダの座標系をL
0として定義し、t
0時刻での慣性ナビゲーションシステムの座標系をI
0として定義し、t
n時刻でのレーザーレーダの座標系をL
nとして定義し、t
n時刻での慣性ナビゲーションシステムの座標系をI
nとして定義し、レーザーレーダのt
0時刻からt
n時刻までの間の姿勢変換行列をT
Lとして定義し、慣性ナビゲーションシステムのt
0時刻からt
n時刻までの間の姿勢変換行列をT
Iとして定義し、レーザーレーダと慣性ナビゲーションシステムとの間の外部パラメータ行列をT
LIとして定義すると、
前記複合キャリブレーション方法は、以下のステップを含む、
a)ロボットアームは指定された軌跡に従って運動を行い、ロボットアームの運動過程中に、レーザーレーダ及び慣性ナビゲーションシステムがデータ採集を行う、
b)ロボットアームを制御して運動を停止し、センサによって採集されたデータに対して処理を行い、
レーザーレーダの場合、均一運動モデルに従ってフレーム毎のレーザー点群に対して歪み除去処理を行い、
点群フィルタリングアルゴリズムを採用し、点群データ中の外れ値を除去し、
計算の複雑さを軽減するために、ボクセルグリッド方法を使用してフレーム毎のレーザー点群データに対してダウンサンプリング処理を行う、
c)レーザーレーダの座標系
の初期時刻t
0での座標系L
0と運動終了時刻での座標系L
nとの間の姿勢変換行列T
Lを計算する、
姿勢変換行列T
Lの計算方法は、以下の通りである、
反復最近傍法を採用して第iフレーム点群と第i+1フレーム点群をマッチングし、第iフレーム点群
と第i+1フレーム点群
のマッチング関係を取得し、
第i時刻から第i+1時刻までのレーザーレーダの姿勢変換は、回転行列R
iと並進ベクトルt
iから構成されており、2フレーム点群の姿勢変換関係を示し、さらに、誤差方程式を構築し、誤差方程式を最小二乗問題に変換し、SVD法を採用してR
i、t
iを計算し、R
i、t
iによって第i時刻から第i+1時刻までのレーザーレーダの姿勢変換行列を
として取得し、nフレームのレーザーレーダの姿勢変換行列T
iを累積的に乗算し、レーザーレーダのt
0時刻からt
n時刻までの姿勢変換行列T
Lを取得する、
d)慣性ナビゲーションシステムの座標系
の初期時刻t
0での座標系I
0と運動終了時刻t
nでの座標系I
nとの間の姿勢変換行列T
Iを計算する、
姿勢変換行列T
Iの計算方法は、以下の通りである、
慣性ナビゲーションシステムの加速度測定データ及び角速度測定データに対して積分を行い、変位データt
I及び回転データR
Iを取得すると、慣性ナビゲーションシステムのt
0時刻からt
n時刻までの姿勢変換行列
に表される、
e)T
Lによってt
n時刻でのレーザー点群P
nをt
0時刻でのL
0座標系に投影し、点群P
nLを取得する、
f)T
I及びキャリブレーション待ちパラメータT
LIによってt
n時刻でのレーザー点群P
nをt
0時刻でのL
0座標系に投影し、P
nIを取得する、
g)2グループの点群P
nL及びP
nIをマッチングし、2グループの点群を整列し、外部パラメータ行列T
LIに対して最適化を行い、反復最近傍法を採用してP
nL及びP
nIが記述された同一領域の点群領域をレジストレーションし、最近傍誤差T
errorを構築及び最適化し、T
error、T
L、T
Iによって外部パラメータ行列T
LIを求解する、
ことを特徴とするマルチセンサによる複合キャリブレーション方法。
【請求項7】
視覚条件が十分である場合、単眼カメラの観測データを記録し、視覚-IMUキャリブレーションツールを採用し、単眼カメラと慣性ナビゲーションシステムとの間の外部パラメータ行列TCIを計算し、
決定された3つの外部パラメータ行列TLC、TLI、TCI間の姿勢一貫性に基づいて複合検証を行い、外部パラメータ行列中の変換パラメータを調整し、マルチセンサによる複合キャリブレーションの精度を向上し、
前記パラメータ最適化は、オンライン調整方法を採用し、レーザーレーダ、単眼カメラ、慣性ナビゲーションシステムのデータを融合し、TLI、TCIに対して調整を行う、
ことを特徴とする請求項6に記載のマルチセンサによる複合キャリブレーション方法。
【請求項8】
視覚条件が十分である場合、キャリブレーションターゲットがカメラの視野範囲内に現れるように、ロボットアームを制御し、カメラが常にキャリブレーションターゲットを観測できる条件下で、ロボットアームを制御して空間内で六自由度の運動をし、
単眼カメラの観測データを記録し、キャリブレーションツールを採用して視覚-慣性ナビゲーションシステムの外部パラメータ行列T
CIを次のようにキャリブレーションする、
ことを特徴とする請求項7に記載のマルチセンサによる複合キャリブレーション方法。
【請求項9】
レーザーレーダ、単眼カメラ、慣性測定ユニット間の姿勢変換行列に対して複合最適化を行い、
決定された3つの外部パラメータ行列T
LC、T
LI、T
CI間の姿勢一貫性に基づいて複合検証を行う、
具体的なステップは、以下の通りである、
各姿勢変換誤差を計算する、
【数1】
がすべて誤差閾値error
thrより小さい場合、T
LC、T
LI、及びT
CI間は既に姿勢一貫性を満たしていると見なされ、調整不要となる、
その後、各姿勢変換行列誤差がすべて誤差閾値より小さいという制約を満たす条件下で、総誤差error
Tが最小になるように、各姿勢変換行列に対して調整を行う、
【数2】
の大きさを判断し、3つの誤差の大きさから主な誤差由来を初歩的に特定し、誤差の正負から調整する方向を初歩的に決定する、
並進ベクトル及び回転行列中の各ベクトル成分を分析し、並進ベクトルに対して、次の調整を行う、
【数3】
ここで、Δx、Δy、及びΔzの大きさ及び正負は、
の具体的なベクトル成分を分析することによって取得し、
回転行列に対して、次のような調整を行う、
【数4】
ここで、Δrの大きさと正負は、
の具体的なベクトル成分を分析することによって取得する、
ことを特徴とする請求項7に記載のマルチセンサによる複合キャリブレーション方法。
【発明の詳細な説明】
【技術分野】
【0001】
本発明は、センサ技術分野に関するものである。特に、マルチセンサによるキャリブレーション技術に関するものである。
【背景技術】
【0002】
リアルタイム位置特定と地図構築(Simultaneous Localization and Mapping、SLAMと称する)技術は、無人運転のための環境認識情報を提供しており、従来のSLAM技術は、レーザーSLAMと視覚SLAMに分けられる。レーザーレーダは測距精度が高く、光の影響を受けない等の利点があり、カメラはコストが低く、画像情報が豊富である等の利点がある。しかしながら、単一センサSLAMには、大きな局限性がある。例えば、レーザーレーダの場合、更新頻度が遅く、モーション歪みがあって、雨や雪等の過酷な環境下では正確な測定値を提供できない。カメラの場合、正確な三次元情報を取得できなく、周囲光による制限が比較的に大きい。
【0003】
慣性ナビゲーションシステムは、姿勢推定補助ツールとして、正確な角速度と加速度を提供できる。そのため、レーザーレーダ、視覚センサ、慣性ナビゲーションシステム等のマルチセンサデータを融合することにより、SLAMの環境知覚能力を向上させることができる。
【0004】
SLAMシステム中のセンサのキャリブレーションは、内部パラメータキャリブレーションと外部パラメータキャリブレーションに分けられる。センサの内部パラメータキャリブレーションは、主に、センサ測定データの正確さを確保するためのカメラの内部パラメータ行列の計算と慣性ナビゲーションシステムの誤差係数の計算を指す。センサ間の外部パラメータキャリブレーションは、マルチセンサ情報の融合を正確に行うための前提条件であり、センサ間の外部パラメータキャリブレーションは、各センサの座標系間の姿勢変換関係を決定することである。
【0005】
従来の外部パラメータキャリブレーション方法は、車体座標系を基準として、レーザーレーダの座標系、カメラ座標系、慣性ナビゲーションシステムの座標系から車体座標系への姿勢変換関係を求める。ただし、従来の外部パラメータキャリブレーションでは、すべてのセンサが車体内に固定され、車体は運動次元の制限を受けるため、キャリブレーション過程は複雑であり、ヨー角とロール角の正確なキャリブレーションを実現することは困難である。
【0006】
レーザーレーダは測距精度が高く、キャリブレーション参照物に対して特別な要件はないが、カメラは二次元画像特性に基づくため、キャリブレーションするためには特定のキャリブレーション参照物が必要である。現在、既存のレーザーレーダとカメラの外部パラメータキャリブレーション方法には、単一の碁盤目キャリブレーションプレートに基づくキャリブレーション方法、「L」字の形状のキャリブレーションプレートに基づくキャリブレーション方法、及び三次元碁盤目ターゲットに基づくキャリブレーション方法が含まれる。これらの方法は類似しており、すべてレーザーの三次元特徴点とカメラの二次元特徴点をマッチングすることにより、外部パラメータ行列の求解を行うことである。
【0007】
レーザーレーダと慣性ナビゲーションシステムのキャリブレーションは、運動条件下で行う必要があり、慣性ナビゲーションシステムは、正確な加速度測定値と角速度測定値を提供することができる。従来のキャリブレーション方法は、ハンドアイキャリブレーション方法であるが、そのキャリブレーションの精度を保証することは困難である。中国百度(バイドゥ)のApollo(アポロ)キャリブレーションツールは、「8」字の形状の回りを運動するように車両を制御することにより、センサのデータ採集と外部パラメータキャリブレーションを実現する。
【0008】
マルチセンサによる複合キャリブレーションは、現在無人運転の分野で最もホットなトピックの一つである。既存のキャリブレーション技術は、自動化の程度が低く、操作が複雑であり、精度が低い等のデメリットがある。
【発明の概要】
【0009】
本発明は従来技術に存在する上記の課題を解決するためになされたものであり、操作が簡単であり、精度が高いマルチセンサによる複合キャリブレーション装置及び方法を提供することを目的とする。
【0010】
本発明の目的は、以下の技術的解決策を通じて達成することができる。
【0011】
ロボットアームを含み、前記ロボットアーム上にはセンサ融合フレームが設置され、センサ融合フレーム上にはレーザーレーダ、単眼カメラ、及びデータ処理のためのコンピュータが設置され、レーザーレーダ-カメラによる四キャリブレーションプレート複合キャリブレーションターゲットをさらに含み、前記レーザーレーダ-カメラによる四キャリブレーションプレート複合キャリブレーションターゲットは、一号キャリブレーションプレート、二号キャリブレーションプレート、三号キャリブレーションプレート、四号キャリブレーションプレートを含み、一号キャリブレーションプレート、二号キャリブレーションプレート、三号キャリブレーションプレートの中心位置はドットでマークされ、外部パラメータキャリブレーションの特徴点を提供するために使用され、四号キャリブレーションプレート上には、カメラの内部パラメータキャリブレーションのために黒白の碁盤目模様が配列され、4つのキャリブレーションプレートは、「田」字の形状に配置され、一号キャリブレーションプレートと二号キャリブレーションプレートは並列に配置され、三号キャリブレーションプレートと四号キャリブレーションプレートは一号キャリブレーションと二号キャリブレーションプレートの前方に並列に配置され、三号キャリブレーションプレートと四号キャリブレーションプレートは一号キャリブレーションプレートと二号キャリブレーションプレートより低く、三号キャリブレーションプレート表面の法線ベクトルn3と四号キャリブレーションプレート表面の法線ベクトルn4との間の角度差は30°より大きく、一号キャリブレーションプレート表面の法線ベクトルn1と二号キャリブレーションプレート表面の法線ベクトルn2との間の角度差は30°より大きい、マルチセンサによる複合キャリブレーション装置を提供する。
【0012】
カメラの内部パラメータキャリブレーションと、レーザーレーダ-カメラの外部パラメータキャリブレーションとを含むマルチセンサによる複合キャリブレーション方法を提供する。カメラの内部パラメータキャリブレーションの場合、異なる姿勢下でカメラが碁盤目キャリブレーションプレートに対して撮影を行うように、コンピュータユニットがロボットアーム及びカメラを制御し、張正友(ZhangZhengyou)キャリブレーション方法を採用してカメラの内部パラメータKを計算する。レーザーレーダ-カメラの外部パラメータキャリブレーションの場合、以下のステップを含む。
【0013】
ステップ1、キャリブレーションプレートモジュールがレーザーレーダ及びカメラの視野範囲に現れるように、コンピュータユニットがロボットアームの姿勢を調整するとともに、ロボットアームを制御して静止状態を維持し、レーザーレーダ及びカメラはデータ採集を行う。
【0014】
ステップ2、レーザーレーダデータに対して分析及び処理を行い、点群特徴点を抽出し、各点群の座標情報を記録し、異常点をフィルタリングし、点群分割法を採用して点群データを分割し、4つのキャリブレーションプレートの点群データを4つの異なるグループ{L
1}、{L
2}、{L
3},{L
4}へ分け、K-means方法を利用して点群のクラスタリング中心点を抽出し、
は、第i番目のキャリブレーションプレートの中心点位置のレーザーレーダの座標系における三次元座標値であり、
をマッチングのためのレーザー特徴点として選定する。
【0015】
ステップ3、カメラデータに対して分析及び処理を行い、視覚特徴点を抽出し、各ピクセルのグレー値を記録し、FASTキーポイント抽出アルゴリズムを採用し、キャリブレーションプレートのローカルピクセルのグレー値が明らかに変化された箇所を検出することにより、各キャリブレーションプレートの中心点位置を抽出し、一号キャリブレーションプレート、二号キャリブレーションプレート、三号キャリブレーションプレートのドット中心点位置を抽出し、その座標値C1、C2、C3を記録し、碁盤目間の関係を分析することにより、四号キャリブレーションプレートの中心点座標値C4を求め、Ciは、第i番目のキャリブレーションプレートの中心点位置のカメラ座標系Cにおける二次元座標値であり、Ciをマッチングのための視覚特徴点として選定する。
【0016】
ステップ4、レーザーレーダの特徴点
及びカメラの特徴点
によってマッチング関係
を確立し、特徴点のマッチング関係によって最小再投影誤差を確立し、誤差方程式を構築し、誤差方程式によって最小二乗法による求解を行い、最適な外部パラメータ行列T
LCを取得する。
【0017】
いくつかの実施形態では、キャリブレーションプレートの中心位置特徴点に基づいて、キャリブレーションプレートのエッジ位置を採集して特徴点とする。
【0018】
いくつかの実施形態では、前記カメラの内部パラメータキャリブレーションは、碁盤目キャリブレーション方法を採用しており、前記碁盤目キャリブレーション方法は、異なる姿勢下でカメラが碁盤目キャリブレーションプレートに対して撮影を行うように、コンピュータユニットがロボットアーム及びカメラを制御し、20~30枚の画像のエッジ情報を抽出し、張正友(ZhangZhengyou)キャリブレーション方法を採用してカメラの内部パラメータKを計算することである。
【0019】
いくつかの実施形態では、センサ融合フレーム上に配置された慣性ナビゲーションシステムをさらに含む。複合キャリブレーション方法には、レーザーレーダ及び慣性ナビゲーションシステムによる複合キャリブレーション方法を含む。ロボットアームの初期運動時刻をt0として定義し、ロボットアームの運動終了時刻をtnとして定義し、tn時刻に走査されたレーザー点群をPnとして定義し、t0時刻でのレーザーレーダの座標系をL0として定義し、t0時刻での慣性ナビゲーションシステムの座標系をI0として定義し、tn時刻でのレーザーレーダの座標系をLnとして定義し、tn時刻での慣性ナビゲーションシステムの座標系をInとして定義し、レーザーレーダのt0時刻からtn時刻までの間の姿勢変換行列をTLとして定義し、慣性ナビゲーションシステムのt0時刻からtn時刻までの間の姿勢変換行列をTIとして定義し、レーザーレーダと慣性ナビゲーションシステムとの間の外部パラメータ行列をTLIとして定義する。
【0020】
前記複合キャリブレーション方法は、以下のステップを含む。
ステップ1、ロボットアームは指定された軌跡に従って運動を行い、ロボットアームの運動過程中に、レーザーレーダ及び慣性ナビゲーションシステムがデータ採集を行う。
ステップ2、ロボットアームを制御して運動を停止し、センサによって採集されたデータに対して処理を行う。レーザーレーダの場合、均一運動モデルに従ってフレーム毎のレーザー点群に対して歪み除去処理を行う。点群フィルタリングアルゴリズムを採用し、点群データ中の外れ値を除去する。計算の複雑さを軽減するために、ボクセルグリッド方法を使用してフレーム毎のレーザー点群データに対してダウンサンプリング処理を行う。
ステップ3、レーザーレーダの座標系
の初期時刻t
0での座標系L
0と運動終了時刻での座標系L
nとの間の姿勢変換行列T
Lを計算する。姿勢変換行列T
Lの計算方法は、下記の通りである。反復最近傍法を採用して第iフレーム点群と第i+1フレーム点群をマッチングし、第iフレーム点群
と第i+1フレーム点群
のマッチング関係を取得する。第i時刻から第i+1時刻までのレーザーレーダの姿勢変換は、回転行列R
iと並進ベクトルt
iから構成されており、2フレーム点群の姿勢変換関係を示す。さらに、誤差方程式を構築し、誤差方程式を最小二乗問題に変換し、SVD法を採用してR
i、t
iを計算する。R
i、t
iによって第i時刻から第i+1時刻までのレーザーレーダの姿勢変換行列を
として取得する。さらに、nフレームのレーザーレーダの姿勢変換行列T
iを累積的に乗算し、レーザーレーダのt
0時刻からt
n時刻までの姿勢変換行列T
Lを取得する。
ステップ4、慣性ナビゲーションシステムの座標系
の初期時刻t
0での座標系I
0と運動終了時刻t
nでの座標系I
nとの間の姿勢変換行列T
Iを計算する。姿勢変換行列T
Iの計算方法は、下記の通りである。慣性ナビゲーションシステムの加速度測定データ及び角速度測定データに対して積分を行い、変位データt
I及び回転データR
Iを取得すると、慣性ナビゲーションシステムのt
0時刻からt
n時刻までの姿勢変換行列
に表される。
ステップ5、T
Lによってt
n時刻でのレーザー点群P
nをt
0時刻でのL
0座標系に投影し、点群P
nLを取得する。
ステップ6、T
I及びキャリブレーション待ちパラメータT
LIによってt
n時刻でのレーザー点群P
nをt
0時刻でのL
0座標系に投影し、P
nIを取得する。
ステップ7、2グループの点群P
nL及びP
nIをマッチングする。2グループの点群を整列し、外部パラメータ行列T
LIに対して最適化を行う。反復最近傍法を採用してP
nL及びP
nIが記述された同一点群領域をレジストレーションし、最近傍誤差T
errorを構築及び最適化し、T
error、T
L、T
Iによって外部パラメータ行列T
LIを求解する。
【0021】
いくつかの実施形態では、視覚条件が十分である場合、単眼カメラの観測データを記録し、視覚-IMUキャリブレーションツールを採用し、単眼カメラと慣性ナビゲーションシステムとの間の外部パラメータ行列TCIを計算する。決定された3つの外部パラメータ行列TLC、TLI、TCI間の姿勢一貫性に基づいて複合検証を行い、外部パラメータ行列中の変換パラメータに対して調整を行い、マルチセンサによる複合キャリブレーションの精度を向上する。前記パラメータ最適化は、オンライン調整方法を採用し、レーザーレーダ、単眼カメラ、慣性ナビゲーションシステムのデータを融合し、TLI、TCIに対して調整を行う。
【0022】
従来技術と比較して、本発明のマルチセンサによる複合キャリブレーション装置及び方法には、以下の利点がある。
【0023】
本発明は、16ライン、32ライン、64ライン等のマルチラインレーザーレーダ、単眼カメラ、双眼カメラ、RGBDカメラ等の視覚センサに適用される。本発明の実施形態は、キャリブレーション及び二次開発に便利な携帯型マルチセンサ融合フレーを構築する。本発明の実施形態は、ロボットアームによる補助キャリブレーション方法を使用することにより、インテリジェントキャリブレーション及びバッチキャリブレーションを実現することができる。
【図面の簡単な説明】
【0024】
図面(必ずしも一定の縮尺で描かれているわけではない)で、同様の参照番号は異なる図で同様の構成要素を記載する場合がある。異なる文字接尾辞を持つ同様の参照番号は、同様な構成要素の異なる例を表すことができる。図面は、限定ではなく例として、本明細書で論じられる各実施形態を示している。
【
図1】センサ融合フレームが設置されているロボットアームの概略図である。
【
図3】レーザーレーダ-カメラによる四キャリブレーションプレート複合キャリブレーションターゲットの位置関係の概略図である。
【
図4】キャリブレーションターゲットの空間配置の概略図である。
【
図5】レーザーレーダ-カメラの複合キャリブレーションの原理概略図である。
【
図7】レーザー-視覚特徴マッチングの概略図である。
【
図9】慣性ナビゲーションシステムの姿勢変換の概略図である。
【
図10】キャリブレーションのフローチャートである。
【発明を実施するための形態】
【0025】
以下は、本発明の具体的な実施例であり、図面を結合しながら本発明の技術的解決策をさらに説明するが、本発明は、これらの実施例によって限定されず、以下の実施形態は、請求の範囲に係る本発明を限定するものではない。また、実施形態に記載されている特徴のすべての組み合わせは、本発明の解決に必ずしも必須ではない。
【0026】
実施例
マルチセンサ融合フレーム101、ロボットアーム102、連結機構103、コンピュータユニット104、及び操作プラットフォームを含むマルチセンサによる複合キャリブレーション装置であって、前記マルチセンサ融合フレーム101は、マルチセンサによる複合構築法によってレーザーレーダ201、単眼カメラ202、及び慣性ナビゲーションシステム203を自由的に運動可能な金属フレーム204に固定され、このフレームは治具206を介して無人車両、無人航空機等の環境感知の場合に搭載され、二次開発に適用されるとともに、外部パラメータキャリブレーションの実施に便利である。前記金属フレームは、長さ18cm、幅6cm、高さ8cmである。マルチセンサによる複合構築法を採用して各センサは同じ座標系指向に従って設置される。そのうち、レーザーレーダ201は、金属フレーム204の上部の中央位置に設置され、固定装置205は金属フレームの内部に設置される。単眼カメラ202は、固定装置205の左側5cmの位置に設置され、慣性ナビゲーションシステム203は固定装置205の右側5cmの位置に設置される。所述ロボットアーム102は、操作プラットフォーム105の上方に設置され、三軸方向の並進及び回転運動を提供する。ロボットアームの末端は連結機構103を介して固定装置205に連接され、初期状態下に、マルチセンサ融合フレーム101の地面からの高さは140cmである。前記コンピュータユニット103は、ボットアーム102の運動の制御、センサによるデータ採集の制御、センサデータの処理、外部パラメータ行列の計算を行う機能を有する。
【0027】
レーザーレーダ-カメラによる四キャリブレーションプレート複合キャリブレーションターゲットをさらに含み、レーザーレーダ-カメラによる四キャリブレーションプレート複合キャリブレーションターゲットは、4つの同じサイズのキャリブレーションプレートから構成されている。前記レーザーレーダ-カメラによる四キャリブレーションプレート複合キャリブレーションターゲット104は、4つの30cm×30cmのキャリブレーションプレートから構成されている。
図3に示すように、一~三号キャリブレーションプレートの中央位置はドットでマークされ、外部パラメータキャリブレーションのための特徴点を提供する。四号キャリブレーションプレート上には、カメラの内部パラメータキャリブレーションのために黒白の碁盤目模様が配列される。4つのキャリブレーションプレートは、「田」字の形状で空中に配置される。4つのキャリブレーションプレートをより正確に分割するために、それらは異なる距離及び角度で環境中に配置される。
図4に示すように、三号キャリブレーションプレート及び四号キャリブレーションプレートは高さ120cmのベースを採用して固定し、ベースは水平線一上に配置され、マルチセンサ融合フレームとの距離はD
1=130cmであり、三号キャリブレーションプレートの法線ベクトルn
3
と四号キャリブレーションプレートの法線ベクトルn
4
との間の角度差は30°以上である。一号キャリブレーションプレート及び二号キャリブレーションプレートがカバーされないように確保するために、一号キャリブレーションプレート及び二号キャリブレーションプレートは高さ160cmのベースを採用して固定し、ベースは水平線二上に配置され、マルチセンサ融合フレームとの距離はD
2=180cmである。一号キャリブレーションプレートの法線ベクトルn
1と二号キャリブレーションプレートの法線ベクトルn
2との間の角度差は30°以上である。
【0028】
前記カメラの内部パラメータキャリブレーションは、異なる姿勢下でカメラが碁盤目キャリブレーションプレートに対して撮影を行うように、コンピュータユニットがロボットアーム及びカメラを制御し、20~30枚の画像のエッジ情報を抽出し、張正友(ZhangZhengyou)キャリブレーション方法を採用してカメラの内部パラメータKを計算する。
【0029】
前記レーザーレーダ-カメラによる四キャリブレーションプレート複合キャリブレーションターゲットは、単眼カメラの内部パラメータキャリブレーション及びレーザーレーダ-カメラの外部パラメータキャリブレーションに採用される。前記レーザーレーダと単眼カメラによる複合キャリブレーション方法は、以下のステップを含む。
【0030】
まず、
図5に示すように、複合キャリブレーションターゲットがレーザーレーダ及びカメラの視野範囲に現れるように、コンピュータユニットがロボットアームの姿勢を調整する。ロボットアームを制御して静止状態を維持し、レーザーレーダとカメラを採用してデータ採集を行った後、コンピュータユニットが測定データを処理する。最後に、最小二乗問題を構築し、外部パラメータ行列T
LCを求解する。
【0031】
前記データ採集によってレーザーレーダデータ及びカメラデータに対してそれぞれ処理を行う。
【0032】
レーザーレーダデータの場合、各点群の座標情報を記録し、異常点をフィルタリングし、点群分割法を採用して点群データを分割し、4つのキャリブレーションプレートの点群データを4つの異なるグループ{L
1}、{L
2}、{L
3},{L
4}に分ける。K-means法を利用して点群のクラスタリング中心点を抽出する。
は、第i番目のキャリブレーションプレートの中心点位置のレーザーレーダの座標系Lにおける三次元座標値である。
をマッチングのためのレーザー特徴点として選定する。
【0033】
カメラデータの場合、各ピクセルのグレー値を記録し、FASTキーポイント抽出アルゴリズムを採用し、キャリブレーションプレートのローカルピクセルのグレー値が明らかに変化された箇所を検出することにより、各キャリブレーションプレートの中心点位置を抽出する。一~三号キャリブレーションプレートのドットの中心位置を抽出し、その座標値C
1、C
2、C
3を記録する。四号キャリブレーションプレートの場合、碁盤目間の関係を分析することにより、キャリブレーションプレートの中心点座標値C
4を求める。
は、第i番目のキャリブレーションプレートの中心点位置のカメラ座標系Cにおける二次元座標値である。C
iをマッチングのための視覚特徴点として選定する。
レーザーレーダの三次元特徴点
及び単眼カメラの二次元特徴点
によってマッチング関係
を確立する。
図7に示すように、レーザーレーダ座標
及び単眼カメラ座標
の特徴点Piに基づくマッチング関係を定義することにより、最小再投影誤差を確立し、最小二乗問題を構築する。レーザーレーダ及びカメラの外部パラメータ行列を次のように定義する。
【数1】
【0034】
ここで、Rが回転行列であり、tが並進ベクトルである。マッチング関係及び外部パラメータ行列を結合すると、誤差方程式は次のように表すことができる。
【数2】
【0035】
ここで、s
iは視覚特徴点の深さ値であり、誤差が最小化になるように、誤差方程式に従って最小二乗最適化関数を構築し、最適な外部パラメータ行列を取得する。
【数3】
【0036】
さらに、必要に応じて、より多くの特徴点を採集してマッチングを行い、キャリブレーションプレートの中心位置特徴点に基づいて、キャリブレーションプレートのエッジ位置を採集して特徴点とする。
図6に示すように、キャリブレーションプレート毎の5つの位置を選択して特徴点とし、上記方法に従って最小二乗最適化関数を構築し、外部パラメータ行列を求解する。実験によって特性点の数が多いほど、外部パラメータ行列の計算がより正確であることが証明されている。
【0037】
さらに、キャリブレーションプレートの角度を調整し、異なる角度の状態下で複数グループのキャリブレーションプレートのセンサデータを採集し、グループ毎のデータのキャリブレーションプレートの中心点座標値
をそれぞれ計算し、偏差の大きい中心点座標値を削除し、平均値策略を採用して次のように残りの中心点座標を計算する。
【数4】
【0038】
既存のキャリブレーション技術では、キャリブレーションプレートの位置及び角度は固定である。レーザーレーダの縦方向点群のスパース性によってレーザーレーダによる走査がキャリブレーションプレートのすべての領域を完全にカバーすることを保証することは困難である。レーザーレーダによる走査ラインがキャリブレーションプレートの完全な輪郭を完全に走査できなかった場合、点群特徴点(キャリブレーションプレートの中心点)の座標は、実際の位置と差異が大きくなってしまう。
【0039】
本方法は、レーザーレーダ及びカメラが複数グループのキャリブレーションプレートデータを採集するように、キャリブレーションプレートの角度を調整する。キャリブレーションプレートの中心点を角度調整の回転中心として採用するため、キャリブレーションプレートの調整に関係なく、その中心点座標は常に変わらない。本方法は、キャリブレーションプレートの中心点位置の不変性を利用して、異なる角度下で複数グループの点群データによって複数グループの中心点座標をフィッティングし、誤差が大きい中心点座標を除去し、残りの中心点座標の平均値をキャリブレーションプレートの点群特徴点とする。既存技術と比較して、本方法で抽出された特徴点の精度は大幅に向上されている。
【0040】
レーザーレーダ及び慣性ナビゲーションシステムの複合キャリブレーション方法は、次のステップで構成される。
【0041】
ロボットアームの支援下で、点群マッチングに基づくレーザーレーダ-慣性ナビゲーションシステムによる外部パラメータキャリブレーションを採用する。具体的なステップは下記の通りである。
【0042】
まず、ロボットアームを制御して運動し、センサが空間内で運動しながらデータを採集する。
【0043】
次に、ロボットアームの運動が停止され、センサによって採集されたデータに対して処理を行う。
【0044】
その後、レーザーレーダの初期時刻t0での座標系L0と運動終了時刻tnでの座標系Lnとの間の姿勢変換行列TLを計算する。慣性ナビゲーションシステムの初期時刻t0での座標系I0と運動終了時刻tnでの座標系Inとの間の姿勢変換行列TIを計算する。
【0045】
再び、TLによってtn時刻でのレーザー点群Pnをt0時刻でのL0座標系に投影し、点群PnLを取得する。TI及びキャリブレーション待ちパラメータTLIによってtn時刻でのレーザー点群Pnをt0時刻でのL0座標系に投影し、PnIを取得する。最後に、2グループの点群PnLとPnIをマッチングし、2グループの点群を整列することにより、外部パラメータ行列TLIを計算する。
【0046】
前記ロボットアームの運動は、指定された軌跡内を運動するようにロボットアームを制御することである。ロボットアームの座標軸を基準として、X軸の正方向に沿って100cm移動し、X軸の負方向に沿って100cm移動し、Y軸の正方向に沿って100cm移動し、Y軸の負方向に沿って100cm移動し、Z軸の正方向に沿って100cm移動し、Z軸の負方向に沿って100cm移動する。X軸を中心に時計回りに180°回転し、X軸を中心に反時計回りに180°回転し、Y軸を中心に時計回りに180°回転し、Y軸を中心に反時計回りに180°回転し、Z軸を中心に時計回りに180°回転し、Z軸を中心に反時計回りに180°回転する。ロボットアームの運動過程中に、レーザーレーダ及び慣性ナビゲーションシステムがデータ採集を行う。
【0047】
前記センサのデータ処理は、レーザーレーダの場合、均一運動モデルに従ってフレーム毎のレーザー点群に対して歪み除去処理を行い、点群フィルタリングアルゴリズムを採用し、点群データの外れ値を除去する。計算の複雑さを軽減するために、フレーム毎のレーザー点群データに対して、ボクセルグリッド方法を使用してダウンサンプリング処理を行うことである。
【0048】
前記姿勢変換行列T
Lの計算方法は、次の通りである。反復最近傍法を採用して第iフレーム点群と第i+1フレーム点群をマッチングし、第iフレーム点群
と第i+1フレーム点群
とのマッチング関係を取得する。第i時刻から第i+1時刻までのレーザーレーダの姿勢変換が回転行列R
iと並進ベクトルt
iから構成されると定義すると、2フレーム間の対応する関係は次のように表される。
【数5】
【0049】
【0050】
最小二乗問題を構築することにより、SVD法を採用してR
i、t
iを計算する。
【数7】
【0051】
第i時刻から第i+1時刻までのレーザーレーダの姿勢変換行列は次の通りである。
【数8】
【0052】
T
Lはレーザーレーダのt
0時刻からt
n時刻までの姿勢変換行列であり、次のように表される。
【数9】
【0053】
前記姿勢変換行列T
Iの計算方法は、下記の通りである。慣性ナビゲーションシステムの加速度測定データ及び角速度測定データに対して積分を行い、変位データt
I及び回転データR
Iを取得する。t
0時刻からt
n時刻までの慣性ナビゲーションシステムの姿勢変換行列は、次のように表される。
【数10】
【0054】
前記t
n時刻でのレーザー点群P
nをt
0時刻でのL
0座標系に投影するとは、レーザーレーダの場合、
図8に示すように、直接に姿勢変換行列T
LによってP
nのL
0座標系における座標表示P
nLを取得することができる。
【数11】
【0055】
慣性ナビゲーションシステムの場合、
図9に示すように、姿勢変換行列T
I及び外部パラメータ行列T
LIによってP
nのL
0座標系における座標表示P
nIを取得することができる。
【数12】
【0056】
前記外部パラメータ行列T
LIの計算とは、点群P
nLと点群P
nIを整列することである。理論的に、P
nL及び点群P
nIは同一領域の点群データを記述しており、それらは空間上でオーバーラップする。即ち、次の通りである。
【数13】
【0057】
外部パラメータ誤差が存在するため、P
nL及びP
nIは完全にオーバーラップしているわけではない。反復最近傍法を採用して、P
nL及びP
nIが記載している同一領域の点群領域をレジストレーションし、最近傍誤差を構築して最適化する。
【数14】
【0058】
T
error、T
L,TIによって外部パラメータ行列T
LIを求解する。
【数15】
【0059】
ここまで、上記キャリブレーション方法によって外部パラメータ行列TLC及びTLIを取得する。
【0060】
本発明は、点群レジストレーションに基づくレーザーレーダ-慣性ナビゲーションキャリブレーションであって、既存技術(点群マッチングに基づくレーザーレーダ/IMU複合キャリブレーション方法)は小車にレーザーレーダ及びIMUを搭載する方法を採用しているが、小車は平面内でしか運動できないため、完全な六自由度の運動を提供することはできない。本方法では、キャリブレーションシステムの運動装置としてロボットアームを採用しているため、豊富な空間運動を提供できる。従来技術と比較して、キャリブレーションの精度が向上されている。
【0061】
さらに、必要に応じて、視覚条件が十分である場合、単眼カメラの観測データを記録し、視覚-IMUキャリブレーションツールを採用し、単眼カメラと慣性ナビゲーションシステムとの間の外部パラメータ行列TCIを計算する。決定された3つの外部パラメータ行列TLC、TLI、TCI間の姿勢一貫性に基づいて複合検証を行い、検証が失敗された場合、外部パラメータ行列中の変換パラメータを検証に成功するまで調整する。そのため、検証が失敗された場合、本発明の実施形態は、TLC、TLI、TCIに対してパラメータの最適化を行い、マルチセンサによる複合キャリブレーションの精度を向上する。前記パラメータ最適化は、オンライン調整方法を採用し、レーザーレーダ、単眼カメラ、慣性ナビゲーションシステムのデータを融合し、TLI、TCIに対して調整を行う。
【0062】
さらに、必要に応じて、視覚条件が十分である場合、キャリブレーションターゲットがカメラの視野範囲内に現れるように、ロボットアームを制御する。カメラが常にキャリブレーションターゲットを観測できる条件下で、ロボットアームを制御して空間内で六自由度の運動をする。単眼カメラの観測データを記録し、キャリブレーションツールを採用して視覚-慣性ナビゲーションシステムの外部パラメータ行列T
CIをキャリブレーションする。
【数16】
【0063】
さらに、レーザーレーダ、単眼カメラ、慣性測定ユニット間の姿勢変換行列に対して複合最適化を行う。決定された3つの外部パラメータ行列T
LC、T
LI、T
CI間の姿勢一貫性に基づいて複合検証を行う。原則的に、3つの外部パラメータ行列間には、次の数学的関係が存在する。
【数17】
【0064】
ただし、キャリブレーションの過程に誤差が存在するため、実際に姿勢一貫性を完全に達成することはできない。そのため、外部パラメータ行列中の変換パラメータに対して最適化を行い、マルチセンサによる複合キャリブレーションの精度を向上する必要がある。姿勢変換総誤差を最小化することにより、TLC、TLI、TCIを調整する。
【0065】
前記パラメータの最適化の具体的なステップは、次の通りである。
【0066】
【0067】
がすべて誤差閾値error
thrより小さい場合、T
LC、T
LI、及びT
CI間は既に姿勢一貫性を満たしていると見なされ、調整不要となる。
【0068】
その後、各姿勢変換行列誤差がすべて誤差閾値より小さいという制約を満たす条件下で、総誤差error
Tが最小になるように、各姿勢変換行列に対して調整を行う。
【数19】
【0069】
の大きさを判断し、3つの誤差の大きさから主な誤差由来を初歩的に特定し、誤差の正負から調整する方向を初歩的に決定する。
【0070】
並進ベクトル及び回転行列中の各ベクトル成分を分析し、並進ベクトルに対して次の調整を行う。
【数20】
【0071】
ここで、Δx、Δy、及びΔzの大きさ及び正負は、
の具体的なベクトル成分を分析することによって取得する。回転行列に対して、次のような調整を行う。
【数21】
【0072】
ここで、Δrの大きさと正負は、
の具体的なベクトル成分を分析することによって取得する。
【0073】
例を挙げて説明する。
【0074】
まず、主な誤差由来を特定する。誤差の大きさの順序が
である場合、T
LCが最大の誤差由来と見なされる。T
LCの誤差項目
及び
を分析する。
【0075】
しかし、誤差由來はT
LCだけではない。T
LI及びT
CIの場合、上記と同様なステップを採用して調整を行う。相違点は、T
LC、T
LI、及びT
CIに対して、それぞれα、β、及びγのステップサイズの調整(α>β>γ)を行うとともに、最大調整範囲を制限することである。
【数22】
【0076】
最適化過程中で、TLC、TLI、TCIを順番に調整し、errorTの変化を観察することにより、α、β、γのステップサイズを適切に変更する。調整過程中で、errorTが明らかに低下されることが観察されると、ステップサイズを適切に増やし、調整過程中で、errorTの緩やかな減少又は増加傾向が見られると、ステップサイズを適切に減らすか又はステップサイズの正負を変更する。
【0077】
errorTが最小になるまで、上記のステップに従って外部パラメータ行列を調整する。
【0078】
調整過程中で、計算結果が局所的な最適化になることを防ぐために、TLC、TLI、TCIの調整順番を変更するとともに、最小のerrorTが見つかるまで最適化結果を上記方法と比較する。
【0079】
既存技術と比較して、本発明のマルチセンサによる姿勢変換行列の複合最適化方法は、オフライン最適化方法を採用しており、TLC、TLI、及びTCI間の姿勢一貫性に基づいて姿勢変換行列総誤差の最適化関数を構築し、各外部パラメータに対してパラメータの調整を行う。この最適化方法は、各外部パラメータ行列の誤差を最小化し、精度を最大化する効果を達成する。
【0080】
本明細書では、いくつかの用語が多く使用されているが、他の用語を使用する可能性を排除することではない。これらの用語は、本発明の本質をより便利に記載及び説明するためにのみ使用される。それらをあらゆる追加の制限として解釈することは、本発明の精神に反することである。明細書及び図面に示される装置及び方法における動作、ステップ等の実行順序は、特に明記されていない限り、前の処理の出力が後の処理で使用されていない限り、任意の順序で実施することができる。説明の便宜上、「まず」、「次に」等を採用した説明は、必ずこの順序で実行すべきであることを意味するわけではない。
【0081】
本明細書に記載された特定の実施形態は、単に本発明の精神を例示するものである。当業者は、記載された特定の実施形態に対して様々な変更又は補足又は類似な方法への置き換えを行うことができるが、それは本発明の精神から逸脱したり、添付の特許請求の範囲によって定義された範囲を超えたりすることはない。
【符号の説明】
【0082】
101、センサ融合フレーム;102、ロボットアーム;103、連結機構;104、コンピュータユニット;105、操作プラットフォーム;201、レーザーレーダ;202、単眼カメラ;203、慣性ナビゲーションシステム;204、金属フレーム;205、固定装置;206、治具。