移动机器人路径规划（六）--- 软约束、硬约束下的轨迹优化/生成SOFT AND HARD CONSTRAINED TRAJECTORY OPTIMIZATION