基于回旋曲线的垂直泊车轨迹规划与跟踪控制

为了提高复杂狭窄环境下的垂直泊车便捷性和安全性,提出一种基于回旋曲线的垂直泊车轨迹规划与跟踪控制方法.首先,将垂直泊车轨迹规划问题解耦成路径规划问题和速度规划问题,并基于回旋曲线规划曲率连续的垂直泊车路径,以及基于五次多项式曲线规划垂直泊车速度.随后,将垂直泊车轨迹跟踪控制问题解耦成垂直泊车路径跟踪控制问题和垂直泊车速度跟踪控制问题,并基于Euclid Math OneLA@_2增益控制理论和预估模型设计非时间参考泊车路径跟踪Euclid Math OneLA@_2增益控制律,以及基于PID控制设计垂直泊车速度跟踪控制律.最后,结合硬件在环试验平台对所提出方法的可行性和有效性进行验证.结果表明:所提出的垂直泊车轨迹规划方法得到的泊车路径曲率是连续的,且所提出的垂直泊车轨迹跟踪控制方法在泊车位宽度与车辆宽度之差大于0.655 m时可以安全、精确地引导车辆停放在泊车位.     

线控四轮转向汽车平行泊车路径规划与跟踪控制

针对线控四轮转向汽车平行泊车路径规划与跟踪控制问题,提出一种基于改进粒子群优化算法的平行泊车路径规划方法和一种基于前馈控制和反馈控制的平行泊车路径跟踪控制策略.首先,综合考虑线控四轮转向汽车运动学非完整约束、动力和转向子系统的过程约束和边界约束、避障约束、泊车初始位姿和目标位姿约束,建立以最小化泊车过程总时长为目标的平行泊车路径规划约束最优化问题,并采用可以处理等式约束和不等式约束的粒子群优化算法对其进行求解,得到最优平行泊车路径.随后,利用平行泊车路径规划过程得到的车轮转向角作为前馈控制量,并利用汽车实际位姿与期望位姿的偏差构建PI反馈控制量,实现对规划的平行泊车路径快速、精确和稳定的跟踪控制.最后,利用车辆动力学仿真软件构建模型在环仿真系统,验证所提出方法的可行性和有效性.结果表明:所提出的方法可以快速、精确和稳定地引导线控四轮转向汽车自动完成平行泊车任务.     

基于改进快速行进树的自主代客泊车路径规划

为了加速自主代客泊车系统落地，基于改进快速行进树算法提出了一种自主代客泊车路径规划方法.首先，采用类广度优先搜索策略建立环境地图的“路径场”，并提出一种高计算效率的避障检测策略，基于环境地图“路径场”提出一种符合汽车非完整约束的远端参考点和近端参考点选取原则与路径节点更新原则，通过使路径节点逐渐靠近目标节点来完成自主代客泊车引导路径规划任务. 其次，基于Dubins曲线规划满足初始泊车方位角任意性要求和泊车位方位角的非唯一性要求的泊车路径，引导汽车安全驶入泊车位.最后，仿真验证所提方法的可行性.结果表明：相对于传统的快速行进算法，所提方法规划的自主代客泊车路径满足汽车非完整约束要求，可以安全引导汽车完成自主代客泊车任务.     

全自动平行泊车路径规划方法研究

为解决车辆泊车过程中发生碰撞预警,导致车辆无路径可跟踪的问题,为提高泊车成功率,提出一种全自动泊车路径规划方法,包括一次路径规划和二次路径规划。在对不同泊车状态进行约束分析的基础上,以路径曲率最小为优化目标,建立路径优化函数。利用Matlab非线性约束优化函数求得一次、二次路径轨迹函数参数。车辆在一次泊车发生碰撞预警的情况下进入二次路径规划模块。仿真结果表明:一次路径规划方法能满足车辆轨迹连续且无碰撞泊入车位;如若出现预警碰撞,二次路径规划方法能保证连续、安全泊入车位,为安全泊车提供了二次保障。     

智能车辆自动泊车路径跟踪的非光滑控制策略

针对车辆的非线性非完整约束特性导致的自动泊车路径跟踪实时控制精度不高,致使库内调整次数增加或车辆最终停放位姿不理想等问题,提出一种基于非光滑控制的自动泊车路径跟踪控制策略.通过对车辆动力学跟踪误差模型的降阶转换,推导了2阶、3阶子系统的级联系统有限时间跟踪控制方程.基于此降阶控制方程,以车辆动力学模型中的方向盘转角和车速作为输入,设计具有全局渐近稳定特性的路径跟踪控制器,并进行了仿真分析.结果表明:与传统方法相比基于非光滑控制的路径跟踪控制方法达到了有限时间内全局精确跟踪参考泊车路径的目的,具有强抗扰动性和快速收敛性.     

