差動・omni輪のオドメトリと滑り残差

車輪転がり観測を車体速度へ変換し、SE(2)の経路と観測整合性を計算する。

車輪半径はm、時間は秒、方位角は°、車体角速度はrad/sで入力・表示します。速度・位置は理想転がりモデルに基づく推定値です。

入力すると自動で計算します。Enterで次の項目へ進めます。次の入力欄を選んで進めます。

選択内容に応じて、残りの入力項目を案内します。

計算する内容

モーター軸側の計測なら減速比・4逓倍を反映した実際の車輪1回転カウントを入力します。

左右輪の時系列読取必須
行時刻(秒)左輪(tick)右輪(tick)操作
1
2

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

1行=時刻と各車輪の累積tick。先頭行はエンコーダ基準です。時刻は厳密に昇順、差は10⁻⁶~10⁶秒。末尾の空行は無視します。最大1,000行。


計算結果

必要な値を入力すると自動で計算します。

お気に入り一覧

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

計算方法

差動:左・右の輪接線速度vL,vRからvx=(vL+vR)/2、vy=0(拘束)、ω=(vR−vL)/track。均等配置omni n=3/4:φᵢ=γ+2πi/n、v輪ᵢ=sinφᵢ·vx−cosφᵢ·vy−Rω。Jacobianの擬似逆により vx=2Σsinφᵢv輪ᵢ/n、vy=−2Σcosφᵢv輪ᵢ/n、ω=−Σv輪ᵢ/(nR)。各輪 v輪ᵢ=2πr·Δtickᵢ/(ticksPerRevolution·Δt)。区間の車体速度を一定とし、SE(2) expのA=sin(ωΔt)/(ωΔt)、B=(1−cos(ωΔt))/(ωΔt)で局所変位[Δx,Δy]=Δt[A vx−B vy, B vx+A vy]を求め、開始方位で世界座標へ回転。4輪残差は観測−Jacobian予測、||残差||/(2πr/ticksPerRevolution/Δt/√6)>3なら大きな不整合。整数tick読取の量子化誤差は時点ごと独立な±0.5 tick一様と仮定し、速度分散と線形化した最終姿勢共分散に反映。

区間別車体速度・世界座標軌跡、車輪速度残差、量子化由来の速度・姿勢共分散、観測不能と不整合区間。

計算例(架空の数値)

検算:半径0.1 m、1回転1000 tick、輪距離0.4 m、t=0の左右0からt=1で左右1000 tickなら、前方0.6283185307 m/s・角速度0。左−500/右+500 tickなら、変位0で方位角+90°。

適用対象と限界

平坦な路面で、車輪半径と幾何が一定の差動二輪または理想の均等配置3/4輪omni移動体。Mecanum・スキッドステア・ステアリング輪・不等間隔のomni、3D運動、ギヤ比の自動推定、タイヤ滑り補償、IMU/GNSS統合、実環境のナビゲーション精度保証は対象外。

方法と出典

方法:E1843-wheel-odometry-kinematics/1.0.0 (2026-11-15)。データ記録日:2026-11-15。