基于碰撞复合圆的拖挂车交叉碰撞检测与避撞规划方法

本发明属于道路车辆控制领域，涉及一种基于碰撞复合圆的拖挂车交叉碰撞检测与避撞规划方法，该方法包括以下步骤：（1）获取当前时间窗下拖挂车的状态量及周围环境参数；（2）识别动态障碍物，对于达到障碍体阈值的动态障碍物将其作为动态障碍车辆，基于动态障碍车辆与拖挂车各个单元的基础数据，对拖挂车各个单元逐一构造时变碰撞复合单元，计算精确的碰撞时间范围，计算拖挂车的距离转向时间TTS、距离制动时间TTB；（3）局部路径规划模块基于最优控制模型进行局部避撞路径规划，减小向后放大效应，并基于修正偏离中心道路指数优化路径，减小偏离航道效应。该方法解决了现有拖挂车碰撞检测模型难实时、多近似、高计算、高成本等缺陷。