LRTKレフィクシア株式会社

SLAM計測でループ閉合に失敗する原因と直し方6選

SLAM計測では、計測者が歩いた経路を推定しながら周囲の形状を地図として構築します。その中でも成果品質を左右しやすい処理の一つが「ループ閉合」です。計測開始地点の近くへ戻ったときや、すでに通過した場所を再び観測したときに、SLAMが同じ場所であると認識できれば、移動中に少しずつ蓄積した位置や姿勢のずれを調整できる可能性があります。

一方、現場では「元の場所まで戻ったのに点群が重ならない」「往路と復路が二重に見える」「長い廊下の端で位置がずれる」「閉合したように見えたのに一部だけ変形する」といった問題が起こります。こうした現象は、単純に計測距離が長いことだけで発生するわけではありません。周囲の形状、移動方法、再観測した範囲、動く物体、計測経路、処理時の対応付けなど、複数の条件が関係します。

ループ閉合は、スタート地点へ戻れば自動的に成功する仕組みではありません。SLAM側が過去に観測した場所と現在の観測結果に十分な共通性があると判断し、その対応関係を整合的に利用できることが重要です。ただし、ループ閉合の検出方法や最適化の方法、利用するセンサーはSLAMシステムによって異なるため、同じ歩き方でも結果が変わる場合があります。そのため、現場でループ閉合を安定させたい場合は、機器やソフトウェアの仕様を確認しつつ、歩き方や折り返し方まで含めて計画する必要があります。

この記事では、「SLAM 計測」で現場の点群取得や設備調査、施工記録、既存構造物の3次元化を行う実務担当者に向けて、ループ閉合に失敗しやすい代表的な6つの原因と、その直し方を解説します。

SLAM計測におけるループ閉合とは何か

SLAMは、計測装置が周囲を観測しながら、自分がどこにいるかという位置や姿勢の推定と、周囲の地図作成を同時に進める考え方です。計測中は一つ前の時点から現在までの移動量を連続的に推定しますが、この推定にはわずかな誤差が含まれることがあります。短い移動では目立たなくても、長い距離を移動すると誤差が積み重なり、開始地点と終了地点の位置関係にずれが生じる場合があります。

そこで重要になるのがループ閉合です。以前通った場所を再び観測したときに、その場所を過去の観測地点と対応付けることで、経路全体の整合性を調整するための手掛かりを得ます。

たとえば建物の廊下を一周してスタート地点へ戻った場合を考えます。移動中の推定だけでは、実際には同じ場所へ戻っていても、内部的には開始地点と終了地点がわずかに離れていることがあります。そこで周囲の壁、柱、開口部、設備などの特徴が一致し、同じ場所へ戻ったと判断できれば、開始地点と終了地点の関係を利用して経路を調整できます。

ただし、ループ閉合が成立すれば必ず正確な点群になるわけではありません。誤った場所同士を同一地点として対応付ければ、不自然な変形につながる可能性もあります。また、閉合に成功しても、基準座標への位置合わせや絶対精度が自動的に保証されるわけではありません。

実務では「閉合したかどうか」だけではなく、「どこを根拠に閉合したか」「往路と復路の形状が自然に一致しているか」「閉合後に別の場所が変形していないか」という観点まで確認することが重要です。なお、ループ閉合候補の検出や最適化結果を利用者が確認できるかどうかは、使用するシステムによって異なります。

原因1 同じ形が続いて場所を識別しにくい

ループ閉合が失敗する代表的な原因の一つが、周囲に識別しやすい形状や特徴が少ないことです。

SLAM計測では、周囲の観測結果から位置や姿勢を推定します。そのため、長い平面の壁だけが続く場所、同じ柱が等間隔で並ぶ場所、棚が繰り返し配置されている倉庫、形状変化の少ないトンネルや通路などでは、現在位置を区別する手掛かりが弱くなる場合があります。

たとえば100m近い直線通路で、左右の壁がほぼ平行、床と天井も平坦、途中に目立った凹凸がない状況を考えます。進行方向に対する形状変化が少ないため、少し前の地点と現在地点の観測結果が似てしまいます。その状態で折り返しても、どこへ戻ったのかを明確に識別しにくくなることがあります。

同じ形が規則的に並んでいる場所では別の問題もあります。本来とは異なる柱や区画を同じ位置の特徴として扱ってしまう可能性があるためです。見た目には情報量が多くても、同じパターンが繰り返されているだけでは、場所を特定するための特徴として十分でないケースがあります。

