文章目录 1. 基于二次规划的速度规划存在的问题 2. 基于非线性规划的速度规划 2.1 非线性规划问题 2.2 前期准备 2.2.1 曲率曲线平滑 2.2.2 限速曲线平滑 2.2.3 参考曲线平滑 2.3 定义优化变量 2.4 设计目标函数 2.5 设计约束条件 2.5.1 优化变量约束 2.5.2 约束函数约束 1. 基于二次规划的速度规划存在的问题 二次规划的速度规划算法(PiecewiseJerkSpeedOptimizer)的存在两个问题: 曲率惩罚 p i p_{i} p