CN110928297A - 基于多目标动态粒子群优化的智能公交车辆路径规划方法 - Google Patents

基于多目标动态粒子群优化的智能公交车辆路径规划方法 Download PDF

Info

Publication number
CN110928297A
CN110928297A CN201911031001.1A CN201911031001A CN110928297A CN 110928297 A CN110928297 A CN 110928297A CN 201911031001 A CN201911031001 A CN 201911031001A CN 110928297 A CN110928297 A CN 110928297A
Authority
CN
China
Prior art keywords
dynamic
track
fitness
particle
static
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN201911031001.1A
Other languages
English (en)
Other versions
CN110928297B (zh
Inventor
余伶俐
魏亚东
况宗旭
周开军
霍淑欣
王正久
白宇
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Central South University
Original Assignee
Central South University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Central South University filed Critical Central South University
Priority to CN201911031001.1A priority Critical patent/CN110928297B/zh
Publication of CN110928297A publication Critical patent/CN110928297A/zh
Application granted granted Critical
Publication of CN110928297B publication Critical patent/CN110928297B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0238Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
    • G05D1/024Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0214Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0221Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0223Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0246Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0257Control of position or course in two dimensions specially adapted to land vehicles using a radar
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • G05D1/0278Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using satellite positioning signals, e.g. GPS

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Electromagnetism (AREA)
  • Optics & Photonics (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Multimedia (AREA)
  • Traffic Control Systems (AREA)

Abstract

本发明公开了一种基于多目标动态粒子群优化的智能公交车辆路径规划方法,包括:实时获取车辆和道路信息,生成全局参考路径;基于道路规则线和全局参考路径构建二维环境模型,并初始化粒子群中每个粒子:粒子的每个维度对应一个坐标点,每相邻两个维度坐标点之间设定曲线段,得到粒子对应的轨迹;根据路径长度、平滑度以及静态安全度指标设计轨迹的静态多目标适应度函数;然后采用粒子群算法,并应用静态多目标适应度函数,提取最优轨迹候选集;根据动态障碍物设计动态多目标适应度函数和约束加速度关系,并与静态安全性设计适应度函数结合,从最优轨迹候选集中选择综合适应度最优的一条轨迹。本发明在改善舒适性指标同时,大大提高动态安全性能。

Description

基于多目标动态粒子群优化的智能公交车辆路径规划方法
技术领域
本发明涉及智能驾驶及其控制技术领域,特别是一种基于多目标动态粒子群优化的智能公交车辆路径规划方法。
背景技术
近年来,智能驾驶一直是社会关注的焦点,随着智能驾驶技术研究的持续推进,智能车辆逐步走到了现实中,而结构化的城市道路,清晰的道路标志也使得城市公交车路况相对简单,这些促使了公交车成为自动驾驶技术在日常生活中普及的突破口,自动驾驶技术核心的部分就是为智能车辆规划一条安全无碰撞的最优行驶路径。
路径规划方法的研究主要是为了使智能车辆能够避开障碍物。现有的路径规划算法可分为全局规划和局部规划两个阶段。在全局规划阶段,通过数字地图和定位***确定全局路径和车辆状态。在局部规划阶段,可以根据全局路径以及相机、雷达等传感器获取的周边信息来实现局部路径。但现有技术中缺少一种用于智能公交车辆的、综合考虑静态与动态多障碍目标以及乘车舒适性的轨迹规划方法。
发明内容
本发明所要解决的技术问题在于,提供一种基于多目标动态粒子群优化的智能公交车辆路径规划方法,在改善舒适性指标的同时,大大提高动态安全性能。
为实现上述技术目的,本发明采用如下技术方案:
一种基于多目标动态粒子群优化的智能公交车辆路径规划方法,包括以下步骤:
步骤1,全局参考路径生成;
根据车载传感器实时获取车辆和道路信息,从道路信息提取道路规则线,生成符合道路规则线的全局参考路径;
步骤2,初始化粒子群及相应的轨迹;
基于道路规则线和全局参考路径,构建以前进方向为纵向X轴、垂直方向为横向Y轴的二维环境模型,在二维环境模型中初始化粒子群;
其中,每个粒子的位置编码规则为:每个维度对应二维环境模型中的一个坐标点,每相邻两个维度坐标点之间设定一条曲线段,则M-1条曲线段的总和得到与粒子对应的寻优轨迹,粒子群对应得到轨迹集;
步骤3,静态多目标设定及动态障碍物避让;
根据每条寻优轨迹的长度、平滑度以及与静态障碍物关联的静态安全度指标,设计静态多目标适应度函数;
采用粒子群算法,并应用静态多目标适应度函数,从粒子群轨迹集中筛选出适应度最优的前K条寻优轨迹,构成最优轨迹候选集;
根据动态障碍物及其与当前位置的关系,设计动态多目标适应度函数,并与静态安全性设计适应度函数结合得到综合适应度函数,从最优轨迹候选集中选择综合适应度最优的一条轨迹。
进一步地,每个粒子的每相邻两个维度坐标点之间设定的曲线,均采用三次样条插值方法得到。
进一步地,在生成M-1条样条曲线时,包括以下约束条件:
a,起点约束,起点坐标的函数值及一阶导数值均为0;
b,终点约束,终点坐标的函数值已知且一阶导数值为0;
c,中间点约束,每个中间点在相邻两条曲线段上的函数值相同、一阶导数值相同、二阶导数值相同。
进一步地,所述静态多目标适应度函数的表达式具体为:
fstastic_fitness=ωdffit_distencesffit_smoothnessuffit_security
上式中,fstastic_fitness表示轨迹的静态多目标适应度,ffit_distence表示轨迹长度,ωd表示长度权重,ffit_smoothness表示平滑度,ωs表示平滑度权重,ffit_security表示静态安全度,ωu表示静态安全度权重,且有:
Figure RE-GDA0002276918520000031
Figure RE-GDA0002276918520000032
Figure RE-GDA0002276918520000033
上式中,fcalculate_security表示障碍物到轨迹中各曲线段的最短距离,f(j+1)表示轨迹在第j个维度坐标与第j+1个维度坐标之间的曲线段,f″(j+1)表示曲线段f(j+1)的曲率,(xj,yj)表示粒子的第j个维度的坐标,且粒子的M个维度的横坐标依次等间距分布,间距为L1
若障碍物到轨迹的最短距离小于障碍物的几何半径,设置静态安全度为:fcalculate_security=9999。
进一步地,ωd=4,ωs=400,ωu=2。
进一步地,动态多目标适应度函数的设计规则为:
fdynamic_fitness=ωdynamic(L4-r)|a|,
Figure RE-GDA0002276918520000034
Figure RE-GDA0002276918520000035
Figure RE-GDA0002276918520000036
式中,fdynamic_fitness表示轨迹的动态多目标适应度,ωdynamic表示动态适应度权重,a表示车辆沿轨迹行驶的加速度,L4表示车辆沿轨迹跟随环境车辆的行驶距离,L5表示车辆在轨迹当前位置与动态碰撞物的碰撞点之间的路径弧长,v0表示车辆沿轨迹行驶的初速度,vlimit表示车辆的限制速度。
进一步地,所述动态碰撞物保持匀速直线运动,轨迹在避让动态障碍物时只考虑减速避让,且最优轨迹候选集中的轨迹在做动态障碍物避让时存在以下情况:轨迹与动态障碍物不存在碰撞点的适应度值大于轨迹与动态障碍物存在碰撞点的适应度值,即:f1 nocollison_fitness=f1 stastic_fitness+0>+f2 collison_fitness=f2 stastic_fitness+f2 dynamic_fitness
进一步地,步骤1的具体过程为:
步骤1.1,获取车辆和道路信息,从中提取道路规则线;
利用定位装置获取车辆的当前定位和状态信息,利用雷达获取道路边沿数据并提取道路边沿的几何描述,利用摄像头获取车道线数据并提取车道线的几何描述;
步骤1.2,全局参考路径生成;
若步骤1.1提取的道路规则线中包括车道线的几何描述,则全局参考路径为平行于车道线、且相对于中央车道线右侧的几何描述左移半个车道得到;
若步骤1.1提取的道路信息中不包括车道线的几何描述、但包括道路边沿的几何描述,则全局参考路径为平行于道路边沿、且相对于右侧道路边沿左移半个车道得到;
若步骤1.1提取的道路信息中不包括车道线的几何描述、且不包括道路边沿的几何描述,则检测传感器是否发生故障,并在传感器正常情况下重新执行步骤1。
进一步地,在二维环境模型中初始化粒子群的方法为:
将粒子的位置初始编码为二维环境模型中M维坐标点集合:Xi=([x1,y1],[x2,y2],…,[xM,yM]), i表示粒子群中的粒子标号,M表示粒子的维度;
其中,粒子编码的纵向解固定为[x1,x2,…,xM]=[0,L1,…,(M-1)L1],
将粒子的横向解空间[-L2,L2]以间隔为L3划分为
Figure RE-GDA0002276918520000041
个离散值,即粒子的横向解空间为
Figure RE-GDA0002276918520000042
j表示粒子的维度标号;
再将粒子的每相邻两个维度坐标点之间设定一条曲线段,则M-1条的曲线段的总和得到与粒子对应的寻优轨迹,粒子群对应为轨迹集。
有益效果
本发明的有益效果为:
1、综合考虑轨迹的长度、平滑性、静态安全性、动态安全性等性能指标设计多目标适应度函数设计,大大提高了智能公交路径规划的安全性及舒适性;
2、在动态障碍物的引入,在提高了轨迹规划的动态安全性的同时,输出了车辆加速度规划,尤其适用于智能化的智能公交车辆中;
3、采用粒子群算法,拟合多维度粒子的每相邻维度坐标之间的曲线时,有考虑起点、终点及中间点的约束,增加了轨迹的平滑性,进一步提高路径规划的舒适性;
4、采用粒子群算法,根据路径规划的前进方向特点以将粒子编码的纵向解固定,根据轨迹的偏移上限将横向解离散化为有限个数值,只需要设定较小粒子群种群数量及迭代周期即可完成粒子寻优,大大缩减了路径规划的完成周期。
5、基于路径规划的完成周期短,可在进行动态障碍物避让规划时,可将动态障碍物的运动简单化为匀速直线运动,在保证路径规划安全性的同时,降低了动态障碍物避让进行路径规划的难度。
附图说明
图1为本发明实施例的多目标动态粒子群优化路径规划流程图;
图2为本发明实施例建立的二维环境模型示意图;
图3为本发明实施例的最优轨迹候选集生成及多目标设定流程图;
图4为本发明实施例的动态障碍物避让流程图。
具体实施方式
下面对本发明的实施例作详细说明,本实施例以本发明的技术方案为依据开展,给出了详细的实施方式和具体的操作过程,对本发明的技术方案作进一步解释说明。
本实施例采用长12m,宽2.5m,高3.3m的大客车改装的智能车,装有激光雷达、毫米波雷达、GPS定位***及机器视觉***,在结构化道路进行路径规划实验。
本实施例提供的一种基于多目标动态粒子群优化的智能公交车辆路径规划方法,参见图 1、3、4所示,包括如下过程:
步骤1,全局参考路径生成;
根据车载传感器实时获取车辆和道路信息,从道路信息中提取道路规则线,生成符合道路规则线的全局参考路径,具体过程为:
步骤1.1,获取车辆和道路信息,从中提取道路规则线;
车辆信息具体是指车辆的当前定位和状态信息,即
Figure RE-GDA0002276918520000061
利用GPS定位***获得。
道路信息具体是指道路边沿数据和车道线数据。其中道路边沿数据通过激光雷达和毫米波雷达获取,然后可从道路边沿数据中提取道路边沿的几何描述:包括左边沿的几何描述
Figure RE-GDA0002276918520000062
和右边沿的几何描述
Figure RE-GDA0002276918520000063
车道线数据通过工业摄像头获取,然后可从车道线数据中提取车道线的几何描述
Figure RE-GDA0002276918520000064
其中i表示车道线序号,i∈{0,...,K},K为检测到车道线总数量。上述道路边沿的几何描述和车道线的几何描述,即为提取的道路规则线。
步骤1.2,全局参考路径生成;
若步骤1.1获取的道路规则线中包括车道线的几何描述,则全局参考路径
Figure RE-GDA0002276918520000065
为平行于车道线、且相对于中央车道线右侧的几何描述左移半个车道得到,即
Figure RE-GDA0002276918520000066
k∈{1,2,3},
Figure RE-GDA0002276918520000067
若步骤1.1获取的道路信息中不包括车道线的几何描述、但包括道路边沿的几何描述,则全局参考路径
Figure RE-GDA0002276918520000068
为平行于道路边沿、且相对于可侧道路边沿左移半个车道得到,即
Figure RE-GDA0002276918520000069
Figure RE-GDA00022769185200000610
且有
Figure RE-GDA00022769185200000611
Figure RE-GDA00022769185200000612
若步骤1.1获取的道路信息中不包括车道线的几何描述、且不包括道路边沿的几何描述,则检测传感器是否发生故障,并在传感器正常情况下重新执行步骤1。
步骤2,初始化粒子群及相应的轨迹;
基于道路规则线和全局参考路径,构建以前进方向为纵向X轴、垂直方向为横向Y轴的二维环境模型,如图2所示,其中在二维环境模型中初始化粒子群;其中,每个粒子的位置编码规则为:每个维度对应二维环境模型中的一个坐标点,每相邻两个维度坐标点之间均采用三次样条插值方法得到一条曲线段,则M-1条曲线段的总和得到与粒子对应的的寻优轨迹,粒子群对应得到轨迹集;
在二维环境模型中初始化粒子群的方法具体为:
步骤2.1,将粒子的位置初始编码为二维环境模型中M个坐标点集合: Xi=([x1,y1],[x2,y2],…,[xM,yM]),i表示粒子群中的粒子标号,M表示粒子的维度,在本实施例中取M=5;
步骤2.2,然后将粒子编码的纵向解固定为[x1,x2,…,xM]=[0,L1,…,(M-1)L1],并将粒子的纵向解空间[-L2,L2]以间隔为L3划分为
Figure RE-GDA0002276918520000071
个离散值,即粒子的纵向解空间限定为
Figure RE-GDA0002276918520000072
j表示粒子的维度标号;其中的L2具体取值为轨迹偏移全局参考路径的偏移上限。本实施例中设置L2=6m,L3=0.2m。
步骤2.3,再将粒子的每相邻两个维度坐标点之间设定一条曲线段,则M-1条曲线段的总和得到与粒子对应的的寻优轨迹,粒子群对应为轨迹集。
本实施例中,每条曲线段均采用三次样条插值方法得到,第k条曲线段表示为
Figure RE-GDA0002276918520000073
k=1,2,…,M-1。在生成M-1条曲线段时,包括以下约束条件:
a,起点约束,起点坐标的函数值及一阶导数值均为0,即:
Figure RE-GDA0002276918520000074
b,终点约束,终点坐标的函数值已知且一阶导数值为0,即
Figure RE-GDA0002276918520000075
c,中间点约束,由于中间点处于相邻两条曲线段连接处,每个中间点在相邻两条曲线段上的函数值相同
Figure RE-GDA0002276918520000076
一阶导数值相同
Figure RE-GDA0002276918520000077
二阶导数值相同
Figure RE-GDA0002276918520000078
步骤3,静态多目标设定及动态障碍物避让;
步骤3.1,静态多目标适应度函数设计:
根据每条寻优轨迹的长度、平滑度以及与静态障碍物关联的静态安全度指标,设计静态多目标适应度函数,表达式为:
fstastic_fitness=ωdffit_distencesffit_smoothnessuffit_security
上式中,fstastic_fitness表示轨迹的静态多目标适应度,ffit_distence表示长度,ωd表示长度权重, ffit_smoothness表示平滑度,ωs表示平滑度权重,ffit_security表示静态安全度,ωu表示静态安全度权重,在本实施例中取ωd=4,ωs=400,ωu=2。
其中长度ffit_distence,由于本实施例中所有粒子编码的纵向解均固定为 [x1,x2,…,xM]=[0,L1,…,(M-1)L1],即粒子所表示的轨迹长度在纵向上是相等的,因此在设计适应度函数时可以考虑横向上的长度,即只对各曲线段的横向距离做累加,表示为:
Figure RE-GDA0002276918520000081
(xj,yj)表示粒子的第j个维度的坐标,
平滑度ffit_smoothness,由于每个维度为M的粒子所表示的轨迹分为M-1条曲线段,且曲率 (二阶导数)有正负之分,故本实施例将粒子所表示的轨迹平滑度设计为M-1条曲线段的曲率平方之和,表示为:
Figure RE-GDA0002276918520000082
f(j+1)表示轨迹在第j个维度坐标与第j+1个维度坐标之间的曲线段,f″(j+1)表示曲线段f(j+1)的曲率;
静态安全度ffit_security,路径规划过程中要考虑障碍物的存在,设障碍物为几何半径为r 的中心圆,其位姿坐标为[x,y],则静态安全度表示为:
Figure RE-GDA0002276918520000083
fcalculate_security表示障碍物到轨迹中各曲线段的最短距离。若障碍物到轨迹的最短距离小于障碍物的几何半径,设置静态安全度为:fcalculate_security=9999。
步骤3.2,提取最优轨迹候选集:
采用粒子群算法,并应用静态多目标适应度函数,从粒子群轨迹集中筛选出适应度最优的前K条寻优轨迹,构成最优轨迹候选集。
在设置粒子群的种群大小和粒子群算法的最高迭代次数后,并对粒子群的粒子位置按步骤2初始化编码后,则可以步骤3.1设计的静态多目标适应度函数作为粒子群算法的适应度函数,采用以下位置和速度更新公式对粒子群进行迭代更新:
Vi=ωVi+c1r1(Pbest-Xi)+c2r2(Gbest-Xi),
Xi=Xi+Vi
其中Vi=(vi1,vi2,...,viM)表示第i个粒子的速度,维数与粒子维数相同为M;c1=c1=0.5为学习因子,也称为加速常数,ω为惯性因子,r1、r2为[0,1]之间的随机数,Pbest表示第i个粒子搜索到的最优位置称为个体极值,Gbest表示当前粒子群搜索到的最优位置称为全局极值。由于速度更新公式中c1、c2、r1、r2及ω的设定,计算得到的粒子速度会出现小数,对该数做四舍五入,将速度整数化,符合粒子编码整数的形式。
当达到最高迭代次数后,从粒子群的所有个体极值中选取适应度最小的前K个极值,该 K个极值粒子对应的轨迹即为适应度最优的前K条寻优轨迹。在本实施例中,取K=5。
步骤3.3,动态障碍物避让:
由于本发明的路径规划的完成周期为毫秒级,尤其是本实施例中在采用粒子群算法进行粒子编码的时候,将粒子位置编码的纵向解固定、根据轨迹的偏移上限将横向解离散化为有限个数值,只需要设定较小粒子群种群数量及迭代周期即可完成粒子寻优,大大缩减了路径规划的完成周期。因此本实施例可假设动态障碍物在路径规划的毫秒时间内,其运动速度及方向基本不变,从而假设动态障碍物在路径规划时间内保持直线运动。
本实施例另外还假设存在以下情况:(1)轨迹与动态障碍物不存在碰撞点的适应度值大于轨迹与动态障碍物存在碰撞点的适应度值,即: f1 nocollison_fitness=f1 stastic_fitness+0>+f2 collison_fitness=f2 stastic_fitness+f2 dynamic_fitness;(2)动态障碍物避让只考虑减速避让,不考虑加速超车的情况。
因此,当最优轨迹候选集内的所有轨迹已完成静态障碍物避让后,即可根据动态障碍物及其与当前位置的关系,设计动态多目标适应度函数和车辆沿轨迹行驶的加速度约束关系,并将动态多目标适应度函数与静态安全性设计适应度函数结合得到综合适应度函数,在满足加速度约束关系的基础上从最优轨迹候选集中选择综合适应度最优的一条轨迹。
具体的动态障碍物避让规划方法为:
根据上述假设条件,动态障碍物保持匀速直线运动,生成一条轨迹线,与最优轨迹候选集中的轨迹的交叉点即为碰撞点。
首先,截取最优轨迹候选集中各轨迹的当前位置与碰撞点之间的路径,该路径弧长为L5;而车辆沿轨迹从起点运行至碰撞点所需时间为v0t=L2-r,v0表示车辆沿轨迹行驶的初速度;
然后设定车辆加速度约束关系:车辆沿轨迹跟随动态障碍物的行驶距离为L4,且满足
Figure RE-GDA0002276918520000091
则加速度取值为
Figure RE-GDA0002276918520000092
且加速度满足
Figure RE-GDA0002276918520000093
vlimit表示车辆的限制速度。在本实施例中设定v0=30km/h,vlimit=10km/h。
最后,针对最优轨迹候选集中的K条轨迹,引入动态多目标适应度函数,并综合考虑静态与动态多目标适应度函数,最终即可生成最优轨迹以及动态障碍物避让的加速度。其中动态多目标适应度函数为:
fdynamic_fitness=ωdynamic(L4-r)|a|;
式中,fdynamic_fitness表示轨迹的动态多目标适应度,ωdynamic表示动态适应度权重,取ωdynamic=0.25。
以上实施例为本申请的优选实施例,本领域的普通技术人员还可以在此基础上进行各种变换或改进,在不脱离本申请总的构思的前提下,这些变换或改进都应当属于本申请要求保护的范围之内。

Claims (9)

1.一种基于多目标动态粒子群优化的智能公交车辆路径规划方法,其特征在于,包括以下步骤:
步骤1,全局参考路径生成;
根据车载传感器实时获取车辆和道路信息,从道路信息提取道路规则线,生成符合道路规则线的全局参考路径;
步骤2,初始化粒子群及相应的轨迹;
基于道路规则线和全局参考路径,构建以前进方向为纵向X轴、垂直方向为横向Y轴的二维环境模型,在二维环境模型中初始化粒子群;
其中,每个粒子的位置编码规则为:每个维度对应二维环境模型中的一个坐标点,每相邻两个维度坐标点之间设定一条曲线段,则M-1条曲线段的总和得到与粒子对应的寻优轨迹,粒子群对应得到轨迹集;
步骤3,静态多目标设定及动态障碍物避让;
根据每条寻优轨迹的长度、平滑度以及与静态障碍物关联的静态安全度指标,设计静态多目标适应度函数;
采用粒子群算法,并应用静态多目标适应度函数,从粒子群轨迹集中筛选出适应度最优的前K条寻优轨迹,构成最优轨迹候选集;
根据动态障碍物及其与当前位置的关系,设计动态多目标适应度函数,并与静态安全性设计适应度函数结合得到综合适应度函数,从最优轨迹候选集中选择综合适应度最优的一条轨迹。
2.根据权利要求1所述的方法,其特征在于,每个粒子的每相邻两个维度坐标点之间设定的曲线,均采用三次样条插值方法得到。
3.根据权利要求2所述的方法,其特征在于,在生成M-1条样条曲线时,包括以下约束条件:
a,起点约束,起点坐标的函数值及一阶导数值均为0;
b,终点约束,终点坐标的函数值已知且一阶导数值为0;
c,中间点约束,每个中间点在相邻两条曲线段上的函数值相同、一阶导数值相同、二阶导数值相同。
4.根据权利要求1所述的方法,其特征在于,所述静态多目标适应度函数的表达式具体为:
fstastic_fitness=ωdffit_distencesffit_smoothnessuffit_security
上式中,fstastic_fitness表示轨迹的静态多目标适应度,ffit_distence表示轨迹长度,ωd表示长度权重,ffit_smoothness表示平滑度,ωs表示平滑度权重,ffit_security表示静态安全度,ωu表示静态安全度权重,且有:
Figure FDA0002250143700000021
Figure FDA0002250143700000022
Figure FDA0002250143700000023
上式中,fcalculate_security表示障碍物到轨迹中各曲线段的最短距离,f(j+1)表示轨迹在第j个维度坐标与第j+1个维度坐标之间的曲线段,f″(j+1)表示曲线段f(j+1)的曲率,(xj,yj)表示粒子的第j个维度的坐标,且粒子的M个维度的横坐标依次等间距分布,间距为L1
若障碍物到轨迹的最短距离小于障碍物的几何半径,设置静态安全度为:fcalculate_security=9999。
5.根据权利要求4所述的方法,其特征在于,ωd=4,ωs=400,ωu=2。
6.根据权利要求1所述的方法,其特征在于,动态多目标适应度函数的设计规则为:
fdynamic_fitness=ωdynamic(L4-r)|a|,
Figure FDA0002250143700000024
Figure FDA0002250143700000025
Figure FDA0002250143700000026
式中,fdynamic_fitness表示轨迹的动态多目标适应度,ωdynamic表示动态适应度权重,a表示车辆沿轨迹行驶的加速度,L4表示车辆沿轨迹跟随环境车辆的行驶距离,L5表示车辆在轨迹当前位置与动态碰撞物的碰撞点之间的路径弧长,v0表示车辆沿轨迹行驶的初速度,vlimit表示车辆的限制速度。
7.根据权利要求6所述的方法,其特征在于,所述动态碰撞物保持匀速直线运动,轨迹在避让动态障碍物时只考虑减速避让,且最优轨迹候选集中的轨迹在做动态障碍物避让时存在以下情况:轨迹与动态障碍物不存在碰撞点的适应度值大于轨迹与动态障碍物存在碰撞点的适应度值,即:f1 nocollison_fitness=f1 stastic_fitness+0>+f2 collison_fitness=f2 stastic_fitness+f2 dynamic_fitness
8.根据权利要求1所述的方法,其特征在于,步骤1的具体过程为:
步骤1.1,获取车辆和道路信息,从中提取道路规则线;
利用定位装置获取车辆的当前定位和状态信息,利用雷达获取道路边沿数据并提取道路边沿的几何描述,利用摄像头获取车道线数据并提取车道线的几何描述;
步骤1.2,全局参考路径生成;
若步骤1.1提取的道路规则线中包括车道线的几何描述,则全局参考路径为平行于车道线、且相对于中央车道线右侧的几何描述左移半个车道得到;
若步骤1.1提取的道路信息中不包括车道线的几何描述、但包括道路边沿的几何描述,则全局参考路径为平行于道路边沿、且相对于右侧道路边沿左移半个车道得到;
若步骤1.1提取的道路信息中不包括车道线的几何描述、且不包括道路边沿的几何描述,则检测传感器是否发生故障,并在传感器正常情况下重新执行步骤1。
9.根据权利要求1所述的方法,其特征在于,在二维环境模型中初始化粒子群的方法为:
将粒子的位置初始编码为二维环境模型中M维坐标点集合:Xi=([x1,y1],[x2,y2],…,[xM,yM]),i表示粒子群中的粒子标号,M表示粒子的维度;
其中,粒子编码的纵向解固定为[x1,x2,…,xM]=[0,L1,…,(M-1)L1],
将粒子的横向解空间[-L2,L2]以间隔为L3划分为
Figure FDA0002250143700000031
个离散值,即粒子的横向解空间为
Figure FDA0002250143700000032
j表示粒子的维度标号;
再将粒子的每相邻两个维度坐标点之间设定一条曲线段,则M-1条的曲线段的总和得到与粒子对应的寻优轨迹,粒子群对应为轨迹集。
CN201911031001.1A 2019-10-28 2019-10-28 基于多目标动态粒子群优化的智能公交车辆路径规划方法 Active CN110928297B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201911031001.1A CN110928297B (zh) 2019-10-28 2019-10-28 基于多目标动态粒子群优化的智能公交车辆路径规划方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201911031001.1A CN110928297B (zh) 2019-10-28 2019-10-28 基于多目标动态粒子群优化的智能公交车辆路径规划方法

Publications (2)

Publication Number Publication Date
CN110928297A true CN110928297A (zh) 2020-03-27
CN110928297B CN110928297B (zh) 2020-10-30

Family

ID=69849576

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201911031001.1A Active CN110928297B (zh) 2019-10-28 2019-10-28 基于多目标动态粒子群优化的智能公交车辆路径规划方法

Country Status (1)

Country Link
CN (1) CN110928297B (zh)

Cited By (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111766875A (zh) * 2020-06-18 2020-10-13 珠海格力智能装备有限公司 吸尘设备的避障方法及装置、电子设备
CN112148002A (zh) * 2020-08-31 2020-12-29 西安交通大学 一种局部轨迹规划方法、***及装置
CN112562372A (zh) * 2020-11-30 2021-03-26 腾讯科技(深圳)有限公司 一种轨迹数据的处理方法以及相关装置
CN112859845A (zh) * 2021-01-04 2021-05-28 广州小鹏自动驾驶科技有限公司 一种轨迹的规划方法、装置和车辆
CN113011060A (zh) * 2021-03-03 2021-06-22 西北工业大学 一种复合材料的温度工艺曲线优化方法及***
CN113759887A (zh) * 2020-06-04 2021-12-07 北京京东乾石科技有限公司 一种路径规划方法、装置、存储介质及电子设备
CN114035586A (zh) * 2021-11-22 2022-02-11 江苏科技大学 改进蚁群算法和动态窗口的车间agv小车路径规划方法
WO2022083166A1 (zh) * 2020-10-19 2022-04-28 山东交通学院 一种卡口数据缺失下的车辆行车轨迹重建方法及***
CN114413906A (zh) * 2022-01-18 2022-04-29 哈尔滨工业大学 一种基于改进粒子群优化算法的三维轨迹规划方法
CN116811884A (zh) * 2023-08-25 2023-09-29 格陆博科技有限公司 一种智能驾驶环境感知分析方法及***
CN117250868A (zh) * 2023-11-14 2023-12-19 泉州装备制造研究所 基于多目标粒子群算法的分流控制方法、***及存储介质

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106843236A (zh) * 2017-03-31 2017-06-13 深圳市靖洲科技有限公司 基于权重改进粒子群算法的无人自行车路径规划方法
CN107992051A (zh) * 2017-12-26 2018-05-04 江南大学 基于改进的多目标粒子群算法的无人车路径规划方法
CN108645411A (zh) * 2018-05-15 2018-10-12 深圳大学 基于粒子群算法的机器人路径规划方法、装置及终端设备
CN110081894A (zh) * 2019-04-25 2019-08-02 同济大学 一种基于道路结构权值融合的无人车轨迹实时规划方法

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106843236A (zh) * 2017-03-31 2017-06-13 深圳市靖洲科技有限公司 基于权重改进粒子群算法的无人自行车路径规划方法
CN107992051A (zh) * 2017-12-26 2018-05-04 江南大学 基于改进的多目标粒子群算法的无人车路径规划方法
CN108645411A (zh) * 2018-05-15 2018-10-12 深圳大学 基于粒子群算法的机器人路径规划方法、装置及终端设备
CN110081894A (zh) * 2019-04-25 2019-08-02 同济大学 一种基于道路结构权值融合的无人车轨迹实时规划方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
LINGLI YU等: "A Path Planning and Navigation Control System Design for Driverless Electric Bus", 《IEEE ACCESS》 *
余伶俐等: "智能车辆深度强化学习的模型迁移轨迹规划方法", 《控制理论与应用》 *

Cited By (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113759887A (zh) * 2020-06-04 2021-12-07 北京京东乾石科技有限公司 一种路径规划方法、装置、存储介质及电子设备
CN111766875A (zh) * 2020-06-18 2020-10-13 珠海格力智能装备有限公司 吸尘设备的避障方法及装置、电子设备
CN112148002A (zh) * 2020-08-31 2020-12-29 西安交通大学 一种局部轨迹规划方法、***及装置
CN112148002B (zh) * 2020-08-31 2021-12-28 西安交通大学 一种局部轨迹规划方法、***及装置
WO2022083166A1 (zh) * 2020-10-19 2022-04-28 山东交通学院 一种卡口数据缺失下的车辆行车轨迹重建方法及***
CN112562372A (zh) * 2020-11-30 2021-03-26 腾讯科技(深圳)有限公司 一种轨迹数据的处理方法以及相关装置
CN112562372B (zh) * 2020-11-30 2021-11-16 腾讯科技(深圳)有限公司 一种轨迹数据的处理方法以及相关装置
CN112859845A (zh) * 2021-01-04 2021-05-28 广州小鹏自动驾驶科技有限公司 一种轨迹的规划方法、装置和车辆
CN113011060A (zh) * 2021-03-03 2021-06-22 西北工业大学 一种复合材料的温度工艺曲线优化方法及***
CN114035586A (zh) * 2021-11-22 2022-02-11 江苏科技大学 改进蚁群算法和动态窗口的车间agv小车路径规划方法
CN114035586B (zh) * 2021-11-22 2024-03-29 江苏科技大学 改进蚁群算法和动态窗口的车间agv小车路径规划方法
CN114413906A (zh) * 2022-01-18 2022-04-29 哈尔滨工业大学 一种基于改进粒子群优化算法的三维轨迹规划方法
CN114413906B (zh) * 2022-01-18 2022-12-13 哈尔滨工业大学 一种基于改进粒子群优化算法的三维轨迹规划方法
CN116811884A (zh) * 2023-08-25 2023-09-29 格陆博科技有限公司 一种智能驾驶环境感知分析方法及***
CN116811884B (zh) * 2023-08-25 2023-11-28 格陆博科技有限公司 一种智能驾驶环境感知分析方法及***
CN117250868A (zh) * 2023-11-14 2023-12-19 泉州装备制造研究所 基于多目标粒子群算法的分流控制方法、***及存储介质
CN117250868B (zh) * 2023-11-14 2024-03-01 泉州装备制造研究所 基于多目标粒子群算法的分流控制方法、***及存储介质

Also Published As

Publication number Publication date
CN110928297B (zh) 2020-10-30

Similar Documents

Publication Publication Date Title
CN110928297B (zh) 基于多目标动态粒子群优化的智能公交车辆路径规划方法
Dai et al. Modeling vehicle interactions via modified LSTM models for trajectory prediction
CN110749333B (zh) 基于多目标优化的无人驾驶车辆运动规划方法
CN112673234B (zh) 路径规划方法和路径规划装置
CN109669461B (zh) 一种复杂工况下自动驾驶车辆决策***及其轨迹规划方法
WO2018176593A1 (zh) 一种面向无人自行车的局部避障路径规划方法
Pérez et al. Trajectory generator for autonomous vehicles in urban environments
CN108088456A (zh) 一种具有时间一致性的无人驾驶车辆局部路径规划方法
Yi et al. Model predictive trajectory planning for automated driving
CN107813820A (zh) 一种仿优秀驾驶员的无人车换道路径规划方法
CN112577506B (zh) 一种自动驾驶局部路径规划方法和***
CN113343746A (zh) 用于车辆行驶表面上的车道检测的方法和设备
CN116723970A (zh) 使用界限表示进行自动驾驶拓扑规划的***、方法和计算机程序产品
CN116118780A (zh) 一种车辆避障轨迹规划方法、***、车辆及存储介质
US20230150549A1 (en) Hybrid log simulated driving
CN113515111B (zh) 一种车辆避障路径规划方法及装置
Zhang et al. Structured road-oriented motion planning and tracking framework for active collision avoidance of autonomous vehicles
CN116069037A (zh) 无人车编队轨迹规划控制方法、装置、设备及存储介质
US20240043037A1 (en) Systems and methods related to controlling autonomous vehicle(s)
Malayjerdi et al. Practical path planning techniques in overtaking for autonomous shuttles
Park et al. Path generation algorithm based on crash point prediction for lane changing of autonomous vehicles
CN112706760B (zh) 一种用于特殊道路场景的无人驾驶泊车路径规划方法
CN116466708A (zh) 一种面向复杂非结构化场景的自主代客泊车轨迹规划方法
CN114537435A (zh) 一种自动驾驶中的实时整车轨迹规划方法
CN115079699A (zh) 一种基于模型预测控制的人机共驾汽车的运动规划方法

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant