Introduction
这篇文章主要就是建立了一个dynamic model (including track-soil interactions), 然后建立了一个controller。
然后在仿真器中测试了一下。The result is an accurate control of the lateral offset and forward velocity error along a path.
这篇文章使用的也会是skid steering, which involves complicated ground-track interactions. Traction forces are produced by the shear stress created by the track slippage relative to the ground.
The resultant of the two track forces creates both the driving force needed for forward motion and the turning torque needed for steering.
Dynamic Modeling
上图的这种情况是the vehicle is turning in the positive direction, from
X
X
X to
Y
Y
Y
F
i
,
R
i
,
F
o
,
R
o
F_{i}, R_{i}, F_{o}, R_{o}
Fi,Ri,Fo,Ro are the traction and resistance forces exerted to the vehicle through the “inner” and “outer” tracks.
C
.
G
.
C.G.
C.G. is the center of gravity.
C
C
C is the instantaneous center of rotation
f
y
f_{y}
fy is the lateral friction distribution, 在履带上某一点
f
y
f_{y}
fy的方向取决于该点的方向
M x ¨ = F i − R i + F o − R o M \ddot{x} = F_{i} - R_{i} + F_{o} - R_{o} Mx¨=Fi−Ri+Fo−Ro M y ¨ = 4 f y d s M \ddot{y} = 4f_{y}d_{s} My¨=4fyds I ψ ¨ = ( F o − R o ) b − ( F i − R i ) b − 2 f y ( l 2 − d s 2 ) I \ddot{\psi} = (F_{o} - R_{o})b - (F_{i} - R_{i})b - 2f_{y}(l^{2} - d_{s}^{2}) Iψ¨=(Fo−Ro)b−(Fi−Ri)b−2fy(l2−ds2)
Path Tracking Control
The friction force are large and if neglected in the controller, produce large tracking errors.
The overall control objective is to drive the vehicle from a starting point to any other point in a horizontal plane. This includes the “planning” and the “control” problem.
这篇文章专注解决control problem with the assumption that the desired path is given.
desired path是用离散点进行描述的,每个离散点还要让planner指定速度。
Reference
[6]和[10]要看一下。