直し方として考えられるのは、識別しやすい特徴のある場所を計測経路へ積極的に組み込むことです。直線だけを往復するのではなく、柱の角、壁の凹凸、開口部、設備周辺、交差通路など、三次元形状に変化がある場所を経由します。

特に折り返し地点を何もない壁面の途中に設定するより、複数方向の面が観測できる場所に設定した方が、再認識に使える情報を増やせる場合があります。壁の角では互いに異なる方向を向く面を観測できますし、柱では複数面を回り込んで観測できます。

また、同じ場所を再観測するときは、完全に同じ一本の線だけをなぞるより、周辺の特徴が十分観測できる範囲を持たせることが重要です。ただスタート地点の一点へ戻るのではなく、その周辺をある程度再観測して「過去のデータと現在のデータが共通して見えている区間」を確保します。

SLAM計測では、現場が広いほど長距離を一気に歩きたくなります。しかし特徴の乏しい環境では、距離を伸ばすことよりも、どこで位置関係を再確認できる経路にするかを優先した方が安定した成果につながる場合があります。

原因2 閉合地点で共通して見える範囲が少ない

「スタート地点へ戻ったから閉合できるはず」と考えてしまうことも、失敗を招く原因になります。

ループ閉合で重要なのは、物理的に同じ場所へ戻ることだけではありません。過去に観測した周囲の形状や特徴と、再訪時に観測した結果との間に、対応付けに使える共通部分が必要です。

たとえば計測開始時には入口から室内方向を観測し、その後建物を一周して入口へ戻ったとします。ところが戻ったときには機器を出口方向へ向けたまま短時間で計測を終了すると、位置は同じでも観測している範囲が開始時と大きく異なる可能性があります。

この場合、「人間から見ると同じ場所」でも、「SLAMが利用できる観測情報としては共通部分が少ない」という状態になります。

直し方は、閉合地点を点ではなく区間として考えることです。

たとえば開始地点から20m程度進んだ区間に柱や開口部など特徴的な形状があるなら、計測終了時にもその区間へ戻り、同じ周辺形状を十分に観測する方法が考えられます。20mという距離自体が基準になるわけではありません。重要なのは、使用するシステムの観測範囲や現場条件に応じて、開始時と終了時に共通して観測できる特徴を確保することです。

閉合区間では機器の向きにも注意します。往路で正面だけを見ながら進み、復路では反対方向だけを見ていると、システムによっては共通する観測情報が少なくなる場合があります。機器を無理に大きく振るのではなく、歩行しながら壁面、柱、床、天井、設備など複数方向の固定構造を継続して取得できる姿勢を意識します。

また、閉合直前に急いで計測を終えないことも重要です。「開始地点へ戻った」というだけで停止せず、開始地点周辺を再観測し、必要であれば短い周回を追加します。

大規模施設では、最後にスタート地点へ戻ることだけをループとして考える必要もありません。システムが途中の再訪をループ閉合として利用できる場合は、建物内の複数地点で小さなループを作りながら進む方法があります。途中で過去の経路へ再接続できれば、長い計測全体を最後の一回の閉合だけに依存させずに済みます。

実務では「どこへ戻るか」だけでなく「どの範囲を再び観測するか」という視点で経路を設計すると、ループ閉合を安定させやすくなります。

原因3 長い直線移動で誤差が蓄積している

SLAM計測では、同じ場所へ戻るまでの経路が長くなるほど、途中の位置推定に小さな誤差が積み重なる可能性があります。特に注意したいのが、幾何学的な変化の少ない長い直線区間です。

工場の通路、大型倉庫、地下通路、共同溝、駅施設などでは、数十mからさらに長い直線を連続して移動する場合があります。こうした場所では進行方向に対する形状変化が少なく、移動量や姿勢を拘束する手掛かりが弱くなることがあります。

その結果、計測開始直後は整って見えていても、遠方へ進むにつれて位置や方向のずれが蓄積し、復路が別の線として生成される場合があります。点群を見ると、同じ壁が二重になったり、本来平行な通路が少しずつ開いたり、開始地点と終了地点がずれて見えたりします。

長距離直線への対策では、終点まで進んでから一度だけ戻る経路を避け、途中で再観測地点を設ける方法が考えられます。

たとえば長い通路を計測する場合、途中にある交差通路や設備区画を利用して小さな周回を作ります。一定区間進んだところで以前通った位置へ戻り、再び前進することで、短い区間ごとに過去の観測との関係を作れる場合があります。

通路に側室がある場合は、単純に直進するだけでなく、側室入口付近を少し回り込んで壁面や角を取得する方法も考えられます。直線上にはない三次元的な特徴を観測できるためです。

