停车问题1 问题描述如下图所示,考虑一个 10m*7m 大小的停车场,将车从如下初始位置停到停车场中任意位置,如图停车位置 1—4 所示
-5-4-3-2-1012345-10123456初 始 位 置1停 车 位 置2停 车 位 置3停 车 位 置4停 车 位 置x(m)y(m)图 1 问题描述示意图2 数学模型车的模型示意图如下所示,则可以得到如下数学模型方程式: (1)图 2 车的模型示意图3 问题求解3
1 变分法求解最优控制定义如下性能指标函数: (2)通过构建 Hamiltonian 求解,并采用数值法求解两点边值问题
(1)停车位置 1:图 3 变分法求解结果(停车位置 1)(2)停车位置 3图 4 变分法求解结果(停车位置 3)3
2 动态规划法求解最优控制定义如下性能指标函数: (3)采用离散动态规划求解,分别将时间、状态量、控制量、状态方程和性能指标函数离散化
分别尝试不同的离散化程度
(1)第一次离散化求解:运行时间(1120s)离散化后的维度为:时间(150);状态(4*10*2*3*6);控制(6*6)图 5 动态规划求解结果(第一次离散化)(2)第二次离散化求解: 运行时间(70291s)离散化后的维度为:时间(30);状态(10*25*12*16*15);控制(15*15)图 6 动态规划求解结果(第二次离散化)3
3 直接打靶法求解最优控制定义如下性能指标函数: (4)采用 SQP 方法求解,结果如下:(1)停车位置 1图 7 直接打靶法求解结果(停车位置 1)(2)停车位置 3图 8 直接打靶法求解结果(停车位置 3)3
4 模型预测控制求解最优控制定义如下性能指标函数:(5)预测步长 ,控制步长
(1)停车位置 1图 9 模型预测控制求解结果(停车位置 1)(2)停车位置 3图 10 模型预测控制求解结果(停车位置 3)3
5 自适应动态