レーザー測距の占有グリッド・log odds

既知姿勢で取得したrange/bearing観測から2次元セルの占有確率を推定する。

地図は軸に平行な正方セルです。原点は左下、セル境界は左・下を含み、右・上を含みません。

既知の姿勢をそのまま使用します。誤差が0と推定されたことを意味せず、安全な通行領域を保証しません。

項目を入力・選択してから「計算する」を押してください。

必要な入力・選択は10項目です。

事前占有確率より小さく指定。ビームが通過したセルに適用します。

事前占有確率より大きく指定。反射ありの端点セルだけに適用します。

姿勢・レーザー測距行必須
行センサーX(m)センサーY(m)姿勢方位(°)相対角(°)測距(m)観測操作
1
2

6列を左端の欄へタブ区切りで貼り付けられます。1000行まで。

1行=1本のビーム。X/Yは地図と同じm、方位はX正方向から反時計回り、相対角は姿勢方位に加算。反射なしの末端を占有にしません。6列TSVを貼り付けできます。

空欄は0。結果表にx方向16セルを表示します。

空欄は0。結果表にy方向16セルを表示します。


計算結果

値を入力して計算してください。

お気に入り一覧

計算方法・適用範囲・出典

計算方法

セル (x,y) は左下を(0,0)とする行優先配列です。未観測セルは初期値p₀を保持します。各測距rayと通過セルの幾何交差を求め、通過セルにlogit(p_free)−logit(p₀)、反射ありの端点セルにlogit(p_hit)−logit(p₀)を各1回加算。反射なしは末端を占有更新せず、地図外の端点は占有更新しません。更新後のlog oddsは[-20,20]に制限し、p=1/(1+exp(−log odds))で確率へ戻します。分類は未観測を最優先し、観測済みのP≦0.35を空き、P≧0.65を占有、その間を未確定とします。姿勢方位+相対角の単位は°、座標・距離はmです。

全セルの占有確率と未観測区別、16×16の表示窓、空き・占有・未確定数、測距行ごとの通過/端点更新数と地図外判定。

計算例(架空の数値)

4×3セル、1m/セル、原点(0,0)、事前確率0.4、通過確率0.2、端点確率0.8。姿勢(0.5,0.5)、方位0°、相対角0°、距離2m、反射あり1本なら(0,0)と(1,0)は0.2、(2,0)は0.8、残り9セルは未観測で0.4です。

適用対象と限界

測距の反射有無・範囲と地図内の姿勢が既知で、地図座標系のXY値がメートルで揃った2D測距データ。未知姿勢の自己位置推定、SLAM、地図座標回転、3D・ビーム幅・透過物・反射強度、相関観測の補正、動的障害物、経路安全性やcollision-freeの認定はしない。

採用した方式

  • 単線rayによる2D占有グリッド更新(独立実装 v1.0(2026-11-15)):対象範囲 静的セル独立の二値占有モデル、単線・無幅ray、各行を順番に独立更新、位置姿勢の入力誤差は未評価/適用地域 地域非依存・地図座標単位m

方法と出典

方法:既知姿勢2D単線ray log odds v1.0(2026-11-15)。データ記録日:2026-11-15。