さらに、往路と復路を完全に同じ直線上で移動する必要はありません。安全な範囲で通路の反対側を通ったり、柱列の左右を使い分けたりすると、異なる角度から共通構造物を観測できます。

ただし、経路を複雑にすれば必ず精度が高まるという意味ではありません。急な方向転換を繰り返したり、狭い場所で機器を激しく振ったりすると別の問題を招く可能性があります。重要なのは、特徴の少ない直線移動を延々と続けず、安定して再観測できる地点を計画的に配置することです。

長い直線でずれが発生する現場では、「最後に閉合すれば全部直る」と考えない方が安全です。途中で誤差が大きくなると、終点で戻ってきても過去の位置との対応付けが難しくなる可能性があります。長距離計測ほど、システムが利用できる形で途中の再観測機会を増やす発想が重要になります。

原因4 人や車両など動く対象を多く観測している

SLAM計測では、周囲の環境が計測中に変化すると、過去の観測結果と現在の観測結果を対応させにくくなる場合があります。

代表例が、人、フォークリフト、台車、車両、開閉する扉、移動式の資材、カーテン、シートなどです。

たとえば倉庫内で開始地点付近に大量の荷物が置かれていたものの、計測中に荷物が移動したとします。終了時に同じ場所へ戻っても、開始時と終了時では周囲の形状が異なっています。

人の往来が多い環境では、観測される対象の一部が常に動いています。すべての動的物体が直ちにSLAMを破綻させるわけではありませんが、固定された構造物より動く対象が目立つ状況では、安定した位置推定や場所認識に利用できる情報が減る可能性があります。

直し方は、まず固定物を多く観測できるタイミングと経路を選ぶことです。

工場であれば設備停止中や作業者の移動が少ない時間帯、物流施設であれば車両の往来を避けやすい時間帯など、現場運用に合わせて計測条件を整えます。計測のために無理な作業停止を行うのではなく、安全管理や現場工程を優先し、その中で変化の少ない時間帯を選ぶことが現実的です。

閉合地点についても同様です。一時的に置かれる資材の周辺より、建物躯体、固定設備、柱、壁、階段など、計測中に位置が変わりにくい対象が多い場所を選びます。

大きなシャッターや扉がある場所では、開始時と終了時で開閉状態が変わる可能性があります。閉合の手掛かりとして利用したい場所なら、周辺の固定された柱や壁も十分観測しておくことが重要です。

屋外でも同じ考え方が使えます。駐車車両だけを主な特徴として扱うのではなく、建物外壁、縁石、構造物、擁壁など、位置が変わりにくい対象を広く取得します。

ループ閉合を安定させたい場合、閉合地点は単に歩きやすい場所ではなく、「時間が経っても形状が変わりにくい場所」を選ぶことが重要です。

原因5 移動速度や機器の向きが急激に変わっている

SLAM計測では、どこを歩くかだけでなく、どのように歩くかも重要です。

急な加速や停止、素早い旋回、大きな上下動、機器を急に振る動作などが繰り返されると、連続する観測間の変化が大きくなります。その結果、使用するセンサーやアルゴリズムによっては、位置や姿勢を連続的に追跡することが難しくなる場合があります。

特に注意したいのが折り返し地点です。

長い通路の終端まで歩き、その場で180度素早く方向転換すると、旋回中に観測範囲が急激に変化します。さらに方向転換直後に速い速度で戻り始めれば、折り返し周辺で十分な観測情報を取得できない可能性があります。

ループ閉合地点でも、到着直後に急停止して計測を終える方法は避けた方がよい場合があります。

直し方は、計測中の動きをできるだけ滑らかにし、使用機器が想定する速度や姿勢変化の範囲で操作することです。狭い場所や特徴の少ない場所、方向転換地点では、安全を確保しながら慎重に移動します。

方向転換するときは、その場で機器だけを急回転させるより、歩行可能な空間がある場合は少し弧を描くように旋回すると、周囲の形状を連続して観測しやすくなることがあります。

階段でも同様です。足元だけに意識が集中し、機器が大きく上下すると、観測状態が変化しやすくなります。安全を最優先にしながら、手すり、壁、踊り場、天井など周囲の固定構造物を継続的に観測できる姿勢を保つことが大切です。

また、「たくさん周囲を見せた方がよい」と考えて、機器を左右へ頻繁に振る必要はありません。SLAMでは連続する観測を安定して対応付けられることも重要です。機器の推奨方法に従い、不要な急操作を避ける方が扱いやすい場合があります。

再計測で改善する場合も、単に速度を遅くするだけでは不十分です。どこで追跡が不安定になったのかを点群や軌跡から推測し、その区間では急旋回、障害物回避、階段移動、狭い通路への進入などがなかったか確認します。

