state lattice + OBVP 算法回顾

目标 给点起点和终点 先求出在起点做一次state lattice planning 的轨迹 再求在轨迹基础上从轨迹终点到给定终点的OBVP问题

1. state lattice

将控制量a离散化 离散成discretize_step份
分别再xyz上进行积分求得p v,得到轨迹

2. OBVP

将第一段的轨迹终点作为OBVP的起点 给定终点作为OBVP终点 进行最优边界值问题求解
起点 p v
终点p
OBVP求解过程

  • 建模:系统建模 问题建模(优化目标函数) 状态表示 输入表示
  • 求解:定义哈密尔顿方程 用庞特里亚金极小值原理求解最小代价函数
    • 求解细节问题
    • 求 alpha1 alpha2 alpha3 beta1 beta2 beta3
      在这里插入图片描述
  • 建立矩阵方程 param = H × deltaPv;
  • J 已经推导出 直接将参数带入 J
  • 求得最优T的解
  • 回到算法中 将T带入参数中所有alpha beta J都可求得
  • 2
    点赞
  • 9
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值