2
差動駆動ロボットの位置を計算する
インクリメンタルセンサーを備えた差動駆動ロボットの位置をどのように計算または更新しますか? 2つのディファレンシャルホイールのそれぞれには、1つのインクリメンタルセンサーが取り付けられています。両方のセンサーは、距離決定します。は、既知の時間間にホイールが回転しました。Δ R I G H TΔ LのEのFt△left\Delta leftΔのRのI Gh t△r私ght\Delta rightΔ トン△t\Delta t まず、両方の車輪の中心がロボットの位置をマークしていると仮定しましょう。この場合、次のように位置を計算できます。 x = xリットルのE ft+ xR I Gh t2y= yリットルのE ft+ yR I Gh t2バツ=バツleft+バツr私ght2y=yleft+yr私ght2 x = \frac{x_{left}+x_{right}}{2} \\ y = \frac{y_{left}+y_{right}}{2} 両方の車輪が直線で回転するという仮定の下でこれらの方程式を「導出」します(短い距離ではほぼ正しいはずです)。 ΔのXΔ トン= 12(ΔのリットルE FtΔ トン+ Δ R I Gh tΔ トン) cos(θ)Δ YΔ …