5.3.1 非完整路径规划的数学描述