智能车辆在连续弯道场景下的最优轨迹规划方法及系统
摘要:
本发明公开了一种智能车辆在连续弯道场景下的最优轨迹规划方法及系统,其包括:步骤1,通过传感器获取自车所在道路的道路边界点以及该道路的中心线点的坐标,沿自车纵轴的前、后方向分别设置半径为R的前包络圆和后包络圆,通过前包络圆和后包络圆表征自车,同时将道路边界点均沿垂直于其对应中心线的方向内缩距离R;步骤2,将道路边界点拟合出总数为N条具有相互重叠部分并由多项式和描述的道路边界;步骤3,使用自行车运动学模型作为自车的车辆模型,同时将和作为道路边界约束,结合车辆约束,建立第一最优控制问题,并将最优控制问题转化为非线性规划问题,求出全局最优轨迹。
0/0