动力学约束下的路径规划

一 简介

Kinodynamic:Kinematic+Dynamic
满足动力学和运动学约束的运动规划.
三种车模型:
Simple car model
Reeds & Shepp’s car
Dubin’s car
在这里插入图片描述

二 状态栅格搜索算法(State Lattice Search)

构建可行的运动连接:

  • 前向的积分:离散控制空间(A*)
  • 后向的计算:离散状态空间(PRM)
    在这里插入图片描述
    控制空间采样的例子
    在这里插入图片描述
    通过状态空间模型表示状态:s’=As+Bu
    通过状态转移方程得到路径.
    在这里插入图片描述
    在这里插入图片描述
    通过离散控制,给控制量,构建graph
    Note:可以引入启发函数,在搜索过程中构建必要的图,其他地方可以不构建.

状态空间采样
通过反向计算两点的连接方式 构建graph

三 两点边界值最优控制问题(OBVP)

在这里插入图片描述
将条件带进去,得到一个通解.得到解容易,得到最优解较难.

OBVP
在这里插入图片描述
在这里插入图片描述
实际例子
在这里插入图片描述
启发函数
在这里插入图片描述
Frent frame下的最动态约束规划问题
在这里插入图片描述
先参数化:5次多项式
解最优控制问题
在这里插入图片描述

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值