移動方法を標準化しておけば、複数の担当者がSLAM計測を行う場合にも成果のばらつきを抑えやすくなります。

原因6 閉合を意識しない経路で一筆書きしている

SLAM計測のループ閉合を安定させるうえで、重要な対策の一つが計測経路の見直しです。

現場では、効率を優先するあまり、入口から奥まで一筆書きで計測し、最後に入口へ戻る経路を選びがちです。しかし、一つの巨大なループだけに依存すると、途中で位置ずれが蓄積した場合の影響が大きくなることがあります。

たとえば大型倉庫で、外周を一周して最後に開始地点へ戻る計画を立てたとします。外周が長く、似た形状が続き、途中に十分な再観測地点がなければ、閉合の成否が最後の再訪区間に大きく依存する可能性があります。

このような現場では、システムが途中の再訪を利用できる場合、経路を複数の小さなループに分割する考え方が有効です。

入口から中央通路へ進み、一度入口付近へ戻る。その後別の区画へ進み、中央通路へ戻る。さらに次の区画を計測し、再び既知の経路へ合流するというように、計測経路同士が複数箇所で交差する形にします。

平面上で数字の8のような経路を作る方法も考えられます。中央の交差区間を繰り返し通過するため、左右それぞれのループで共通する観測区間を確保できます。

複数階の建物では、階ごとに再観測区間を設けたうえで、階段やスロープなど階を結ぶ区間を計測する考え方もあります。すべてを一続きの巨大な経路として扱うより、どの区間でずれが生じたかを確認しやすくなる場合があります。

ただし、ループを増やせば無条件に良くなるわけではありません。狭い範囲を何度も往復して点群密度だけが極端に高くなったり、作業時間が過度に増えたりすれば、後処理やデータ容量に影響することがあります。

そこで、現場図面や既存平面図を確認しながら、特徴の多い交差地点を再通過する経路を事前に決めることが重要です。

現場到着後すぐに計測を開始するのではなく、まず短時間で周囲を確認します。長い直線がどこにあるか、同じ形の区画がどこに続いているか、動く物体が多い場所はどこか、再訪しやすい交差部はどこかを把握してから計測を始めます。

ループ閉合は後処理だけで直すものではありません。計測前の経路設計の段階から再観測の機会を作ることで、後処理に頼りすぎない成果を作りやすくなります。

ループ閉合失敗を現場で見抜く確認方法

ループ閉合の問題は、計測終了後に初めて確認するより、使用するシステムで現場確認が可能であれば、早めに兆候を把握した方が再計測の負担を減らせます。

最初に確認したいのが、同じ構造物の二重化です。

往路と復路で同じ壁を計測したにもかかわらず、点群上では2枚の壁として平行に表示されている場合、位置推定にずれが生じている可能性があります。柱の輪郭が二重になっていたり、床の高さが往路と復路で分離していたりする場合も注意が必要です。

次に確認したいのが、経路の開始地点と終了地点です。実際には同じ場所へ戻ったのに、軌跡上で開始位置と終了位置が離れて見える場合、閉合が十分に機能していない可能性があります。

ただし、開始地点と終了地点だけが一致しているからといって安心はできません。全体調整によって両端が近づいていても、中間部に不自然な変形が残る可能性はあります。

そのため、途中で再通過した柱、壁、設備、開口部なども確認します。複数の場所で往路と復路の形状が自然に重なっているかを見ることで、経路全体の整合性を判断しやすくなります。

床面にも情報があります。本来ほぼ連続する床で段差が発生している場合や、同じ通路を往復した部分だけ高さが異なる場合には、位置や姿勢の推定に問題が生じている可能性があります。

長い通路では、平面図上のずれだけでなく方向の変化も確認します。実際には直線である壁が徐々に曲がって見える、平行な壁の間隔が少しずつ変わるといった現象は、累積した位置・姿勢誤差を疑う手掛かりになります。

重要なのは、一つの見た目だけで精度を断定しないことです。SLAM点群がきれいに重なって見えていても、必要とする管理精度を満たしているかどうかは別途確認する必要があります。

寸法管理や施工管理など精度要求がある用途では、既知寸法、基準点、検証点など、SLAMとは独立した情報を利用して成果を確認することが重要です。ループ閉合は内部整合性を改善するための重要な処理ですが、それだけで測量成果としての絶対的な正しさを保証するものではありません。

再計測する前に確認したいデータ処理上のポイント

