自动驾驶 quintic 路径规划基本原理

To reduce the number of calculation of min of cost function, we use the method like dichotomy, divide the time into four equal parts.

Choose the min cost fun time point as winner, So we have these cases:

  1. winner=0(first)
    min located t_0 to t_1, in the next iteration find the min between t_0 to t_1, reset the t_min=t_0, t_max=t_1, and don’t have to calculate the cost fun at t_0 and t_1 again.
    winner=0(first)

  2. winner=4(last)
    min located t_3 to t_4, in the next iteration find the min between t_3 to t_4, reset the t_min=t_3, t_max=t_4, and don’t have to calculate the cost fun at t_3 and t_4 again.

  3. winner=else
    min located t_win-1 to t_ win+1, in the next iteration find the min between t_ win-1 to t_ win+1, reset the t_min=t_ win-1, t_max=t_ win+1, and don’t have to calculate the cost fun at t_ win-1 and t_ win+1 again.
    winner=else
    So in the next iteration, we do the same find where the min locates and reset the searching aera again.

To calculate the cost function of trajectory

cost function
overshoot
cost 5-1
cost 5-2
cost 5-3
cost 6
cost 1
cost 8
cost 2
cost 3
cost 7

  • 12
    点赞
  • 8
    收藏
    觉得还不错? 一键收藏
  • 1
    评论

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论 1
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值