Trajectory planning of tracked vehicles

The motions of planar tracked vehicles are governed by three force and moment equations. The force equation perpendicular to the tracks represents a dynamic nonholonomic constraint which is explicitly dependent on vehicle speed. It couples path planning with trajectory planning. The nominal track forces required to follow a specified data at desired speeds are determined. The problem is reduced to computing vehicle orientations along the path that are consistent with the nonholonomic constraint. The computation of vehicle orientations is formulated as a parameter optimization that minimizes the violation of the equality constraint. The method is demonstrated for planar motions along a circular path on plate and inclined planes