ループ閉合に失敗したように見えても、すぐに現場へ戻ってすべてを再計測する必要があるとは限りません。まず取得済みデータと、使用するシステムで確認可能な処理条件を確認します。

最初に見るべきなのは、どの区間からずれが大きくなっているかです。

計測開始直後から点群が不安定なら、開始地点の環境や初期移動に問題があった可能性があります。一方、長い直線を通過した後から二重化しているなら、その直線区間が原因候補になります。特定の折り返し地点からずれているなら、急旋回や特徴不足を疑えます。

このように問題区間を切り分けることで、次回の計測経路を具体的に改善できます。

過去の観測地点と再観測地点の間に、本当に十分な共通範囲があるかも確認します。閉合位置の近くまで戻っていても、実際の点群を見ると異なる面ばかり取得していることがあります。

データ処理でループ候補や軌跡を確認できる場合は、どの地点同士が対応付けられているかを見ることも有効です。同じ形が繰り返される施設では、本来とは異なる区画同士が似た場所として扱われていないか注意します。

特に規則的な柱列や棚列が続く現場では、見た目が整っていても誤った対応付けによって全体が変形する可能性があります。そのため、「閉合が成立した」という表示だけを判断基準にせず、実際の構造物との整合性を確認する必要があります。

部分的な再処理で改善できる場合もありますが、取得時に必要な形状情報や視覚情報そのものが不足している場合、処理だけで完全に補うことは困難です。

たとえば特徴のない長い通路を一方向からしか取得しておらず、復路との共通観測もほとんどない場合は、新しい観測情報を追加するための再計測を検討した方がよい場合があります。

再計測するなら、同じ経路をそのまま繰り返すのではなく、原因に合わせて変更します。特徴不足なら柱や角を多く含む経路へ変更し、直線が長すぎるなら途中の再訪区間を追加し、閉合範囲が狭いなら再観測区間を広げます。

人や車両が多かったなら時間帯を変更し、急旋回が多かったなら折り返し方を見直します。

原因を特定せず「もう一度ゆっくり歩く」だけでは、同じ失敗を繰り返す可能性があります。計測データそのものを次回計画の診断材料として使うことが大切です。

SLAM計測のループ閉合を安定させるまとめ

SLAM計測でループ閉合に失敗する原因は、一つではありません。同じ形が繰り返される環境、閉合地点の共通観測不足、長い直線による誤差蓄積、動く対象の多さ、急激な移動や旋回、閉合を考慮していない計測経路などが複合的に影響します。

重要なのは、「開始地点へ戻れば閉合する」という考え方から離れることです。

ループ閉合で必要なのは、SLAMが過去に観測した場所と現在位置との関係を認識できることです。そのためには、使用するセンサーやアルゴリズムに応じて、特徴のある固定構造物を観測し、以前通った区間との共通情報を確保する必要があります。

特に広い工場や倉庫、長い通路では、最後に一度だけスタート地点へ戻る経路より、システムが利用できる形で途中に再訪区間を設ける計画が有効な場合があります。小さなループを組み合わせれば、一つの長大な閉合だけに依存する状態を避けやすくなります。

計測中の動きも重要です。急な旋回や大きな姿勢変化を避け、周囲の固定構造物を連続して観測しながら進みます。折り返し地点や閉合地点では、到着してすぐ終了するのではなく、過去と共通する周辺形状を十分に取得します。

計測後は、閉合したという処理結果だけを見るのではなく、壁や柱の二重化、床面の段差、直線形状の曲がり、開始地点と終了地点の関係、途中の再通過地点の重なりなどを確認します。必要な精度が決められている業務では、既知点や検証点など独立した基準による確認も欠かせません。

SLAM計測の品質は、センサー性能だけで決まるものではありません。環境を読み、経路を設計し、適切な位置で再観測し、取得後に成果を検証する一連の運用によって安定性を高めていくことが重要です。

現場で3次元計測をより手軽に運用し、屋外で取得した位置情報と点群を現場業務へつなげたい場合は、LRTK Phoneによる座標付き点群取得も選択肢です。LRTK Phoneはcm精度測位と3D点群スキャンに対応しますが、本記事で説明した一般的なSLAMのループ閉合と、製品の点群生成方式が同一であると決めつけるべきではありません。用途ごとの計測方式と精度条件を確認したうえで、現場条件に合う計測経路と検証方法を組み合わせることが、使える3次元データを作る第一歩です。

現場を3Dで残して、あとから測る。
実際の画面と動画で使い方を確認できます。

LRTK Phoneの使い方・実例を見る
資料請求導入相談
現場をスマホで3DスキャンLRTK Phone実例を見る

技術記事一覧へ戻る →