レーザー測距の占有グリッド・log odds
バグ・不具合を報告
既知姿勢で取得したrange/bearing観測から2次元セルの占有確率を推定する。
地図は軸に平行な正方セルです。原点は左下、セル境界は左・下を含み、右・上を含みません。
既知の姿勢をそのまま使用します。誤差が0と推定されたことを意味せず、安全な通行領域を保証しません。
項目を入力・選択してから「計算する」を押してください。
必要な入力・選択は10項目です。
計算結果
—セル
—セル
- 未観測セル
- —セル
- 観測済み・未確定セル
- —セル
- 通過セル更新
- —回
- 端点セル更新
- —回
- 測距末端が地図外
- —本
- 地図境界で切られたray
- —本
- 地図と交差しないray
- —本
値を入力して計算してください。
この計算機は使いやすかったですか?
回答はサイト改善のために保存します。入力値・計算結果は送りません。
ありがとうございます。よかったら、上の共有ボタンからこの計算機を紹介しませんか?
計算方法・適用範囲・出典
計算方法
セル (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。