測距・追跡#141
近傍運用の相対追跡 — ランデブー・ドッキングをセンチメートルへ導く
編隊飛行が数十km〜数百kmでの相対航法だったのに対し、ISSへの補給機のドッキングでは最終的に数メートル以内でセンチメートル〜ミリメートルの精度が要求される。GNSS相対航法・レーダー/LiDAR・光学カメラという段階的センサー切り替えの設計思想、LiDAR点群から相対姿勢を推定するICPアルゴリズム、そして光速ではなく搭載計算機の処理時間が支配する最終接近フェーズの制御遅延要求を数式で追う。
前提知識: 編隊飛行の相対航法 — 探査機同士が直接測り合う世界
この回で学ぶこと
前回は、数十kmから数百万kmという長大な距離を隔てた探査機同士が、機体間測距(クロスリンクレンジング)によって相対位置をメートルからピコメートルのオーダーで維持し続ける、編隊飛行の世界を見ました。そこでは光行差時間そのものが制御ループの支配的な遅延要因になり得るほど、探査機同士は「遠い」存在でした。
この回で扱うのは、その対極にある近傍運用(Proximity Operations)、なかでもランデブー・ドッキングです。国際宇宙ステーション(ISS)への補給機の接近・結合を思い浮かべてください。数百kmの周回軌道上ですれ違う2機の宇宙機が、最終的には数メートル、そして数十センチメートルまで互いに近づき、ドッキング機構同士をセンチメートル、場合によってはミリメートルのオーダーで位置合わせして結合します。編隊飛行が「メートル単位の距離を保ったまま離れ続ける」制御だったとすれば、ランデブー・ドッキングは「メートル単位の距離を、確実にゼロへ近づけていく」制御です。要求される相対測位精度は、絶対距離こそ編隊飛行よりずっと小さいものの、相対距離に対する精度の比という意味では同じくらい、あるいはそれ以上に厳しいものになります。
この回では、この極めて近距離・高精度な相対追跡を実現するために、接近フェーズに応じてセンサーを段階的に切り替えていく設計思想を概観したうえで、中距離で使われる**LiDAR(Light Detection and Ranging)による測距の原理と、そのLiDARが取得した3次元点群からターゲット宇宙機の相対位置・相対姿勢を推定するICP(Iterative Closest Point)**アルゴリズムを数式で追います。最後に、最終接近フェーズにおいて制御ループのむだ時間がなぜ編隊飛行以上にシビアな要求を課すのか、その理由が光速ではなく別のところにあることを見ていきます。
直感的導入: なぜセンサーを何度も乗り換えるのか
ランデブー・ドッキングの接近プロファイルは、しばしば「望遠鏡から虫眼鏡、そして触診へ」というたとえで説明されます。数十km彼方にいるターゲットを最初に見つけるには、広い範囲を見渡せる手段が必要です。しかし数十m先まで近づいた段階では、もはや「点」ではなく「立体物」としてのターゲットの形状や姿勢そのものを、精密に把握しなければなりません。1つのセンサーだけで、数十kmの探知能力と数ミリメートルの精度を同時に満たすことは、原理的にほぼ不可能です。
理由は大きく2つあります。
理由1: 角度分解能に基づくセンサーは、距離に比例して絶対精度が悪化する。 レーダーやアンテナで方位角・仰角を測るタイプのセンサーは、角度の分解能 がほぼ一定であっても、それが生み出す横方向の位置誤差は距離 にほぼ比例して と拡大します。数十km先では数十cmの角度誤差でも許容できますが、数十m先で同じ角度誤差が残っていれば、位置誤差はセンチメートル未満まで縮まります。つまり距離が縮むほど、同じセンサーでも(角度計測が主体である限り)相対的な精度は自動的に上がっていく面もありますが、逆に「要求される絶対精度」の方がそれ以上のペースで厳しくなっていくため、結局はセンサーの乗り換えが必要になります。
理由2: 電波ベースの相対航法は、近距離では構造物によるマルチパスで信頼性を失う。 GNSS搭載航法の回で見たように、GNSS受信機は測位衛星からの信号を受信するだけで自機の位置を決定できます。ターゲット(ISSなど)にもGNSS受信機が載っていれば、両者の測位結果を差し引くことで、共通誤差(衛星時計・軌道暦・電離層遅延)をキャンセルした相対GNSS航法が可能になり、数km〜数十kmの中遠距離ではメートル級、条件が良ければサブメートル級の相対位置精度が得られます。ところが数十m以内まで近づくと、ターゲット周辺の太陽電池パドルや構造物にGNSS電波が反射してマルチパス誤差が急増し、さらにアンテナ同士の相対幾何がめまぐるしく変わるため、GNSS相対航法の精度と信頼性はむしろ悪化します。
この2つの理由から、近傍運用では次のような3段階のセンサー切り替えが設計の定石になっています。
| 接近フェーズ | 距離の目安 | 主なセンサー | 得られる情報 | 精度の目安 |
|---|---|---|---|---|
| 遠距離接近 | 数km〜数十km | 相対GNSS航法 | 相対位置(3自由度) | メートル〜サブメートル |
| 中距離接近 | 数百m〜数十m | レーダー・LiDAR | 相対位置・相対姿勢(6自由度) | センチメートル |
| 近接・最終接近 | 数十m以内 | 光学カメラ+ターゲットマーカー | 相対位置・相対姿勢(6自由度、高更新レート) | ミリメートル〜センチメートル |
遠距離ではそもそもターゲットが点状にしか見えず、相対「位置」しか求めようがありません。中距離に入るとLiDARの走査ビームがターゲットの構造(太陽電池パドル、モジュール外形など)を分解できるようになり、初めて相対「姿勢」まで含めた6自由度の情報が得られるようになります。そして近接距離では、ターゲット上にあらかじめ用意された専用のマーカー(再帰反射材や幾何学模様のターゲットプレート)を光学カメラで直接認識することで、LiDARよりも高い更新レートと安定性で最終アライメントを追い込みます。この段階的な設計思想を、以下で数式とともに追っていきます。
数式による定式化
相対GNSS航法(遠距離): 差分による共通誤差の除去
GNSS搭載航法の回で導出した擬似距離方程式を思い出しましょう。GNSS衛星 に対するチェイサー(追跡側)の擬似距離は、
であり、ターゲット側も同様に と書けます。ここで は衛星時計誤差・軌道暦誤差・電離層遅延などの誤差項です。チェイサーとターゲットの相対距離が、GNSS衛星までの距離(約2万kmの中軌道)に比べて十分小さい(数十km以下)なら、両者が見ている誤差要因はほぼ同一とみなせます()。したがって2つの擬似距離の差を取ると、
となり、衛星時計や軌道暦、電離層遅延といった共通誤差が1次のオーダーで消去されます。これはSBIや前回のDOWRで見た「差分・和分による共通誤差キャンセル」と同じ発想が、GNSS相対測位という別の文脈にも現れたものです。残る未知数は相対位置ベクトル と受信機間の相対クロックバイアスであり、GNSS搭載航法の回と同じ最小二乗の枠組みで解けます。この相対測位は、コード擬似距離だけを使えばメートル級、さらに搬送波位相の差分(相対搬送波位相測位)まで使えばサブメートル〜センチメートル級の精度に達しますが、いずれにせよ両機にGNSS受信機が搭載されており、かつ視界が開けていることが前提です。数十m以内の近接距離では、前節で述べたマルチパスの問題から、この前提が崩れ始めます。
LiDARによる測距の基本原理
中距離接近以降で主力となるLiDARは、再生測距の回で見た電波測距と原理的には同じ「往復伝搬時間から距離を求める」という考え方を、可視光・近赤外のレーザー光に置き換えたセンサーです。最も基本的な**パルス飛行時間法(pulsed Time-of-Flight, ToF)**では、レーザーパルスを送信してからターゲット表面で反射して戻ってくるまでの時間 を計測し、
によって距離 を得ます。電波測距との決定的な違いは、LiDARが指向性の極めて狭いビームを走査(スキャン)することで、ターゲット表面上の多数の点それぞれについて個別に距離を測れる点です。走査角 ごとに測距値 が得られるので、これを直交座標に変換すれば、
という形で、センサー基準系における3次元の点 が得られます。これを走査範囲全体について集めたものが点群(point cloud) であり、ターゲット宇宙機の外形を3次元的になぞった離散データになります。単一の測距点だけを見ていた電波測距やレーザー高度計とは異なり、LiDARは「距離」に加えて「形」そのものを測っていることに注意してください。
なお、測距精度は基本的に時間計測精度で決まり、 という関係が成り立つのは電波測距と同じです。連続波を用いて位相差から距離を求める位相差(AMCW: Amplitude-Modulated Continuous Wave)LiDARという方式もあり、変調周波数 に対する往復位相差 から
と距離を求めます。第2項は、逐次レンジングや非再生測距の回で見たトーン測距と同じ構造の距離アンビギュイティ(距離が変調波長 の整数倍だけずれても同じ位相差になってしまう不確定性)であり、複数の変調周波数を組み合わせるなどして解消されます。近傍運用では対象距離が既知の範囲(数百m以内)にあらかじめ絞り込めるため、このアンビギュイティは深宇宙測距ほど深刻な問題にはなりません。
点群からの相対姿勢推定: ICP (Iterative Closest Point)
LiDARが得るのは、あくまで「センサー基準系(チェイサー機体に固定された座標系)から見たターゲット表面上の点群」です。ここから知りたいのは、ターゲットの基準座標系(あらかじめ用意されたターゲットの3次元モデル、あるいは前回スキャン時の点群)に対して、チェイサーが今どのような相対位置・相対姿勢にあるか、という剛体変換です。この変換(回転行列 と並進ベクトル )を、2つの点群の対応関係から推定する代表的なアルゴリズムが**ICP(Iterative Closest Point)**です。
問題設定はこうです。今回のスキャンで得た点群を 、ターゲットの基準形状を表す点群(あるいはモデル)を とします。求めたいのは、
を満たす です。ここで は点 に対応するターゲット側の点のインデックスですが、これがそもそも未知である(どの走査点がターゲット上のどの点に対応するか、あらかじめ分かっていない)ことがこの問題の本質的な難しさです。ICPはこれを、対応付けと剛体変換の推定という2つのステップの反復によって解きます。
ステップ1(対応付け): 現在の推定変換 のもとで、各走査点 に最も近いターゲット側の点を最近傍点として選びます。
ステップ2(剛体変換の推定): ステップ1で決めた対応関係を固定したうえで、上の二乗誤差を最小にする を閉形式で求めます。まず両点群の重心
を計算し、重心を除いた偏差ベクトル 、 を使って、 の相互共分散行列
を作ります。この を特異値分解(SVD)すると となり、最適な回転行列は
で与えられます(この の項は、単純に を取ると鏡映(反転)を含む変換になってしまう場合があるための符号補正です)。並進ベクトルは、回転を当てた後の重心が一致する条件から、
と求まります。これは、GNSS搭載航法の回で見た最小二乗解が「並進とクロックバイアスだけ」を線形に解いていたのに対し、ここでは「回転」という非線形な自由度まで同時に含んだ剛体位置合わせ問題であることに対応しています(統計学・測地学の文脈ではこの部分問題はWahba問題あるいはKabsch algorithmとして知られています)。
ステップ3(反復): 求めた を新しい推定値 として、ステップ1に戻ります。対応付けが変換の推定値に依存し、変換の推定値が対応付けに依存するという鶏と卵の関係にあるため、両者を交互に更新しながら、点群間の平均二乗誤差が収束するまでこれを繰り返します。初期値 が真の変換にある程度近ければ、ICPは局所的な二乗誤差を単調に減少させながら収束することが保証されますが、初期値が悪いと誤った対応付けに収束してしまう(局所最適解に捕まる)リスクがあるため、実運用では前段のセンサー(相対GNSS航法や粗いレーダー航法)から得られる初期推定値でICPを立ち上げることが重要になります。これもまた、段階的にセンサーを切り替えていく設計思想が単なる精度向上のためだけでなく、後段アルゴリズムの初期値を与えるためにも必要とされている理由です。
最終接近フェーズの制御ループとむだ時間要求
前回、編隊維持の制御ループには測距信号の光行差時間 を含むむだ時間 があり、制御帯域幅 に対して という制約が課されることを見ました。ランデブー・ドッキングでも同じ構造の閉ループ
が最終接近フェーズの相対位置制御に使われますが、ここで の中身がまったく違うものになる点が重要です。相対距離がたかだか数十mであれば、光行差時間は
程度であり、制御ループの観点からは完全に無視できます。つまりランデブー・ドッキングでは、編隊飛行やDSN追跡を悩ませてきた「光速の壁」はもはや問題になりません。その代わりに支配的になるのが、LiDARの走査・点群取得に要する時間、ICPの反復計算に要する処理時間、そして推進系(スラスタ)の応答遅れという、搭載計算機とアクチュエータ側の遅延です。むだ時間の中身が、通信路の物理的な伝搬遅延から、オンボード処理のレイテンシへと主役を交代するのです。
この処理遅延がどれだけ許容されるかは、光行差時間のような絶対的な物理限界ではなく、要求される位置決め精度から逆算されます。相対並進速度(接近速度)を 、制御ループのむだ時間を とすると、むだ時間のあいだにターゲットとの相対位置は近似的に
だけ、制御が把握している値と実際の値の間でズレが生じます。このズレが、ドッキング機構が機械的に許容できる位置合わせ公差 (キャプチャーエンベロープ、典型的には数cm程度)に対して十分小さくなければなりません。
たとえば最終接近時の接近速度を 、位置合わせ公差を 程度とすると、要求されるむだ時間の目安は
となり、実際にはこれよりさらに1桁程度小さい、数十ミリ秒から高々百ミリ秒程度のセンサー更新・処理・制御指令の周期が要求されます。これは、前回LISAの腕長制御が「秒オーダーのむだ時間でも問題ない(自由飛行+地上後処理という設計に逃げられる)」としていたのとは対照的に、ランデブー・ドッキングではリアルタイム性そのものが逃げ場のない絶対要求になることを意味します。同様の議論は相対姿勢についても成り立ち、相対角速度を 、姿勢の位置合わせ公差を とすれば、 という同型の制約が得られます。ICPのような反復最適化アルゴリズムを、この厳しい時間予算の中で毎周期実行し切れるだけの搭載計算機の演算性能が要求されるのは、この制約の直接の帰結です。
実務での使われ方
- HTV(こうのとり、JAXA): ISSへの無人補給機で、遠距離接近では相対GPS航法(Relative GPS, RGPS)により数百mまで自律的に接近し、そこから先はレーザーによる測距センサー(Rendezvous Sensor)がISS「きぼう」モジュールに取り付けられた再帰反射材(コーナーキューブ)を照射・検出することで、相対位置・相対姿勢を高精度に決定する。最終的にISSロボットアーム(Canadarm2)の把持可能範囲まで自律接近し、ドッキングではなくキャプチャー(把持)されてから berthing(結合)される方式を採る。
- SpaceX Dragon: 遠距離では相対GPS航法を用い、中距離からはLiDARベースのセンサー(初代DragonEyeはフラッシュLiDAR、Crew Dragonではより高性能なLiDARに更新)によりISSの形状を走査して6自由度の相対航法情報を得る。最終接近ではISSの国際ドッキングアダプタ(IDA)に設置された光学ターゲットを機体搭載カメラで認識し、自律的にドッキングを行う。ISS/NASA・Boeing StarlinerなどではTrajectory Control Sensor (TCS)と呼ばれるレーザーセンサーが、ターゲット上の再帰反射材を追跡して同様の役割を果たす。これらは国際ドッキングシステム標準(International Docking System Standard, IDSS)で規定される相対航法アーキテクチャに準拠している。
- Progress / Soyuz (ロシア): Kurs(クルス)という電波方式の自動ランデブードッキングシステムを長年使用しており、複数のアンテナ間の電波の到達時間差・位相差から相対位置・姿勢を求める。近年はより新しいKurs-NAへの更新が進められている。光学・LiDAR方式が主流になった欧米機と異なり、電波ベースのシステムを最終接近まで一貫して使い続けている点が対照的である。
- 軌道上サービス(On-Orbit Servicing, OOS): 近年、燃料補給・修理・デブリ除去など、必ずしもドッキング機構を持たない「協調的でない(non-cooperative)」対象への近傍運用の重要性が高まっている。Northrop Grumman社のMission Extension Vehicle(MEV-1, MEV-2)は、静止軌道上の通信衛星(Intelsat)に対してLiDARベースのセンサー(LIRIS)を用いた相対航法により結合を実現した。この場合、ターゲット側に協調的なマーカーや再帰反射材が用意されていないことが多く、本文で説明したICPのような、ターゲットの生の形状(既存のCADモデルや事前スキャンデータ)そのものから相対姿勢を推定するアルゴリズムの重要性が一段と増す。Astroscale社のELSA-dミッションでは、逆に協調的なターゲット(磁気ドッキングプレート付き)に対する光学マーカーベースの近傍運用が実証されている。
演習問題
-
LiDARによるターゲットまでの測距において、ターゲットまでの距離を とするとき、パルス往復時間 を求めてください。また、測距精度 を達成するために必要な時間計測精度 を、本文の関係式 を用いて求めてください。
-
AMCW方式のLiDARで変調周波数 を用いる場合、本文の式にある距離アンビギュイティ(周期) を計算してください。この値を、近傍運用で想定される対象距離のレンジ(数百m以内)と比較し、単一の変調周波数だけで距離を一意に決定できるか論じてください。
-
ICPアルゴリズムのステップ1(対応付け)とステップ2(剛体変換の推定)が、互いに他方の結果に依存する「鶏と卵」の関係にあることを本文で確認しました。もし初期推定値 が真の相対姿勢から大きくずれていた場合、何が起こると考えられますか。また、前段のセンサー(相対GNSS航法など)から得られる粗い推定値をICPの初期値として与えることが重要である理由を、この観点から説明してください。
-
最終接近時の接近速度が 、ドッキング機構の位置合わせ公差が であるとき、本文の関係式 から要求されるむだ時間の目安を求めてください。さらに、この結果を前回のLISA編隊(片道光行差時間 秒でも「自由飛行+後段データ処理」で許容できた)と比較し、ランデブー・ドッキングにおいて制御ループの遅延要求がなぜ光速ではなく搭載計算機の処理性能によって決まるのかを、自分の言葉で説明してください。
まとめと次回予告
ランデブー・ドッキングでは、遠距離の相対GNSS航法から、中距離のLiDARによる点群取得とICPによる姿勢推定、そして近接距離の光学カメラによるターゲットマーカー認識へと、接近が進むにつれてセンサーを段階的に切り替えていく設計が取られます。これは、角度分解能ベースのセンサーが持つ距離依存の精度特性と、電波ベースの相対航法が近距離でマルチパスに弱くなるという2つの制約から導かれる、実務上の必然でした。LiDARが取得する3次元点群からは、ICPアルゴリズムによって相対位置だけでなく相対姿勢(6自由度)までも推定でき、これは編隊飛行で扱ってきた「点としての相対位置」の議論を大きく超えるものです。そして最終接近フェーズの制御ループでは、編隊飛行を支配していた光行差時間の壁がもはや無視できるほど小さくなる代わりに、センサー処理・アルゴリズム計算・アクチュエータ応答という搭載系のレイテンシが、ミリメートル級の精度要求のもとでシビアな制約として立ちはだかることを見ました。
次回は、ここまで扱ってきた宇宙機同士の相対航法から少し話題を変え、地上局と探査機を結ぶ電波が大気中を通過する際に生じる対流圏屈折補正に軽く触れます。電離層と同様、対流圏もまた電波の伝搬遅延・経路曲がりの原因となり、精密な測距・追跡には欠かせない補正の対象です。
参考文献
- W. Fehse, Automated Rendezvous and Docking of Spacecraft, Cambridge Aerospace Series, Cambridge University Press
- P. J. Besl, N. D. McKay, “A Method for Registration of 3-D Shapes,” IEEE Transactions on Pattern Analysis and Machine Intelligence, Vol. 14, No. 2 (1992)
- International Docking System Standard (IDSS), Interface Definition Document, NASA/International Partners
- JAXA, “H-II Transfer Vehicle (HTV) Rendezvous and Proximity Operations,” JAXA技術資料
- S. Ruel, T. Luu, A. Berube, “Space Shuttle Testing of the TriDAR 3D Rendezvous and Docking Sensor,” Journal of Field Robotics
- B. K. P. Horn, “Closed-form Solution of Absolute Orientation using Unit Quaternions,” Journal of the Optical Society of America A
- NASA, “Northrop Grumman Mission Extension Vehicle (MEV) On-Orbit Servicing Overview,” NASA/industry公開資料
- DSN Telecommunications Link Design Handbook, DSN No. 810-005(Proximity Operationsに関するモジュール)