版权说明:本文档由用户提供并上传,收益归属内容提供方,若内容存在侵权,请进行举报或认领
文档简介
号一种基于安全走廊的多车协同轨迹规划优本发明公开了一种基于安全走廊的多车协息与无人驾驶车的矩形轮廓信息表示离散化的结合无人驾驶车时空走廊位置信息建立避碰约2步骤1、获取各无人驾驶车当前环境下从初始位置到目标位置之间待优化粗糙路径信步骤2、根据步骤1构建的各无人驾驶车参考路径点,构步骤3、根据步骤2建立的各无人驾驶车安全走廊立方体步骤4、基于步骤3构建的待优化代价指标函数,结步骤5、在步骤4构建的待优化二次规划问题的基础上步骤6、根据步骤5得到的各无人驾驶车安全通行走廊,步骤7、根据步骤5中构建的无人驾驶车安全走廊长度与步骤6中规划的无人驾驶车行2.根据权利要求1所述的一种基于安全走廊的多车协同轨迹规划优化方法,其特征在3.根据权利要求2所述的一种基于安全走廊的多车协同轨迹规划优化方法,其特征在3;;廊中枢点位置的纵坐标,x'(k)表示第k个走廊x方向最小边界距离中枢点的长度,x:(k)表示第k个走廊x方向最大边界距离中枢点的长度,表示第k个走廊y方向最大边界第k个走廊y方向最大边界的位置。4.根据权利要求3所述的一种基于安全走廊的多车协同轨迹规划优化方法,其特征在针对各无人驾驶车建立的走廊立方体cube'(k),构建待优化代价指标函数,其中包括;5.根据权利要求4所述的一种基于安全走廊的多车协同轨迹规划优化方法,其特征在基于步骤3构建的待优化代价指标函数,结合混合整数规划算法构建基于约束的待优6.根据权利要求5所述的一种基于安全走廊的多车协同轨迹规划优化方法,其特征在4;7.根据权利要求6所述的一种基于安全走廊的多车协同轨迹规划优化方法,其特征在;任意时刻走廊大小需要满足位于上一时刻车辆运;;式中,v,表示车辆向后运动的最大速度,S:on.表示无人驾驶车从I'(k-1)时刻出发到r'(t)时刻沿x方向运动的最小距离,表沿x方向运动的最大距离,san.表示无人驾驶车从I'(k-1)时刻出发到时刻沿y方向运动的最小距离,J:a表示无人驾驶车从I'(k-1)时刻出发到r'(t)时刻沿y方向运动的最5。8.根据权利要求7所述的一种基于安全走廊的多车协同轨迹规划优化方法,其特征在于,步骤4中安全走廊之间的防碰撞约束描述为不同车辆i和j在同一时刻的安全走廊立方;为二进制变量,用于表示无人驾驶车辆i对应的第m个走廊立方体和无人驾驶车辆j对应的第n个走廊立方体是否用于表示无人驾驶车辆i的第m个时间段对应的时刻值与无人驾驶车辆j的第m个时间段9.根据权利要求8所述的一种基于安全走廊的多车协同轨迹规划优化方法,其特征在最小值时的变量p'(k).g'(k),r'(k)的取值,获得无人驾驶车i的k个走廊立方体相连而成的于:步骤6中将安全走廊内轨迹生成目标描述为包括代价函数与约束条件的非线性规划问轨迹平滑度代价其中表示轨迹平滑度代价在优化问题中的权重系数,x'(表示车辆i在时刻t处轨迹的曲率;横纵向舒适度代价其中表示控制信号6与走廊中枢点时空偏差代价其中w,w,表示不同方向的误差权重系数,('(),y'()表示车辆i的质心在时刻t处所处位置;;;;;;7表车辆i在时刻t车身四角点对应的坐标值。8体参见Hang,Peng,etal."Human_likedecisionmakingforautonomousdriving:Anoncooperativegametheoreticapproach."IEEETransactionsonIntelligentB,LuY,etal.AHierarchicalMulti_VehicleCoordinatedMotionPlanningMethodbasedonInteractiveSpatio_TemporalCorridors[J].IEEETransactionsonIntelligentVehicles,2023。现有技术主要关注多车无冲突目标位置决策以及安全[0006]为实现上述目的,本发明提供一种基于安全走廊的多车步骤1、获取各无人驾驶车当前环境下从初始位置到目标位置之间待优化粗糙路9步骤7、根据步骤5中构建的无人驾驶车安全走廊长度与步骤6中规划的无人驾驶在惯性坐标系下,针对无人驾驶车群组V={kek。;;式中,p'(k)表示第k个走廊中枢点的位置,g'(k)表示第k个走廊的大小,示第k个走廊中枢点位置的纵坐标,x'(k)表示第k个走廊x方向最小最大边界距离中枢点的长度,表示第k个走廊下边界y方向最小边界距离中枢点的表示第k个走廊x方向最大边界的位置,表示第k个走廊y方向最小边界的位置,表示第k个走廊y方向最大边界的位置。针对各无人驾驶车建立的走廊立方体cube'(k),构建待优化代价指标函数,其中;基于步骤3构建的待优化代价指标函数,结合混合整数规划算法构建基于约束的[0011]优选的,步骤4中安全走廊中枢点位置约束描述为走廊中枢点距离不超过最大行;;任意时刻走廊大小需要满足位于上一时刻车辆运;;式中,v,表示车辆向后运动的最大速度,S:on.表示无人驾驶车从I'(k-1)时刻出时刻沿x方向运动的最大距离,表示无人驾驶车从I'(k-1)时刻出发到方向运动的最小距离,J:a表示无人驾驶车从I'(k-1)时刻出发到时刻沿y方向运动。[0013]优选的,步骤4中安全走廊之间的防碰撞约束描述为不同车辆i和j在同一时刻的;为二进制变量,用于表示无人驾驶车辆i对应的第m个走廊立方体和无人驾驶车辆j对应的第n个走廊立方体是否用于表示无人驾驶车辆i的第m个时间段对应的时刻值与无人驾驶车辆j的第m个时间段得代价函数取最小值时的变量p'(k).g'(k),r'(k)的取值,获得无人驾驶车i的k个走廊立方[0015]优选的,步骤6中将安全走廊内轨迹生成目标描述为包括代价函数与约束条件的轨迹平滑度代价其中表示轨迹平滑度代价在优化问题中的权重系数,x'(表示车辆i在时刻t处轨迹的曲率;横纵向舒适度代价其中表示控制a表示车辆i在时刻t处前轮转向角度变化率,表示车辆i在时刻t其中w,w,表示不同方向的误差权重系数,('(),y'()表示车辆i的质心在时刻t处所处;;;其中x'(),y'(),0'()分别对应于车身质心位置坐标与车身与参考坐标系夹角,;;;别代表车辆i在时刻t车身四角点对应的坐标值。[0019]以下对在附图中提供的本发明的实施例的详细描述并非旨在限制要求保护的本步骤1、获取各无人驾驶车当前环境下从初始位置到目标位置之间待优化粗糙路在惯性坐标系下,针对无人驾驶车群组V={;;式中,p'(k)表示第k个走廊中枢点的位置,g'(k)表示第k个走廊的大小,示第k个走廊中枢点位置的纵坐标,x'(k)表示第k个走廊x方向最小最大边界距离中枢点的长度,表示第k个走廊下边界y方向最小边界距离中枢点的表示第k个走廊x方向最大边界的位置,表示第k个走廊y方向最小边界的位置,表示第k个走廊y方向最大边界的位置。体中枢点位置与参考轨迹位置之间距离值表示;走廊空间占据代价由走廊长度和宽度构针对各无人驾驶车建立的走廊立方体cube'(k),构建待优化代价指标函数,其中;基于步骤3构建的待优化代价指标函数,结合混合整数规划算法构建基于约束的;;任意时刻走廊大小需要满足位于上一时刻车辆运;;式中,v,表示车辆向后运动的最大速度,S:on.表示无人驾驶车从I'(k-1)时刻出时刻沿x方向运动的最大距离,表示无人驾驶车从I'(k-1)时刻出发到方向运动的最小距离,J:a表示无人驾驶车从I'(k-1)时刻出发到时刻沿y方向运动。[0026]安全走廊之间的防碰撞约束描述为不同车辆i和j在同一时刻的安全走廊立方体;为二进制变量,用于表示无人驾驶车辆i对应的第m个走廊立方体和无人驾驶车辆j对应的第n个走廊立方体是否用于表示无人驾驶车辆i的第m个时间段对应的时刻值与无人驾驶车辆j的第m个时间段器,求出满足步骤4中约束条件情况下使得代价函数取最小值时的变量p'(k).g'(k),r'(k)的轨迹平滑度代价其中表示轨迹平滑度代价在优化问题中的权重系数,x'(表示车辆i在时刻t处轨迹的曲率;横纵向舒适度代价其中表示控制a表示车辆i在时刻t处前轮转向角度变化率,表示车辆i在时刻t其中w,w,表示不同方向的误差权重系数,('(),y'()表示车辆i的质心在时刻t处所处;;;其中x'(),y'(),0'()分别对应于车身质心位置坐标与车身与参考坐标系夹角,;;;别代表车辆i在时刻t车身四角点对应的坐标值。[0029]步骤7、根据步骤5中构建的无人驾驶车安全走廊长度与步骤6中规划的无人驾驶
温馨提示
- 1. 本站所有资源如无特殊说明,都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
- 2. 本站的文档不包含任何第三方提供的附件图纸等,如果需要附件,请联系上传者。文件的所有权益归上传用户所有。
- 3. 本站RAR压缩包中若带图纸,网页内容里面会有图纸预览,若没有图纸预览就没有图纸。
- 4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
- 5. 人人文库网仅提供信息存储空间,仅对用户上传内容的表现方式做保护处理,对用户上传分享的文档内容本身不做任何修改或编辑,并不能对任何下载内容负责。
- 6. 下载文件中如有侵权或不适当内容,请与我们联系,我们立即纠正。
- 7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。
最新文档
- 2026事业单位工勤技能-浙江-浙江家禽饲养员二级(技师)历年参考题库含答案详解
- 2026事业单位工勤技能-浙江-浙江仓库管理员四级(中级工)历年参考题库含答案详解
- 2026事业单位工勤技能-河南-河南环境监测工一级(高级技师)历年参考题库含答案详解
- 2026事业单位工勤技能-河南-河南工程测量员三级(高级工)历年参考题库含答案详解
- 2026事业单位工勤技能-河南-河南保健按摩师五级(初级工)历年参考题库含答案详解
- 2026事业单位工勤技能-河北-河北客房服务员一级(高级技师)历年参考题库含答案详解
- 2026事业单位工勤技能-河北-河北中式面点师四级(中级工)历年参考题库含答案详解
- 2026事业单位工勤技能-江西-江西热力运行工三级(高级工)历年参考题库含答案详解
- 2026事业单位工勤技能-江西-江西工程测量员一级(高级技师)历年参考题库含答案详解
- 2026事业单位工勤技能-江西-江西仓库管理员一级(高级技师)历年参考题库含答案详解
- 2026-2027学年度福建省高一地理期中考试卷
- 人教版品德与社会五下《生活中的快乐》课件
- 2026医疗三基三严知识试题题库(附参考答案)
- 2026年公务员时事政治试题(附答案)
- 2026中国钢铁物流加工配送中心转型升级路径探索
- 2026中国超白压延玻璃在BIPV领域的透光率与发电效率平衡研究
- 《特种加工机床 激光加工扫描振镜系统 检测方法》
- IPC-JEDEC J-STD-020F-2024 中文版(非气密固态表面贴装器件的潮湿 - 再流焊敏感度分级)
- 2026年四川省政府采购评审专家考试试卷及答案
- 光伏支架调整施工方案
- 《平凡的世界》课件
评论
0/150
提交评论