底盤Y軸上兩輪中心的間距。
底盤X軸上兩輪中心的間距。
運動學因子 K = Lx + Ly (其中 Lx = DY/2, Ly = DX/2)。
根據底盤的目標速度(vtx, vty, ω)計算每個輪子的速度(vw1, vw2, vw3, vw4)。
vw1 (左前) = (0.50) - (0.00) - (0.215) · (0.00)
vw2 (右前) = (0.50) + (0.00) + (0.215) · (0.00)
vw3 (左後) = (0.50) + (0.00) - (0.215) · (0.00)
vw4 (右後) = (0.50) - (0.00) + (0.215) · (0.00)
左前輪 (vw1): 0.00 米/秒
右前輪 (vw2): 0.00 米/秒
左後輪 (vw3): 0.00 米/秒
右後輪 (vw4): 0.00 米/秒