第44卷第2期2023年2月兵工学报ACTAAＲMAMENTAＲIIVol．44No．2Feb．2023DOI:10．12382/bgxb．2021．0756基于微分平坦的分层轨迹规划算法周孝添1，任宏斌1，苏波2，齐志权2，汪洋2(1．北京理工大学机械与车辆学院，北京100081;2．中国北方车辆研究所，北京100072)摘要:为充分考虑横纵向耦合和汽车运动学特性对轨迹规划的影响，提出一种分层优化的轨迹规划算法框架。利用贝塞尔曲线的凸包性设计安全走廊约束，以轨迹平滑性为目标函数得到一个基于贝塞尔曲线节点的下层规划器。在上层规划器中，基于下层规划器求解得到的横纵向贝塞尔曲线和车辆运动学模型的微分平坦输出进行三维耦合，构建满足车辆乘坐舒适性、高效性和安全性的目标函数，利用粒子群优化算法对贝塞尔轨迹初始参数进行二次优化得到综合性能最优的行驶轨迹。仿真结果表明:新算法在保证安全性的同时，具有良好的乘坐舒适性和可跟踪性;由于二次规划与粒子群优化算法的求解效率高，此框架实时性强，具有概率完备性。关键词:轨迹规划;微分平坦;贝塞尔曲线;二次规划;粒子群优化算法中图分类号:TJ810.2文献标志码:A文章编号:1000-1093(2023)02-0394-12HierarchicalTrajectoryPlanningAlgorithmbasedonDifferentialFlatnessZHOUXiaotian1，ＲENHongbin1，SUBo2，QIZhiquan2，WANGYang2(1．SchoolofMechanicalEngineering，BeijingInstituteofTechnology，Beijing100081，China;2．ChinaNorthVehicleＲesearchInstitute，Beijing100072，China)Abstract:Tofullyconsidertheinfluenceoftransverseandlongitudinalcouplingandvehiclekinematicsontrajectoryplanning，ahierarchicaloptimization-basedtrajectoryplanningalgorithmframeworkisproposed．ThesafecorridorconstraintisdesignedwiththeconvexhullofaBeziercurve．Takingthetrajectorysmoothnessastheobjectivefunction，weobtainalowerplannerbasedonBeziercurvenodes．Intheupperplanner，basedonthetransverseandlongitudinalBeziercurvessolvedbythelowerplannerandthedifferentiallyflatoutputofthevehiclekinematicsmodel，theobjectivefunctionmeetingthevehicleridecomfort，efficiencyandsafetyrequirementsisconstructed，andquadraticoptimizationisappliedtotheinitialparametersoftheBeziertrajectorybyparticleswarmoptimizationalgorithmtoobtainthedrivingtrajectorywiththebestcomprehensiveperformance．Thesimulatio...
