CN110362084A - 一种基于蚁群算法的车辆路径追踪控制方法 - Google Patents
一种基于蚁群算法的车辆路径追踪控制方法 Download PDFInfo
- Publication number
- CN110362084A CN110362084A CN201910658937.0A CN201910658937A CN110362084A CN 110362084 A CN110362084 A CN 110362084A CN 201910658937 A CN201910658937 A CN 201910658937A CN 110362084 A CN110362084 A CN 110362084A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- control
- ant
- delta
- current
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 27
- 238000013461 design Methods 0.000 claims abstract description 4
- 239000011159 matrix material Substances 0.000 claims description 27
- 239000003016 pheromone Substances 0.000 claims description 25
- 241000257303 Hymenoptera Species 0.000 claims description 10
- 238000005070 sampling Methods 0.000 claims description 7
- 238000012937 correction Methods 0.000 claims description 4
- 230000007423 decrease Effects 0.000 claims description 3
- 230000009191 jumping Effects 0.000 claims description 3
- 230000007704 transition Effects 0.000 claims description 3
- 238000005457 optimization Methods 0.000 abstract description 6
- 238000004364 calculation method Methods 0.000 description 4
- 238000005096 rolling process Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000013178 mathematical model Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0221—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0223—Control 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
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开了一种基于蚁群算法的车辆路径追踪控制方法,包括步骤:1、建立车辆的运动学模型;2、设计车辆模型预测控制器;3、获取当前时刻车辆的状态,利用蚁群算法求解使目标函数取最小值的控制量增量序列,其第一个元素为当前时刻的最优控制增量;4、根据当前时刻的最优控制增量控制轮胎转向角和车辆行驶速度,控制车辆运行,判断是否需要切换参考点后进入步骤2继续下一个时刻的控制。该方法计算速度快,能够提高车辆路径追踪的实时性。
Description
技术领域
本发明属于车辆自动驾驶控制技术领域,具体涉及一种在无人驾驶车辆路径追踪时计算车辆轮胎转向角和车辆速度的方法。
背景技术
路径追踪是无人驾驶车辆中的一项关键技术,目前路径追踪主要有以下几种方法:采用PID控制器,有较好的跟踪能力,但是缺乏对复杂工况的适应;采用纯追踪算法,跟踪性能和实时性较好,但是需要建立精确的运动学模型,而且前视距离不易选取,使其在应用方面受到很大的限制;基于模型预测控制(MPC)的方法,该方法不要求建立精确的数学模型,而是通过求解带约束的目标函数,预测系统未来时刻的状态,在线滚动优化,并根据系统实际输出进行反馈校正,修正预测模型,最终使得系统在未来时刻的跟踪误差最小,有独特的预测能力,控制效果好,在许多生产过程中得到了广泛的应用。
然而模型预测控制需要在每一采样时刻,根据当前的测量信息,在线求解一个有限时域开环优化问题,这个过程会消耗很多时间。为了提高计算速度,引入了控制时域的概念。当预测时域大于控制时域时,将不再进行优化求解,而是把最后一个控制时刻求解出的控制量,作为今后时刻的控制输出。但是这样的处理方式在一定程度上降低了优化的自由度。
车辆路径追踪系统需要快速的动态响应,其轨迹跟踪性能主要取决于转向和速度的实时控制,而基于传统的MPC路径追踪方法在实际工程中动态性差,进而影响跟踪精度。
发明内容
发明目的:针对现有技术中存在的问题,本发明提供了一种基于蚁群算法的车辆路径追踪控制方法,该方法计算速度快,能够提高车辆路径追踪的实时性。
技术方案:本发明采用如下技术方案:
一种基于蚁群算法的车辆路径追踪控制方法,包括步骤:
步骤1、建立车辆的运动学模型,包括如下步骤:
(1.1)车辆的坐标与航向角和轮胎转向角之间具有如下的关系:
其中x、y分别为车辆在X轴和Y轴的坐标,为车辆航向角,l为车辆的前后轴的轴距,v为车辆的速度,δ为轮胎转向角;分别为车辆在X轴和Y轴的速度,为车辆的转向角速度;
(1.2)以为状态量,u=[δ v]T为控制量,构建车辆的一般运动学模型:
其中,
参考轨迹上当前参考点r处运动学模型的一般形式为:
(1.3)建立离散化跟踪误差模型,如下:
其中,为k时刻的跟踪误差,Ak,t和Bk,t分别为根据当前时刻t预测k时刻状态的状态系数矩阵和控制系数矩阵;
T为采样周期,k为离散变量,t为当前采样时刻;
步骤2:设计车辆模型预测控制器,包括如下步骤:
(2.1)计算系统的预测输出表达式;
系统的预测输出表达式为:
Y(t)=ΨtX(t|t)+ΘtΔU(t) (5)
其中,Y(t)为系统预测输出矩阵,Ψt为系统状态量预测参数,Θt为控制增量序列预测参数,ΔU(t)为控制增量序列,X(t|t)为当前时刻t的状态量;
设当前时刻t的状态系数矩阵当前时刻t的控制系数矩阵其中I2表示2行2列的单位矩阵,I3表示3行3列的单位矩阵,03×2表示3行2列的全0矩阵;
则Nc为控制时域,Np为预测时域;
(2.2)根据式(5)的预测模型,目标函数的表达式如下所示:
其中,R、Q为权重矩阵,ρ为权重系数,ε为松弛因子,Nc为控制时域,Np为预测时域,η(t+i|t)为当前时刻t预测t+i时刻的系统输出量,控制增量序列ΔU(t)为待求解的未知量;
约束条件为:
ΔUmin≤ΔU(t)≤ΔUmax (7)
其中,ΔUmin、ΔUmax分别为控制时域内控制量变化量最小值、最大值的集合;
步骤3、获取当前时刻车辆的状态,利用蚁群算法求解使目标函数取最小值的ΔU(t)*:
ΔU(t)*=[Δu(t|t)* Δu(t+1|t)* … Δu(t+Nc-1|t)*]T, (8)
则当前时刻的最优控制增量为Δu(t|t)*;
步骤4、根据当前时刻的最优控制增量Δu(t|t)*控制轮胎转向角和车辆行驶速度,控制车辆运行,判断是否需要切换参考点r后进入步骤2继续下一个时刻的控制。
所述步骤(3)利用蚁群算法求解使目标函数取最小值的ΔU(t)*,包括如下步骤:
(3.1)蚁群算法初始化:
蚁群由M只蚂蚁组成,定义蚂蚁i在第l次迭代时的位置Posi(l)为适应度Ji(l)为根据当前时刻车辆的坐标、航向角和以Posi(l)作为控制增量序列ΔU(t)计算得到的目标函数值,适应度Ji(l)为:Ji(l)=J(Posi(l));
修正后的适应度为:
其中Kavr(l)是Ji(l)的平均值,Kavr0为[e3,+∞)范围内的随机数;信息素Ti(l)为:
定义最大迭代次数为Lmax;i=1,2,…,M;
初始化蚁群中每只蚂蚁的初始位置Posi(0),Posi(0)满足条件:ΔUmin≤Posi(0)≤ΔUmax;计算每只蚂蚁初始适应度Ji(0)、初始修正适应度和初始信息素Ti(0);令迭代次数l=1;
(3.2)计算本次迭代中蚂蚁i选择下一个可行位置的概率Pi:
其中,Ti(l-1)表示在上一次迭代中,蚂蚁i的信息素大小;在第l次迭代中,蚂蚁i按照式(12)所示的规则进行移动:
其中,rands为范围[-1,1]内的随机数,P0为预设的(0,0.5)范围内的状态转移概率常数,up和low分别为蚂蚁可移动范围的上下限,up=ΔUmax,low=ΔUmin,λ为随迭代次数增加而减小的变量;计算每只蚂蚁位置移动后的适应度Ji(l)、修正适应度和信息素Ti(l);
(3.3)再次更新每只蚂蚁的信息素浓度:
Ti new(l)=(1-μ)Ti new(l-1)+L×Ti(l) (14)
其中,μ为信息挥发系数,μ∈(0,1),L为信息素收敛常数;Ti new(0)=Ti(0);
统计本次迭代中所有蚂蚁更新后信息素最大的值,即和取得最大值时的蚂蚁的位置Posbest(l);
(3.4)判断是否终止迭代:
如果满足蚁群算法结束条件,则本次迭代蚂蚁的位置Posbest(l)为最优控制增量序列ΔU(t)*=[Δu(t|t)* Δu(t+1|t)* … Δu(t+Nc-1|t)*]T,取ΔU(t)*第一个元素Δu(t|t)*为当前时刻t的期望控制增量;转到步骤4;
如果不满足蚁群算法结束条件,令迭代次数l=l+1,跳转到步骤(3.2)继续计算当前时刻t的期望控制增量。
本发明中,每次迭代中λ的取值为:
蚁群算法结束条件为:
当前迭代次数l>Lmax,或最优解满足精度要求:
||Posbest(l)-Posbest(l-1)||2<ξ,ξ是预设的精度阈值。
所述步骤(4)具体包括如下步骤:
(4.1)根据当前时刻的最优控制增量Δu(t|t)*和前一时刻的控制量计算当前时刻的控制量:
u(t)=u(t-1)+Δu(t|t)*
由此得到当前时刻轮胎转向角δ(t)和车辆的速度v(t),来控制车辆运行;
(4.2)判断是否已经到达或超过参考轨迹上当前参考点r,如果到达或超过,则将参考轨迹上下一个点作为参考点r;跳转至步骤2继续下一个时刻的控制。
有益效果:与现有技术相比,本发明公开的基于蚁群算法的车辆路径追踪控制方法具有如下优点:利用蚁群算法作为滚动优化方法,具有更强的全局搜索能力,更快的计算能力,能够提高车辆轮胎转向角和车速的运算速度,更好的满足车辆路径追踪的实时性要求。
附图说明
图1为本发明公开的基于蚁群算法的车辆路径追踪控制方法的流程图;
图2为利用蚁群算法计算当前时刻的最优控制增量的流程图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚,下面结合附图对本发明的具体实施案例做说明。
如图1所示,本发明公开了一种基于蚁群算法的车辆路径追踪控制方法,包括步骤:
步骤1、建立车辆的运动学模型,包括如下步骤:
(1.1)车辆的坐标与航向角和轮胎转向角之间具有如下的关系:
其中x、y分别为车辆在X轴和Y轴的坐标,为车辆航向角,l为车辆的前后轴的轴距,v为车辆的速度,δ为轮胎转向角;分别为车辆在X轴和Y轴的速度,为车辆的转向角速度;
(1.2)以为状态量,u=[δ v]T为控制量,构建车辆的一般运动学模型:
其中,
参考轨迹上当前参考点r处运动学模型的一般形式为:
(1.3)建立离散化跟踪误差模型,如下:
其中,为k时刻的跟踪误差,Ak,t和Bk,t分别为根据当前时刻t预测k时刻状态的状态系数矩阵和控制系数矩阵;
T为采样周期,k为离散变量,t为当前采样时刻;
步骤2:设计车辆模型预测控制器,包括如下步骤:
(2.1)计算系统的预测输出表达式;
系统的预测输出表达式为:
Y(t)=ΨtX(t|t)+ΘtΔU(t) (5)
其中,Y(t)为系统预测输出矩阵,Ψt为系统状态量预测参数,Θt为控制增量序列预测参数,ΔU(t)为控制增量序列,X(t|t)为当前时刻t的状态量;
设当前时刻t的状态系数矩阵当前时刻t的控制系数矩阵其中I2表示2行2列的单位矩阵,I3表示3行3列的单位矩阵,03×2表示3行2列的全0矩阵;
则Nc为控制时域,Np为预测时域;
(2.2)根据式(5)的预测模型,目标函数的表达式如下所示:
其中,R、Q为权重矩阵,ρ为权重系数,ε为松弛因子,Nc为控制时域,Np为预测时域,η(t+i|t)为当前时刻t预测t+i时刻的系统输出量,控制增量序列ΔU(t)为待求解的未知量;
约束条件为:
ΔUmin≤ΔU(t)≤ΔUmax (7)
其中,ΔUmin、ΔUmax分别为控制时域内控制量变化量最小值、最大值的集合;
步骤3、获取当前时刻车辆的状态,利用蚁群算法求解使目标函数取最小值的ΔU(t)*:
ΔU(t)*=[Δu(t|t)* Δu(t+1|t)* … Δu(t+Nc-1|t)*]T, (8)
则当前时刻的最优控制增量为Δu(t|t)*,具体步骤为:
(3.1)蚁群算法初始化:
蚁群由M只蚂蚁组成,蚂蚁的位置作为待优化的控制增量序列ΔU(t);
定义蚂蚁i在第l次迭代时的位置Posi(l)为适应度Ji(l)为根据当前时刻车辆的坐标、航向角和以Posi(l)作为控制增量序列ΔU(t)计算得到的目标函数值;
适应度Ji(l)为:Ji(l)=J(Posi(l)); (9)
修正后的适应度为:
其中Kavr(l)是Ji(l)的平均值,Kavr0为[e3,+∞)范围内的随机数;修正适应度值的目的在于,避免适应度值过大,导致式(11)解算出的信息素趋于0。信息素Ti(l)为:
定义最大迭代次数为Lmax;i=1,2,…,M;
初始化蚁群中每只蚂蚁的初始位置Posi(0),Posi(0)满足条件:ΔUmin≤Posi(0)≤ΔUmax;根据式(9)-(11)计算每只蚂蚁初始适应度Ji(0)、初始修正适应度和初始信息素Ti(0);令迭代次数l=1;
(3.2)计算本次迭代中蚂蚁i选择下一个可行位置的概率Pi:
其中,Ti(l-1)表示在上一次迭代中,蚂蚁i的信息素大小;在第l次迭代中,蚂蚁i按照式(13)所示的规则进行移动:
其中,rands为范围[-1,1]内的随机数,P0为预设的(0,0.5)范围内的状态转移概率常数,up和low分别为蚂蚁可移动范围的上下限,up=ΔUmax,low=ΔUmin;λ为随迭代次数增加而减小的变量,本发明中取值为:当Pi<P0时,属于局部搜索;当Pi≥P0时,属于全局搜索。计算每只蚂蚁位置移动后的适应度Ji(l)、修正适应度和信息素Ti(l);
(3.3)综合上次迭代信息素剩余量与本次迭代中位置更新后的信息素,再次更新每只蚂蚁的信息素:
Ti new(l)=(1-μ)Ti new(l-1)+L×Ti(l) (14)
其中,μ为信息挥发系数,μ∈(0,1),L为信息素收敛常数,L越大,信息素收敛越快,过大时会陷入局部最优,也不稳定,经过实验其最佳取值范围是[1,1000];Ti new(0)=Ti(0);
统计本次迭代中所有蚂蚁更新后信息素最大的值,即和取得最大值的蚂蚁的位置Posbest(l);
(3.4)判断是否终止迭代:
如果满足蚁群算法结束条件,则本次迭代蚂蚁的位置Posbest(l)为最优控制增量序列ΔU(t)*=[Δu(t|t)* Δu(t+1|t)* … Δu(t+Nc-1|t)*]T,取ΔU(t)*第一个元素Δu(t|t)*为当前时刻t的期望控制增量;转到步骤4;
如果不满足蚁群算法结束条件,令迭代次数l=l+1,跳转到步骤(3.2)继续计算当前时刻t的期望控制增量。
所述蚁群算法结束条件为:
当前迭代次数l>Lmax,或最优解满足精度要求:
||Posbest(l)-Posbest(l-1)||2<ξ
ξ是预设的精度阈值。步骤4、根据当前时刻的最优控制增量Δu(t|t)*控制轮胎转向角和车辆行驶速度,控制车辆运行,判断是否需要切换参考点r后进入步骤2继续下一个时刻的控制,具体步骤为:
(4.1)根据当前时刻的最优控制增量Δu(t|t)*和前一时刻的控制量计算当前时刻的控制量:
u(t)=u(t-1)+Δu(t|t)*
由此得到当前时刻轮胎转向角δ(t)和车辆的速度v(t),来控制车辆运行;
(4.2)判断是否已经到达或超过参考轨迹上当前参考点r,如果到达或超过,则将参考轨迹上下一个点作为参考点r;跳转至步骤2继续下一个时刻的控制。
Claims (5)
1.一种基于蚁群算法的车辆路径追踪控制方法,其特征在于,包括步骤:
步骤1、建立车辆的运动学模型,包括如下步骤:
(1.1)车辆的坐标与航向角和轮胎转向角之间具有如下的关系:
其中x、y分别为车辆在X轴和Y轴的坐标,为车辆航向角,l为车辆的前后轴的轴距,v为车辆的速度,δ为轮胎转向角;分别为车辆在X轴和Y轴的速度,为车辆的转向角速度;
(1.2)以为状态量,u=[δ v]T为控制量,构建车辆的一般运动学模型:
其中,
参考轨迹上当前参考点r处运动学模型的一般形式为:
(1.3)建立离散化跟踪误差模型,如下:
其中,为k时刻的跟踪误差,Ak,t和Bk,t分别为根据当前时刻t预测k时刻状态的状态系数矩阵和控制系数矩阵;
T为采样周期,k为离散变量,t为当前采样时刻;
步骤2:设计车辆模型预测控制器,包括如下步骤:
(2.1)计算系统的预测输出表达式;
系统的预测输出表达式为:
Y(t)=ΨtX(t|t)+ΘtΔU(t) (5)
其中,Y(t)为系统预测输出矩阵,Ψt为系统状态量预测参数,Θt为控制增量序列预测参数,ΔU(t)为控制增量序列,X(t|t)为当前时刻t的状态量;
设当前时刻t的状态系数矩阵当前时刻t的控制系数矩阵其中I2表示2行2列的单位矩阵,I3表示3行3列的单位矩阵,03×2表示3行2列的全0矩阵;
则Nc为控制时域,Np为预测时域;
(2.2)根据式(5)的预测模型,目标函数的表达式如下所示:
其中,R、Q为权重矩阵,ρ为权重系数,ε为松弛因子,Nc为控制时域,Np为预测时域,η(t+i|t)为当前时刻t预测t+i时刻的系统输出量,控制增量序列ΔU(t)为待求解的未知量;
约束条件为:
ΔUmin≤ΔU(t)≤ΔUmax (7)
其中,ΔUmin、ΔUmax分别为控制时域内控制量变化量最小值、最大值的集合;
步骤3、获取当前时刻车辆的状态,利用蚁群算法求解使目标函数取最小值的ΔU(t)*:
ΔU(t)*=[Δu(t|t)* Δu(t+1|t)* … Δu(t+Nc-1|t)*]T, (8)
则当前时刻的最优控制增量为Δu(t|t)*;
步骤4、根据当前时刻的最优控制增量Δu(t|t)*控制轮胎转向角和车辆行驶速度,控制车辆运行,判断是否需要切换参考点r后进入步骤2继续下一个时刻的控制。
2.根据权利要求1所述的基于蚁群算法的车辆路径追踪控制方法,其特征在于,所述步骤(3)利用蚁群算法求解使目标函数取最小值的ΔU(t)*,包括如下步骤:
(3.1)蚁群算法初始化:
蚁群由M只蚂蚁组成,定义蚂蚁i在第l次迭代时的位置Posi(l)为适应度Ji(l)为根据当前时刻车辆的坐标、航向角和以Posi(l)作为控制增量序列ΔU(t)计算得到的目标函数值;
适应度Ji(l)为:Ji(l)=J(Posi(l));
修正后的适应度为:
其中Kavr(l)是Ji(l)的平均值,Kavr0为[e3,+∞)范围内的随机数;信息素Ti(l)为:
定义最大迭代次数为Lmax;i=1,2,…,M;
初始化蚁群中每只蚂蚁的初始位置Posi(0),Posi(0)满足条件:ΔUmin≤Posi(0)≤ΔUmax;计算每只蚂蚁初始适应度Ji(0)、初始修正适应度和初始信息素Ti(0);令迭代次数l=1;
(3.2)计算本次迭代中蚂蚁i选择下一个可行位置的概率Pi:
其中,Ti(l-1)表示在上一次迭代中,蚂蚁i的信息素大小;在第l次迭代中,蚂蚁i按照式(13)所示的规则进行移动:
其中,rands为范围[-1,1]内的随机数,P0为预设的(0,0.5)范围内的状态转移概率常数,up和low分别为蚂蚁可移动范围的上下限,up=ΔUmax,low=ΔUmin,λ为随迭代次数增加而减小的变量;
计算每只蚂蚁位置移动后的适应度Ji(l)、修正适应度和信息素Ti(l);
(3.3)再次更新每只蚂蚁的信息素:
其中,μ为信息挥发系数,μ∈(0,1),L为信息素收敛常数,
统计本次迭代中所有蚂蚁更新后信息素最大的值,即和取得最大值的蚂蚁的位置Posbest(l);
(3.4)判断是否终止迭代:
如果满足蚁群算法结束条件,则本次迭代蚂蚁的位置Posbest(l)为最优控制增量序列ΔU(t)*=[Δu(t|t)* Δu(t+1|t)* … Δu(t+Nc-1|t)*]T,取ΔU(t)*第一个元素Δu(t|t)*为当前时刻t的期望控制增量;转到步骤4;
如果不满足蚁群算法结束条件,令迭代次数l=l+1,跳转到步骤(3.2)继续计算当前时刻t的期望控制增量。
3.根据权利要求2所述的基于蚁群算法的车辆路径追踪控制方法,其特征在于,所述步骤(3.2)中
4.根据权利要求2所述的基于蚁群算法的车辆路径追踪控制方法,其特征在于,所述蚁群算法结束条件为:
当前迭代次数l>Lmax,或最优解满足精度要求:
||Posbest(l)-Posbest(l-1)||2<ξ
ξ是预设的精度阈值。
5.根据权利要求1所述的基于蚁群算法的车辆路径追踪控制方法,其特征在于,所述步骤(4)具体包括如下步骤:
(4.1)根据当前时刻的最优控制增量Δu(t|t)*和前一时刻的控制量计算当前时刻的控制量:
u(t)=u(t-1)+Δu(t|t)*
由此得到当前时刻轮胎转向角δ(t)和车辆的速度v(t),来控制车辆运行;
(4.2)判断是否已经到达或超过参考轨迹上当前参考点r,如果到达或超过,则将参考轨迹上下一个点作为参考点r;跳转至步骤2继续下一个时刻的控制。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910658937.0A CN110362084B (zh) | 2019-07-22 | 2019-07-22 | 一种基于蚁群算法的车辆路径追踪控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910658937.0A CN110362084B (zh) | 2019-07-22 | 2019-07-22 | 一种基于蚁群算法的车辆路径追踪控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110362084A true CN110362084A (zh) | 2019-10-22 |
CN110362084B CN110362084B (zh) | 2022-08-26 |
Family
ID=68221348
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910658937.0A Active CN110362084B (zh) | 2019-07-22 | 2019-07-22 | 一种基于蚁群算法的车辆路径追踪控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110362084B (zh) |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111176284A (zh) * | 2020-01-02 | 2020-05-19 | 东南大学 | 一种用于无人驾驶的车辆路径追踪自适应控制方法和系统 |
CN111857152A (zh) * | 2020-07-31 | 2020-10-30 | 北京京东乾石科技有限公司 | 用于生成车辆控制信息的方法和装置 |
CN112114588A (zh) * | 2020-08-31 | 2020-12-22 | 南京航空航天大学 | 一种平衡车及其控制方法 |
CN112180925A (zh) * | 2020-09-28 | 2021-01-05 | 广东嘉腾机器人自动化有限公司 | Agv轨迹跟随方法、装置及处理设备 |
CN113110045A (zh) * | 2021-03-31 | 2021-07-13 | 同济大学 | 一种基于计算图的模型预测控制实时优化并行计算方法 |
CN113190018A (zh) * | 2021-05-24 | 2021-07-30 | 东南大学 | 一种基于改进航向误差率的智能体路径控制方法 |
CN113221387A (zh) * | 2021-06-10 | 2021-08-06 | 燕山大学 | 一种波浪能转换装置的最大能量输出控制方法及系统 |
CN113581285A (zh) * | 2021-08-25 | 2021-11-02 | 深圳亿嘉和科技研发有限公司 | 一种液压转向阿克曼型机器人的自动回充控制方法 |
CN113734182A (zh) * | 2020-05-29 | 2021-12-03 | 比亚迪股份有限公司 | 一种车辆自适应控制方法及其装置 |
CN113781785A (zh) * | 2021-11-10 | 2021-12-10 | 禾多科技(北京)有限公司 | 用于仿真测试的随机交通流控制方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101799888A (zh) * | 2010-01-22 | 2010-08-11 | 浙江大学 | 基于仿生智能蚁群算法的工业软测量方法 |
CN108334086A (zh) * | 2018-01-25 | 2018-07-27 | 江苏大学 | 一种基于软约束二次规划mpc的无人驾驶车辆路径跟踪控制方法 |
CN109884900A (zh) * | 2019-04-03 | 2019-06-14 | 东南大学 | 基于自适应模型预测控制的收获机路径跟踪控制器的设计方法 |
US20200301374A1 (en) * | 2017-10-17 | 2020-09-24 | Hitachi Automotive Systems, Ltd. | Prediction control device and method |
-
2019
- 2019-07-22 CN CN201910658937.0A patent/CN110362084B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101799888A (zh) * | 2010-01-22 | 2010-08-11 | 浙江大学 | 基于仿生智能蚁群算法的工业软测量方法 |
US20200301374A1 (en) * | 2017-10-17 | 2020-09-24 | Hitachi Automotive Systems, Ltd. | Prediction control device and method |
CN108334086A (zh) * | 2018-01-25 | 2018-07-27 | 江苏大学 | 一种基于软约束二次规划mpc的无人驾驶车辆路径跟踪控制方法 |
CN109884900A (zh) * | 2019-04-03 | 2019-06-14 | 东南大学 | 基于自适应模型预测控制的收获机路径跟踪控制器的设计方法 |
Non-Patent Citations (10)
Title |
---|
ABHISHEK KUMAR KASHYAP: "Optimization of stability of humanoid robot NAO using ant colony", 《METHODOLOGIES AND APPLICATION》 * |
SAIBAL MANNA: "Ant Colony Optimization Tuned Closed-Loop Optimal Control Intended for Vehicle Active Suspension System", 《IEEE》 * |
冀杰等: "面向车道变换的路径规划及模型预测轨迹跟踪", 《中国公路学报》 * |
冯志雨: "分层递进的改进聚类蚁群算法解决TSP问题", 《计算机科学与探索》 * |
焦巍 等: "非线性模型预测控制的智能算法综述", 《系统仿真学报》 * |
王凯正: "基于车车信息交互的智能车辆轨迹规划与运动控制", 《中国优秀硕士论文 工程科技Ⅱ辑》 * |
王娟等: "蚁群算法滚动优化的LS-SVM预测控制研究", 《控制与决策》 * |
石佳晨: "基于MPC的智能稻麦收获机路径追踪方法研究", 《中国优秀硕士论文数据库》 * |
雷登云: "基于改进蚁群算法的车辆路径优化模型", 《电子科技》 * |
龙文 等: "基于蚁群算法和LSSVM的锅炉燃烧优化预测控制", 《电力自动化设备》 * |
Cited By (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111176284A (zh) * | 2020-01-02 | 2020-05-19 | 东南大学 | 一种用于无人驾驶的车辆路径追踪自适应控制方法和系统 |
CN113734182A (zh) * | 2020-05-29 | 2021-12-03 | 比亚迪股份有限公司 | 一种车辆自适应控制方法及其装置 |
CN113734182B (zh) * | 2020-05-29 | 2023-11-14 | 比亚迪股份有限公司 | 一种车辆自适应控制方法及其装置 |
CN111857152A (zh) * | 2020-07-31 | 2020-10-30 | 北京京东乾石科技有限公司 | 用于生成车辆控制信息的方法和装置 |
CN111857152B (zh) * | 2020-07-31 | 2024-07-19 | 北京京东乾石科技有限公司 | 用于生成车辆控制信息的方法和装置 |
CN112114588A (zh) * | 2020-08-31 | 2020-12-22 | 南京航空航天大学 | 一种平衡车及其控制方法 |
CN112180925B (zh) * | 2020-09-28 | 2023-02-17 | 广东嘉腾机器人自动化有限公司 | Agv轨迹跟随方法、装置及处理设备 |
CN112180925A (zh) * | 2020-09-28 | 2021-01-05 | 广东嘉腾机器人自动化有限公司 | Agv轨迹跟随方法、装置及处理设备 |
CN113110045A (zh) * | 2021-03-31 | 2021-07-13 | 同济大学 | 一种基于计算图的模型预测控制实时优化并行计算方法 |
CN113190018A (zh) * | 2021-05-24 | 2021-07-30 | 东南大学 | 一种基于改进航向误差率的智能体路径控制方法 |
CN113221387A (zh) * | 2021-06-10 | 2021-08-06 | 燕山大学 | 一种波浪能转换装置的最大能量输出控制方法及系统 |
CN113581285A (zh) * | 2021-08-25 | 2021-11-02 | 深圳亿嘉和科技研发有限公司 | 一种液压转向阿克曼型机器人的自动回充控制方法 |
CN113781785B (zh) * | 2021-11-10 | 2022-02-08 | 禾多科技(北京)有限公司 | 用于仿真测试的随机交通流控制方法 |
CN113781785A (zh) * | 2021-11-10 | 2021-12-10 | 禾多科技(北京)有限公司 | 用于仿真测试的随机交通流控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN110362084B (zh) | 2022-08-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110362084B (zh) | 一种基于蚁群算法的车辆路径追踪控制方法 | |
CN110262229B (zh) | 基于mpc的车辆自适应路径追踪方法 | |
CN111176284B (zh) | 一种用于无人驾驶的车辆路径追踪自适应控制方法和系统 | |
CN112693449B (zh) | 一种无人车辆极限工况下横纵向耦合控制方法 | |
CN109884900B (zh) | 基于自适应模型预测控制的收获机路径跟踪控制器的设计方法 | |
CN109669463A (zh) | 一种考虑agv速度和前轮偏向角可变的区间轨迹跟踪方法 | |
CN110281912B (zh) | 一种智能车辆横向纵向综合控制系统及控制方法 | |
CN113031436A (zh) | 一种基于事件触发的移动机器人模型预测轨迹跟踪控制系统及方法 | |
CN114047722A (zh) | 基于mpc的自适应位姿修正的路径跟踪控制方法 | |
CN113341719A (zh) | 一种融合teb算法和模糊控制的agv轨迹跟踪控制方法 | |
CN107272419A (zh) | 一种基于改进pso的驾驶员自适应方向控制方法 | |
CN114675673B (zh) | 一种空中动目标追踪方法及系统 | |
Qinpeng et al. | Path tracking control of wheeled mobile robot based on improved pure pursuit algorithm | |
CN113190018B (zh) | 一种基于改进航向误差率的智能体路径控制方法 | |
CN116560371A (zh) | 基于自适应模型预测控制的自动驾驶车辆路径跟踪方法 | |
CN109062040A (zh) | 基于系统嵌套优化的预测pid方法 | |
CN113721620B (zh) | 基于粒子群-遗传混合算法的车辆横向pid控制方法 | |
CN114200925B (zh) | 基于自适应时域模型预测的拖拉机路径跟踪控制方法及系统 | |
CN113325694B (zh) | 一种基于机器学习的模型预测控制参数的整定方法 | |
CN114859886A (zh) | 基于自适应伸缩因子的变论域模糊控制agv纠偏方法 | |
CN114879508A (zh) | 一种基于模型预测控制的磨削机器人路径跟踪控制方法 | |
CN114839878A (zh) | 基于改进ppo算法的双足机器人行走稳定性优化方法 | |
CN113815602A (zh) | 一种车辆横向自适应控制方法 | |
CN114415522B (zh) | 一种履带车辆平台路径跟踪控制方法及系统 | |
CN114194216B (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 |