CN111413966B - 一种递进式模型预测无人驾驶规划跟踪协同控制方法 - Google Patents
一种递进式模型预测无人驾驶规划跟踪协同控制方法 Download PDFInfo
- Publication number
- CN111413966B CN111413966B CN202010169826.6A CN202010169826A CN111413966B CN 111413966 B CN111413966 B CN 111413966B CN 202010169826 A CN202010169826 A CN 202010169826A CN 111413966 B CN111413966 B CN 111413966B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- representing
- control
- optimal
- obstacle
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 20
- 230000000750 progressive effect Effects 0.000 title claims abstract description 10
- 239000002245 particle Substances 0.000 claims abstract description 33
- 238000005457 optimization Methods 0.000 claims abstract description 25
- 230000006870 function Effects 0.000 claims description 28
- 238000005070 sampling Methods 0.000 claims description 18
- 230000005484 gravity Effects 0.000 claims description 12
- 238000004364 calculation method Methods 0.000 claims description 11
- 230000009471 action Effects 0.000 claims description 9
- 238000006073 displacement reaction Methods 0.000 claims description 6
- 230000004888 barrier function Effects 0.000 claims description 3
- 238000009499 grossing Methods 0.000 claims description 3
- 230000007246 mechanism Effects 0.000 claims description 3
- 238000012545 processing Methods 0.000 claims description 3
- 230000000694 effects Effects 0.000 description 4
- 238000011161 development Methods 0.000 description 2
- 230000006872 improvement Effects 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 230000003044 adaptive effect Effects 0.000 description 1
- 238000013528 artificial neural network Methods 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 239000013643 reference control Substances 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
Images
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/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/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0214—Control 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
-
- 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
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:计算各个时刻的障碍势场Po;步骤4:根据实际需求设计局部路径规划代价函数与轨迹跟踪代价函数;步骤5:利用动态惯性因子粒子群算法求解规划层模型预测控制问题,计算最优控制序列与状态;步骤6:根据步骤5逐步迭代求得规划对应的最优控制输入和参考状态,对求得的最优参考进行四次多项式拟合;步骤7:求解优化问题,得到最优控制序列;步骤8:判断是否达到全局目标点。本发明面加快了优化求解的收敛速度,减小了跟踪层优化的搜索空间;能将控制层的优化时间大大减少。
Description
技术领域
本发明涉及无人驾驶路径规划与轨迹跟踪控制技术领域,特别是涉及一种递进式模型预测控制算法框架。
背景技术
“无人驾驶车辆局部路径规划”的基本定义是根据车辆获取的当前周围环境信息和车辆的决策意图与全局路径信息进行结合,计算出一条或多条应用于控制层引导车辆前进的安全、平滑的局部路径。在路径规划技术发展初期,A*算法、D*算法、快速搜索随机树法(Rapidly-exploring Random Trees,RRT)等算法被应用于无人驾驶车辆。但这些算法普遍存在不能保证路径的最优、生成轨迹不连续等缺点。近年来,模型预测控制算法(ModelPredictive Control,MPC)在控制领域中不断发展。由于MPC具有滚动优化、反馈校正的思想,该思想与局部路径规划算法的思想十分契合,因此许多专家学者将其应用于路径规划过程并取得了很好的效果。传统方法只研究单独的规划问题和控制问题,为解决实时性问题采取的策略一般是采用简单的控制算法,如采用MPC规划、采用PID跟踪,或者对复杂问题进行简化,如简化系统模型以降低计算复杂度等。
在获取局部路径之后,无人驾驶车辆需要利用该路径结合当前车辆状态计算合适的控制量,使车辆能够跟踪上预定的参考轨迹。在无人驾驶车辆发展初期,PID控制由于其简单的结构及算法的成熟度,被学者们广泛应用于车辆的轨迹跟踪中,取得了较好的效果。随着实际应用对算法要求的不断提高,自适应控制、神经网络等算法被应用于车辆控制。与此同时由于MPC具有处理多变量、多约束等系统的能力,能够将车辆行驶中的运动学与动力学约束考虑在内,因此成为目前轨迹跟踪研究中最为广泛的一种控制算法。
相比于一般算法,MPC在无人驾驶的局部路径规划与轨迹跟踪问题上具有更优的控制性能。但该算法需要对车辆未来的状态进行预测,并根据目标函数计算最优控制量,由此给计算设备带来的计算负担十分巨大。因此,一般在上层采用基于MPC的规划控制算法来提供尽可能符合要求的参考控制量,在下层采用PID等低计算负担的控制算法实现跟踪过程。这样虽然降低了计算负担,但也在一定程度上牺牲了部分控制精度,并且不能保证控制量的最优性。
一般的简单算法或者简化的算法将导致控制优化性能的损失。
发明内容
本发明旨在提出一种递进式模型预测无人驾驶规划跟踪协同控制方法,在每个系统采样周期内,结合改进粒子群算法中逐步迭代和模型预测控制算法,利用规划层求解的最优控制输入和参考状态为跟踪层优化求解的初始原点,并以预测时域内的道路曲率为基本参数,计算选择跟踪层的最优解的搜索半径,以此减少解的搜索空间。
本发明的一种递进式模型预测无人驾驶规划跟踪协同控制方法,包括以下步骤:
步骤1:建立车辆的离散运动学模型:
其中,k表示采样时刻,表示车辆在全局参考坐标系XOY下的状态向量,[v,δf]T表示控制输入向量,(x,y)表示车辆重心的位置,表示航向角,v表示车辆重心处的速度,δf表示前轮的转向角,L表示车辆轴距;
步骤2:确定车辆运行时需要满足的约束条件:为了避免车辆发生碰撞,确定时变安全的避障约束条件,表达式如下:
其中,xr,i和yr,i分别表示无人车与第i个障碍物之间的纵向和横向相对距离,Lx和Ly分别表示纵向和横向安全距离,式中的正负号由车辆选择的避障方向确定,如果选择从左侧规避障碍,不等式中的符号为负号;反之,如果选择右侧避障的话,符号为正号;
除避障约束外,路径规划部分还应满足横向位移约束条件,表达式如下:
其中,ymin和ymax表示在k采样时刻的最大和最小横向位移的约束,该约束保证车辆能行驶在车道内;
此外考虑控制输入的约束和控制输入增量约束,以保证控制输入满足执行机构的物理约束和生成轨迹的平滑性要求:
控制输入的约束条件表示为:
控制输入增量约束条件表示为:
控制增量定义如下:
Δv(k)=v(k)-v(k-1)
Δδf(k)=δf(k)-δf(k-1)
其中,vmax(k)和vmin(k)表示在k采样时刻的最大车辆重心处的速度和最小车辆重心处的速度;
步骤3:计算各个时刻的障碍势场Po,障碍势场Po的计算公式如下:
其中,N表示障碍物的个数并且第i个障碍物的避障势场表达式如下:
其中,Ω表示障碍物的作用区域,即势场作用域,该区域由碰撞约束决定,γo表示障碍的收敛系数,do,i(k)表示k时刻车辆距离第i个障碍物的纵向距离,Ao,i表示第i个障碍物的势场幅值;
步骤4:根据实际需求设计局部路径规划代价函数与轨迹跟踪代价函数,其中:
采用模型预测结构构造优化指标如下:
同时,设计轨迹跟踪层代价函数以跟踪上局部规划层计算出的安全参考轨迹,其表达式如下:
其中,Ψt和Ψp分别表示预测状态序列和给定的参考状态序列,代价函数中的第一部分表示期望预测状态能够跟踪上参考状态,第二部分是考虑到乘客舒适性的代价,Ξ和Θ代表着各自部分的系数;
步骤5:利用动态惯性因子粒子群算法的基本步骤求解规划层模型预测控制问题,计算最优控制序列与状态:首先对控制输入进行初始化,保证初始化粒子在整个解空间中随机分布,即在搜索半径内随机分布;结合步骤1-4构造的代价函数优化指标以及车辆的离散运动学模型,采用以下的更新公式对控制量u进行更新,利用步骤4中的局部路径规划代价函数设计粒子的适应度计算公式,迭代循环得到最优粒子,即最优控制量Uopt,以及对应的最优参考状态序列:
其中,p表示粒子,δf和s分别表示前轮的转向角和速度,w表示权重因子,v表示粒子的进化速度,c表示学习因子,r表示0至1之间的随机数,pb表示个体最优值,gb表示全局最优值;当开始进行迭代时,利用后两项公式计算粒子的进化速度,再用前两项公式计算粒子的位置,迭代至最大迭代次数或者满足阈值条件结束求解;采用的改进的粒子群算法使用动态惯性因子,计算公式为:
其中,k表示迭代次数,M表示最大迭代次数,wmax和wmin分别表示惯性因子的最大值和最小值,一般取0.9和0.4;
步骤6:根据步骤5逐步迭代求得规划对应的最优控制输入和参考状态,对求得的最优参考进行四次多项式拟合,以对轨迹跟踪层的参考输入进行平滑处理,在获得每个采样点处平滑后的优化参考后,采用以U′=[U(2:Np),0]作为控制层初始化粒子的初始原点,同时利用预测时域内的道路曲率κ来计算优化的初始值:
其中,rand()表示[-1,1]之间的随机数,MR中m1是与转向角有关的半径参数,m2是与速度有关的半径参数;
步骤7:通过步骤1中的车辆的离散运动学模型预测系统预测时域内的状态,并根据步骤4的轨迹跟踪代价函数求解优化问题,得到最优控制序列;
步骤8:判断是否达到全局目标点,具体为:将最优控制序列中的第一个元素作用于智能车辆,当车辆执行机构执行控制量并进入下一个控制周期时,车辆状态更新,判断是否到达全局目标点,如否,返回步骤3,重复步骤3-8,如是,直至到达目标点,结束循环。
与已有技术相比,本发明的一种递进式模型预测无人驾驶规划跟踪协同控制方法具有以下积极技术效果:
(1)一方面加快了优化求解的收敛速度,另一方面减小了跟踪层优化的搜索空间;
(2)能将控制层的优化时间大大减少;
(3)在采样周期一定的前提下大大减少计算最优解所需的时间,从系统整体角度减小计算负担。通过该方法可以。
附图说明
图1为本发明的一种递进式模型预测无人驾驶规划跟踪协同控制方法整体流程图;
图2为障碍物势场的三维示例图;
图3为障碍物作用区域Ω的平面示例图。
具体实施方式
本发明使用基于运动学模型的模型预测控制方法进行状态预测,并采用动态惯性因子的粒子群算法直接对代价函数进行优化求解。通过该方法保证每一个部分在实现功能的前提下获得更优的解。
在每个系统采样周期内,利用规划层求解的最优控制输入和参考状态为跟踪层优化求解的初始原点,并以预测时域内的道路曲率为基本参数,计算选择跟踪层的最优解的搜索半径,以此减少解的搜索空间。通过该方法可以在采样周期一定的前提下大大减少计算最优解所需的时间。
本发明的一种递进式模型预测无人驾驶规划跟踪协同控制方法,具体步骤如下:
步骤1:建立车辆的离散运动学模型:
其中,k表示采样时刻,表示车辆在全局参考坐标系XOY下的状态向量,[v,δf]T表示控制输入向量,(x,y)表示车辆重心的位置,表示航向角,v表示车辆重心处的速度,δf表示前轮的转向角,L表示车辆轴距;在k采样时刻的
步骤2:确定车辆运行时需要满足的约束条件:为了避免车辆发生碰撞,确定时变安全的避障约束条件,表达式如下:
其中,xr,i和yr,i分别表示无人车与第i个障碍物之间的纵向和横向相对距离,Lx和Ly分别表示纵向和横向安全距离,式中的正负号由车辆选择的避障方向确定,如果选择从左侧规避障碍,不等式中的符号为负号;反之,如果选择右侧避障的话,符号为正号;
除避障约束外,路径规划部分还应满足横向位移约束条件,表达式如下:
其中,ymin和ymax表示在k采样时刻的最大和最小横向位移的约束,该约束保证车辆能行驶在车道内;
此外考虑控制输入的约束和控制输入增量约束,以保证控制输入满足执行机构的物理约束和生成轨迹的平滑性要求:
控制输入的约束条件表示为:
控制输入增量约束条件表示为:
控制增量定义如下:
Δv(k)=v(k)-v(k-1)
Δδf(k)=δf(k)-δf(k-1)
其中,vmax(k)和vmin(k)表示在k采样时刻的最大车辆重心处的速度和最小车辆重心处的速度;
步骤3:计算各个时刻的障碍势场Po,障碍势场Po的计算公式如下:
其中,N表示障碍物的个数并且第i个障碍物的避障势场表达式如下:
其中,Ω表示障碍物的作用区域,即势场作用域,该区域由碰撞约束决定,γo是障碍的收敛系数,do,i(k)表示k时刻车辆距离第i个障碍物的纵向距离。Ao,i是第i个障碍物的势场幅值;
步骤4:根据实际需求设计局部路径规划代价函数与轨迹跟踪代价函数。局部路径规划代价函数用以得到一条无碰撞的路径,本发明结合人工势场法的思想,采用模型预测结构构造优化指标如下:
同时,设计轨迹跟踪层代价函数以跟踪上局部规划层计算出的安全参考轨迹,其表达式如下:
其中,Ψt和Ψp分别表示预测状态序列和给定的参考状态序列。代价函数中的第一部分表示期望预测状态能够跟踪上参考状态。第二部分是考虑到乘客舒适性的代价,即期望预测的控制输入变化尽可能小,保证控制动作的平顺性。Ξ和Θ代表着各自部分的系数,某一参数相较于另一参数越大,就代表着该项性能要求越高,同时该部分只需要满足式(4a)和(4b)描述的控制量与控制增量约束即可,不需要考虑可行驶区域安全约束;
步骤5:利用动态惯性因子粒子群算法的基本步骤求解规划层模型预测控制问题,计算最优控制序列与状态:首先对控制输入进行初始化,保证初始化粒子在整个解空间中随机分布,即在搜索半径内随机分布;结合步骤1-4构造的代价函数优化指标以及车辆的离散运动学模型,采用以下的更新公式对控制量u进行更新,利用步骤4中的局部路径规划代价函数设计粒子的适应度计算公式,迭代循环得到最优粒子,即最优控制量Uopt,以及对应的最优参考状态序列:
其中,p表示粒子,δf和s分别表示前轮的转向角和速度,w表示权重因子,v表示粒子的进化速度,c表示学习因子,r表示0至1之间的随机数,pb表示个体最优值,gb表示全局最优值;当开始进行迭代时,利用后两项公式计算粒子的进化速度,再用前两项公式计算粒子的位置,迭代至最大迭代次数或者满足阈值条件结束求解;采用的改进的粒子群算法使用动态惯性因子,其计算公式为:
其中,k表示迭代次数,M表示最大迭代次数,wmax和wmin分别表示惯性因子的最大值和最小值,一般取0.9和0.4;
步骤6:根据步骤5逐步迭代求得规划对应的最优控制输入和参考状态,对求得的最优参考进行四次多项式拟合,以对轨迹跟踪层的参考输入进行平滑处理,在获得每个采样点处平滑后的优化参考后,采用以U′=[U(2:Np),0]作为控制层初始化粒子的初始原点,同时利用预测时域内的道路曲率κ来计算优化的初始值:
其中,rand()表示[-1,1]之间的随机数,MR中m1是与转向角有关的半径参数,m2是与速度有关的半径参数,需要根据实际调整。由于应用场景的特殊性,所求得的半径将远小于步骤5中的初始化半径,解空间大小也远小于步骤5,在采样周期相同的情况下,优化求解的速度将大幅度提高;
步骤7:通过步骤1中的车辆的离散运动学模型预测系统预测时域内的状态,并根据步骤4的轨迹跟踪代价函数求解优化问题,得到最优控制序列;
步骤8:判断是否达到全局目标点,具体为:将最优控制序列中的第一个元素作用于智能车辆,当车辆执行机构执行控制量并进入下一个控制周期时,车辆状态更新,判断是否到达全局目标点,如否,返回步骤3,重复步骤3-8,如是,直至到达目标点,结束循环。
本发明在规划和控制两个层面均使用当前应用广泛且作用效果表现较好的MPC方法,在规划层能得到光滑且满足约束的路径,跟踪层能够计算出使得车辆能快速准确跟踪上参考给定的控制量。
以上所述的具体实施例,对本发明的目的、技术方案和有益效果进行了进一步详细说明,所应理解的是,以上所述仅为本发明的具体实施例而已,并不用于限制本发明,凡在本发明的精神和原则之内,所做的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (1)
1.一种递进式模型预测无人驾驶规划跟踪协同控制方法,其特征在于,该方法包括以下步骤:
步骤1:建立车辆的离散运动学模型:
其中,k表示采样时刻,表示车辆在全局参考坐标系XOY下的状态向量,[v,δf]T表示控制输入向量,(x,y)表示车辆重心的位置,表示航向角,v表示车辆重心处的速度,δf表示前轮的转向角,L表示车辆轴距;
步骤2:确定车辆运行时需要满足的约束条件:为了避免车辆发生碰撞,确定时变安全的避障约束条件,表达式如下:
其中,xr,i和yr,i分别表示无人车与第i个障碍物之间的纵向和横向相对距离,Lx和Ly分别表示纵向和横向安全距离,式中的正负号由车辆选择的避障方向确定,如果选择从左侧规避障碍,不等式中的符号为负号;反之,如果选择右侧避障的话,符号为正号;
除避障约束外,路径规划部分还应满足横向位移约束条件,表达式如下:
其中,ymin和ymax表示在k采样时刻的最大和最小横向位移的约束,该约束保证车辆能行驶在车道内;
此外考虑控制输入的约束和控制输入增量约束,以保证控制输入满足执行机构的物理约束和生成轨迹的平滑性要求:
控制输入的约束条件表示为:
控制输入增量约束条件表示为:
控制增量定义如下:
Δv(k)=v(k)-v(k-1)
Δδf(k)=δf(k)-δf(k-1)
其中,vmax(k)和vmin(k)表示在k采样时刻的最大车辆重心处的速度和最小车辆重心处的速度;
步骤3:计算各个时刻的障碍势场Po,障碍势场Po的计算公式如下:
其中,N表示障碍物的个数并且第i个障碍物的避障势场表达式如下:
其中,Ω表示障碍物的作用区域,即势场作用域,该区域由碰撞约束决定,γo表示障碍的收敛系数,do,i(k)表示k时刻车辆距离第i个障碍物的纵向距离,Ao,i表示第i个障碍物的势场幅值;
步骤4:根据实际需求设计局部路径规划代价函数与轨迹跟踪代价函数,其中:
采用模型预测结构构造优化指标如下:
同时,设计轨迹跟踪层代价函数以跟踪上局部规划层计算出的安全参考轨迹,其表达式如下:
其中,Ψt和Ψp分别表示预测状态序列和给定的参考状态序列,代价函数中的第一部分表示期望预测状态能够跟踪上参考状态,第二部分是考虑到乘客舒适性的代价,Ξ和Θ代表着各自部分的系数;
步骤5:利用动态惯性因子粒子群算法的基本步骤求解规划层模型预测控制问题,计算最优控制序列与状态:首先对控制输入进行初始化,保证初始化粒子在整个解空间中随机分布,即在搜索半径内随机分布;结合步骤1-4构造的代价函数优化指标以及车辆的离散运动学模型,采用以下的更新公式对控制量u进行更新,利用步骤4中的局部路径规划代价函数设计粒子的适应度计算公式,迭代循环得到最优粒子,即最优控制量Uopt,以及对应的最优参考状态序列:
其中,p表示粒子,δf和s分别表示前轮的转向角和速度,w表示权重因子,v表示粒子的进化速度,c表示学习因子,r表示0至1之间的随机数,pb表示个体最优值,gb表示全局最优值;当开始进行迭代时,利用后两项公式计算粒子的进化速度,再用前两项公式计算粒子的位置,迭代至最大迭代次数或者满足阈值条件结束求解;采用的改进的粒子群算法使用动态惯性因子,计算公式为:
其中,k表示迭代次数,M表示最大迭代次数,wmax和wmin分别表示惯性因子的最大值和最小值;
步骤6:根据步骤5逐步迭代求得规划对应的最优控制输入和参考状态,对求得的最优参考进行四次多项式拟合,以对轨迹跟踪层的参考输入进行平滑处理,在获得每个采样点处平滑后的优化参考后,采用以U′=[U(2:Np),0]作为控制层初始化粒子的初始原点,同时利用预测时域内的道路曲率κ来计算优化的初始值:
其中,rand()表示[-1,1]之间的随机数,MR中m1是与转向角有关的半径参数,m2是与速度有关的半径参数;
步骤7:通过步骤1中的车辆的离散运动学模型预测系统预测时域内的状态,并根据步骤4的轨迹跟踪代价函数求解优化问题,得到最优控制序列;
步骤8:判断是否达到全局目标点,具体为:将最优控制序列中的第一个元素作用于智能车辆,当车辆执行机构执行控制量并进入下一个控制周期时,车辆状态更新,判断是否到达全局目标点,如否,返回步骤3,重复步骤3-8,如是,直至到达目标点,结束循环。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010169826.6A CN111413966B (zh) | 2020-03-12 | 2020-03-12 | 一种递进式模型预测无人驾驶规划跟踪协同控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010169826.6A CN111413966B (zh) | 2020-03-12 | 2020-03-12 | 一种递进式模型预测无人驾驶规划跟踪协同控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111413966A CN111413966A (zh) | 2020-07-14 |
CN111413966B true CN111413966B (zh) | 2022-04-29 |
Family
ID=71494200
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010169826.6A Active CN111413966B (zh) | 2020-03-12 | 2020-03-12 | 一种递进式模型预测无人驾驶规划跟踪协同控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111413966B (zh) |
Families Citing this family (27)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111884554B (zh) * | 2020-08-07 | 2021-10-15 | 吉林大学 | 永磁同步电机驱动系统延寿和转矩精确控制方法 |
CN113625702B (zh) * | 2020-10-28 | 2023-09-22 | 北京科技大学 | 基于二次规划的无人车同时路径跟踪与避障方法 |
CN114442601B (zh) * | 2020-11-06 | 2024-06-18 | 宇通客车股份有限公司 | 一种无人驾驶车辆跟踪控制方法及装置 |
CN114516342B (zh) * | 2020-11-19 | 2024-05-03 | 上海汽车集团股份有限公司 | 一种车辆控制方法、装置及车辆 |
CN114594756A (zh) * | 2020-11-30 | 2022-06-07 | 上海交通大学 | 动态障碍环境下的多车协同编队控制方法、终端及介质 |
CN112477880B (zh) * | 2020-11-30 | 2022-05-20 | 天津大学 | 一种无人驾驶汽车纵向控制方法 |
CN112666975B (zh) * | 2020-12-18 | 2022-03-29 | 中山大学 | 一种基于预测控制和屏障函数的无人机安全轨迹跟踪方法 |
CN112622932B (zh) * | 2020-12-23 | 2022-02-01 | 同济大学 | 一种基于势能场启发式搜索的自动驾驶换道轨迹规划算法 |
CN114690754B (zh) * | 2020-12-25 | 2024-02-09 | 天津大学 | 重复作业式无人车迭代学习自趋优的循迹控制算法 |
CN112706760B (zh) * | 2021-01-15 | 2022-04-22 | 北京航空航天大学 | 一种用于特殊道路场景的无人驾驶泊车路径规划方法 |
CN112904868B (zh) * | 2021-01-29 | 2022-09-13 | 中国人民解放军军事科学院战争研究院 | 一种基于同构化-跟踪的多舰载异构体舰面协同轨迹规划与控制方法 |
CN113008222B (zh) * | 2021-02-20 | 2023-03-31 | 西北工业大学 | 一种基于连续时间轨迹函数的航迹约束目标跟踪方法 |
CN112947492B (zh) * | 2021-04-14 | 2023-09-22 | 北京车和家信息技术有限公司 | 车辆控制方法、装置、存储介质、电子设备及车辆 |
CN113110468B (zh) * | 2021-04-22 | 2022-07-26 | 中国船舶重工集团公司第七0七研究所九江分部 | 一种应用于欠驱动双桨双舵船舶自主靠泊的控制方法 |
CN113110489B (zh) * | 2021-04-30 | 2023-03-10 | 清华大学 | 一种轨迹规划方法、装置、电子设备和存储介质 |
CN113704889B (zh) * | 2021-08-25 | 2024-05-03 | 深圳亿嘉和科技研发有限公司 | 一种液压转向阿克曼底盘的控制方法及其应用 |
CN113619604B (zh) * | 2021-08-26 | 2023-08-15 | 清华大学 | 自动驾驶汽车的集成式决控方法、装置及存储介质 |
CN114280939B (zh) * | 2021-12-27 | 2023-12-22 | 中国联合网络通信集团有限公司 | 一种模型预测控制方法、装置、设备及存储介质 |
CN114625121A (zh) * | 2022-01-24 | 2022-06-14 | 成都理工大学 | 基于多传感器融合的自主巡检探索小车系统及导航方法 |
CN114568108B (zh) * | 2022-02-28 | 2022-11-11 | 清华大学深圳国际研究生院 | 一种无人割草机轨迹跟踪控制方法及计算机可读存储介质 |
CN114721412B (zh) * | 2022-03-16 | 2023-06-16 | 北京理工大学 | 一种基于模型预测控制的无人机轨迹跟踪避障方法 |
CN114415694B (zh) * | 2022-03-28 | 2022-08-19 | 北京理工大学 | 一种面向自动驾驶车辆的实时轨迹规划方法及系统 |
CN114995425B (zh) * | 2022-06-02 | 2024-05-07 | 航天时代(青岛)海洋装备科技发展有限公司 | 一种基于时间最优与能量最优的无人艇自主跟踪方法 |
CN115562261B (zh) * | 2022-09-26 | 2024-05-10 | 北京理工大学 | 一种基于工作流的车辆运动学轨迹跟踪模型预测控制方法 |
CN115454086A (zh) * | 2022-09-27 | 2022-12-09 | 江苏大学 | 一种基于模型预测控制算法的车辆主动避撞控制方法 |
CN115309170B (zh) * | 2022-10-12 | 2023-03-24 | 之江实验室 | 一种考虑舒适性约束的轨迹规划方法、装置和系统 |
CN116540527B (zh) * | 2023-05-12 | 2024-02-06 | 中国矿业大学 | 一种矿用卡车模型预测变速轨迹跟踪控制方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107662211A (zh) * | 2017-10-16 | 2018-02-06 | 西北工业大学 | 一种基于量子粒子群算法的空间机器人预测控制方法 |
CN108646734A (zh) * | 2018-04-27 | 2018-10-12 | 天津大学 | 基于量子粒子群算法的非线性模型预测控制方法 |
CN108873894A (zh) * | 2018-06-11 | 2018-11-23 | 上海大学 | 一种基于多无人艇的目标跟踪协同控制系统和方法 |
CN109582027A (zh) * | 2019-01-14 | 2019-04-05 | 哈尔滨工程大学 | 一种基于改进粒子群优化算法的usv集群避碰规划方法 |
CN109871032A (zh) * | 2019-03-04 | 2019-06-11 | 中科院成都信息技术股份有限公司 | 一种基于模型预测控制的多无人机编队协同控制方法 |
CN109884900A (zh) * | 2019-04-03 | 2019-06-14 | 东南大学 | 基于自适应模型预测控制的收获机路径跟踪控制器的设计方法 |
-
2020
- 2020-03-12 CN CN202010169826.6A patent/CN111413966B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107662211A (zh) * | 2017-10-16 | 2018-02-06 | 西北工业大学 | 一种基于量子粒子群算法的空间机器人预测控制方法 |
CN108646734A (zh) * | 2018-04-27 | 2018-10-12 | 天津大学 | 基于量子粒子群算法的非线性模型预测控制方法 |
CN108873894A (zh) * | 2018-06-11 | 2018-11-23 | 上海大学 | 一种基于多无人艇的目标跟踪协同控制系统和方法 |
CN109582027A (zh) * | 2019-01-14 | 2019-04-05 | 哈尔滨工程大学 | 一种基于改进粒子群优化算法的usv集群避碰规划方法 |
CN109871032A (zh) * | 2019-03-04 | 2019-06-11 | 中科院成都信息技术股份有限公司 | 一种基于模型预测控制的多无人机编队协同控制方法 |
CN109884900A (zh) * | 2019-04-03 | 2019-06-14 | 东南大学 | 基于自适应模型预测控制的收获机路径跟踪控制器的设计方法 |
Non-Patent Citations (2)
Title |
---|
Fast Nonlinear Model Predictive Control Parallel Design Using QPSO and Its Applications on Trajectory Tracking of Autonomous Vehicles;Zuo, Zhiqiang 等;《Proceedings of the 2018 13th World Congress on Intelligent Control and Automation》;20180708;222-227 * |
基于滚动时域的无人机动态航迹规划;王文彬 等;《智能系统学报》;20180831;第13卷(第04期);525-533 * |
Also Published As
Publication number | Publication date |
---|---|
CN111413966A (zh) | 2020-07-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111413966B (zh) | 一种递进式模型预测无人驾驶规划跟踪协同控制方法 | |
CN107561942B (zh) | 基于模型补偿的智能车辆轨迹跟踪模型预测控制方法 | |
CN110989576B (zh) | 速差滑移转向车辆的目标跟随及动态障碍物避障控制方法 | |
CN112677995B (zh) | 一种车辆轨迹规划方法、装置、存储介质及设备 | |
CN109017778B (zh) | 四轮独立驱动车辆的期望路径主动转向控制方法 | |
CN113320542B (zh) | 一种自动驾驶车辆的跟踪控制方法 | |
CN113515125A (zh) | 一种无人驾驶汽车全工况避障控制方法及性能评价方法 | |
CN114460936B (zh) | 基于离线增量学习的自动驾驶汽车路径规划方法及系统 | |
CN114510063B (zh) | 一种无人履带车辆及其轨迹跟踪控制方法和系统 | |
CN111538328A (zh) | 一种用于自主驾驶车辆避障轨迹规划与跟踪控制的优先级分层预测控制方法 | |
CN109017446B (zh) | 期待路径车辆纵向速度追踪控制方法及装置 | |
CN114684199A (zh) | 一种机理分析-数据驱动的车辆动力学串联混合模型、智能汽车轨迹跟踪控制方法及控制器 | |
Obayashi et al. | Real-time autonomous car motion planning using NMPC with approximated problem considering traffic environment | |
CN113485323B (zh) | 一种级联多移动机器人灵活编队方法 | |
Huy et al. | A practical and optimal path planning for autonomous parking using fast marching algorithm and support vector machine | |
Regier et al. | Improving navigation with the social force model by learning a neural network controller in pedestrian crowds | |
Zamani et al. | Feedback motion planning of legged robots by composing orbital lyapunov functions using rapidly-exploring random trees | |
Xi et al. | MPC based motion control of car-like vehicle swarms | |
CN116700288A (zh) | 一种基于自适应模型预测控制的移动机器人局部轨迹规划方法及系统 | |
CN116560375A (zh) | 基于神经网络观测器的轮式移动机器人轨迹跟踪控制方法 | |
Tao et al. | Path following of autonomous vehicles with an optimized brain emotional learning–based intelligent controller | |
Shen et al. | An Efficient Global Trajectory Planner for Highly Dynamical Nonholonomic Autonomous Vehicles on 3D Terrains | |
Wang et al. | Path planning for mobile robot using fuzzy controllers with artificial potential field | |
CN115857483A (zh) | 一种基于控制障碍函数模型预测控制算法的无人船避障控制方法 | |
Ma et al. | Self-learning sliding mode control based on adaptive dynamic programming for nonholonomic mobile robots |
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 |