基于批处理先验知识树的自主代客泊车路径规划

针对室内结构化场景的自主代客泊车路径规划问题,基于批处理先验知识树(BIT*)算法和滚动优化思想提出一种自主代客泊车路径规划方法.首先,基于BIT*算法规划全局自主代客泊车路径,并采用数组实现影响BIT*算法搜索效率的树节点优先队列和树边优先队列,提高全局自主代客泊车路径规划效率.然后,基于滚动优化思想和圆弧-直线组合方法规划满足汽车运动学约束和避障约束的局部自主代客泊车路径,基于滚动优化思想规划的局部自主代客泊车路径可以将汽车引导到泊车位附近,而基于圆弧-直线组合方法规划的局部自主代客泊车路径可以使汽车安全驶入泊车位.最后,仿真验证所提出的自主代客泊车路径规划方法的可行性和有效性,结果表明:相对于基于传统快速扩展随机数(RRT)算法的自主代客泊车路径规划方法,提出的方法搜索效率更高,并且规划的自主代客泊车路径满足汽车运动学约束和避障约束.     

基于样条理论的自动垂直泊车轨迹规划

分析泊车轨迹曲线设计要求并综合B样条曲线特点,提出基于B样条曲线理论通过对轨迹控制点优化进行自动垂直泊车轨迹规划的方法.分析泊车过程中存在的可能性碰撞点,并建立相应的避撞约束函数.考虑泊车环境障碍约束、车辆自身参数约束、泊车初始点方位约束、泊车终点位置约束,以泊车轨迹的最大曲率值最小化为目标,以轨迹曲线控制点为变量,根据Ackerman转向原理建立车辆运动轨迹多约束方程.分别对一般泊车环境和狭小空间泊车环境进行泊车轨迹规划,利用Matlab软件非线性约束优化函数求得轨迹控制点,得出轨迹曲线.仿真结果表明:对于一般泊车环境该方法能使车辆无碰撞地进入车位,且满足泊车轨迹曲率连续性;对于相对狭小泊车环境,也能求得一组轨迹控制点,通过不断调节前轮转角实现车辆无碰撞地泊车入位并保证了轨迹曲率的连续性.仿真结果表明了基于样条理论的泊车轨迹规划方法可实现车辆无碰撞地泊车入位,并满足轨迹曲率连续性要求,有效地解决了泊车过程中停车转向问题.     

无人驾驶拖拉机实时避障路径规划算法

为了实现无人驾驶拖拉机在直线作业时的实时避障路径规划功能,提出一种在改进最短切线法的基础上用五次多项式函数规划路径的避障路径规划算法。针对最短切线法规划的路径曲率不连续、难跟踪控制的问题,首先采用改进最短切线法求相关坐标点,然后基于求得的坐标点用五次多项式函数求解路径,最后得到由两段五次多项式函数曲线和直线组成的曲率连续的避障路径。对避障路径规划算法进行仿真,结果表明,该算法生成路径长度短、实时性好、安全性高。基于常州东风无人驾驶拖拉机的运动学模型设计一种模型预测控制器,在Simulink与CarSim联合仿真平台上对无人驾驶拖拉机的避障路径规划及跟踪控制进行联合仿真,结果表明：与改进最短切线法相比,基于五次多项式函数的路径规划算法规划的路径跟踪控制精度更高,更易于跟踪控制。     

一种面向泊车场景智能车辆轨迹规划方法

局部轨迹规划是自主代客泊车系统的关键技术之一，在该场景下，现有智能车辆的局部轨迹规划方法存在规划耗时长、曲率不连续、安全性不足等问题.针对该类问题，提出一种面向泊车场景的智能车辆轨迹规划方法.该方法通过改进混合A^*算法的解析扩展以及引入风险函数，提升了初始路径搜索的实时性和安全性.进一步，结合初始路径以及二次规划方法实现路径平滑和速度规划，最终完成轨迹生成.仿真实验表明，所提方法能够提升智能车辆轨迹规划实时性、平滑性以及安全性，并且在实车试验上验证所提方法在实际泊车场景的可行性.     

一种基于环视相机的自动泊车方法

针对泊车摄像头视场有限的问题,提出了一种基于环视相机的自动泊车方法.采用4个鱼眼摄像头,构建了一种环绕车身360°的实时视觉泊车辅助系统,用于停车位的实时检测和识别.首先,运用多项式鱼眼校正模型校正失真图像,用Levenberg-Marquardt算法求得最优的缝隙拼接方向并合成环视图;其次,采用Radon变换提取停车位特征识别停车位;最后,使用基于双圆弧的路径规划算法和基于预瞄点的改进PID路径跟踪算法,实现自动泊车.实验表明,该方法具有较高的检测精度和鲁棒性.