自动驾驶之无人驾驶车辆与模型预测控制

无人驾驶车辆

无人车辆( Unmanned Vehicle),根据其行驶环境的不同,可以分为空中无人机( Unmanned Aerial Vehicle)、水面无人艇( Unmanned Surface Vehicle)、水下无人潜水器( Unmanned Underwater Vehicle)和地面无人车辆( Unmanned Ground Vehicle)。

补充：

遥操作无人车辆不等同于完全的遥控车辆,而是在自主行驶无人车辆基础上**,增加了人在回路的任务决策、环境感知与规划、控制等功能**,是一种提升自主无人车辆控制能力的人机交互方式,或者被称为人在回路的决策、规划与控制方法

无人车辆系统分为任务决策、环境感知、路径规划,以及车辆控制与平台4个子系统。

(1)任务决策子系统

无人车辆在任务决策与规划时,任务完成往往与车辆平台全局路径规划是关联的。

任务决策与规划是一种动态规划,需要根据任务和全局环境信息的变化进行调整。以完成侦察任务为例,无人车辆需要遍历侦察区域,同时需要规划出遍历这些区域的最短或最经济全局路径。

(2)环境感知子系统

环境信息一般可以通过以下两种途径获得:一是通过无人车辆环境感知子系统利用车载传感器系统获取行驶环境信息,结合环境模型对传感器信息进行融合,理解和识別行驶环境;二是通过通信网络提供的外部环境信息,例如车联网给无人驾驶车辆提供的前方道路拥堵情况和周围车辆行驶趋势,路基交通设施发送的路口交通信号灯情况和变化趋势,或者地面指挥系统给无人机提供的大范围空域环境信息。

环境感知是无人车辆可靠行驶的关键。

以行驶在城市环境的无人驾驶车辆为例,如果不依赖外部网络提供的环境信息,独立的无人驾驶车辆需要识别行驶道路及与交通规则相关的各类环境信息,包括车道线以及无车道线情况下的道路识别、路沿检测、交通标识与信号灯检测,以及行人、车辆检测等,而且要综合多种道路交通要素对比较复杂的环境进行理解,为路径规划子系统提供行驶区域信息和障碍物信息。

(3)路径规划子系统

路径规划( Path Planning)是指在具有障碍物的环境中,按照一定的评价标准,比如路径长度最短或能量消耗最少原则等,寻找一条从起始状态到目标状态的无碰撞路径。

一般分为全局路径规划和局部路径规划。

全局路径规划功能同时也被视为任务决策规划的一部分。在大多数情况下,无人系统全局路径规划和任务决策与规划是相联系的,二者结合得到无人车辆的全局路径信息;而局部路径规划则是在无人车辆周围局部环境里进行的。全局路径规划是在地图已知的情况下,利用已知局部信息,如障碍物位置和道路边界,确定可行和最优的路径;但是当环境发生变化,如出现未知障碍物时,就必须通过局部路径规划来生成无人车辆的局部行驶路径或轨迹。

局部路径规划是在全局路径引导下,依据传感器感知到的局部环境信息来实时生成车辆所需要行驶的路径。在规划过程中不仅要考虑影响当前任务完成的最优原则,如路径最短、能源消耗最少,或者车辆最安全等,而且还要考虑动态环境带来的约束问题。

路径规划技术的研究重点主要包括环境建模和路径搜索策略两个子问题,如图1.1所示。

路径规划与障碍物环境信息密切相关,因此障得物环境的建模方法是路径规划问题研究中的一个关键问题。目前,最常用的3种环境建模方法是单元分解法( Cell Decomposition)、道路图法( Roadmap)和人工势场法Potential Fields)。

其中人工势场法在实时避障方面具有独特优势。在此基础上,又提出了虚拟力场法( Virtual Force Fields,VFF)、矢量场直方图法Vector Field Histogram,VFH)和向量极坐标直方图法( Vector Polar Histogram,VPH)。这些方法在机器人和无人车辆障得规避方面得到大量应用。

局部路径规划过程中,还需要考虑的一个重要问题是运动规划( Motion Planning),即局部路径规划要满足无人车辆的运动学与动力学约束条件。

文献[16]提出的满足无人车辆运动微分约束的纵横向协同规划算法就是一种典型的局部路径规划的运动规划方法。

[16]姜岩,龚建伟,熊光明,陈慧岩.基于运动微分约束的无人车辆纵横向协同规划算法的研究[J].自动化学报,2013,39(12):2012-2020

将模型预测控制理论应用在无人车辆运动规划时,也将重点探索该方法在处理运动学和动力学约束的途径。

(4)车辆平台控制子系统

车辆控制主要是控制车辆平台跟踪路径规划子系统得到的路径,也即车辆的横向与纵向控制。

和机器人控制一样,无人车辆也存在着路径(Path)与轨迹( Trajectory)的区分。约定轨迹是路径的一种,即同时考虑空间和时间因素的路径。

路径跟踪实质是通过控制车辆的运动来减少车辆与参考路径之间的空间上的误差。如果考虑轨迹,则还包括时间误差。因模型预測控制重点应用在跟踪控制方法中,后续章节将继续对这一点进行详细说明。

设计要求

车辆平台是无人车辆的重要组成部分。环境感知、决策规划及控制必须与车辆平台进行一体化设计。各种无人车辆在行驶环境中,以较高速度行驶时,都会与环境发生相互作用,这时车辆动力学与运动学特性就会影响到环境感知、决策规刘和控制效果。以最为复杂的地面无人车辆为例,高速行驶的车辆执行机构的控制输入、轮胎与地面摩擦引起的滑移、横向加速度引起的侧倾等动力学非线性约束条件比低速时更加苛刻。

因此,无人车辆一方面要在运动规划阶段计算出满足车辆动力学和运动学约束的无碰撞运动轨迹,另一方面需要在跟踪阶段生成满足非线性动力学约束和执行机构极限约束的控制量。

考虑乘坐舒适性的无人驾驶车辆

选择有人乘坐的无人驾驶车辆( Self-driving Vehicle)的原因:这类车辆的运动学模型和动力学模型都比较成熟,在仿真软件 Carsim和 Adams中都有相应的模型,便于我们重点介绍模型预測控制理论在无人驾驶车辆控制中的应用。

路径跟踪( Path Following)与轨迹跟踪( Trajectory Tracking)

路径规划和轨迹规划

无人车辆也存在着路径(Path)与轨迹( Trajectory)的区分。约定轨迹是路径的一种,即同时考虑空间和时间因素的路径。

路径与轨迹延续了机器人控制的概念。

对于无人车辆来说,全局路径点只要包含空间位置信息即可,也可以包含姿态信息,而不需要与时间相关,但局部规划时,则可以考虑时间信息。

这里规定轨迹点也是一种路径点,即当路径点信息中加入了时间约束,就可以被称为轨迹点。

从这个角度理解,轨迹规划就是一种路径规划,当路径规划过程要满足无人车辆的纵向和横向动力学约束时,就成为轨迹规划。

路径规划与轨迹规划既可以在状态空间中表示,也可以在笛卡尔坐标系中表示。

状态空间中表示：

[15]张浩杰,龚建伟,姜岩,熊光明,陈慧岩.基于变维度状态空间的增量启发式路径规划方法研究「J].自动化学报,2013,39(10):1602-1610

笛卡尔坐标系中表示：

[16]姜岩,龚建伟,熊光明,陈慧岩.基于运动微分约束的无人车辆纵横向协同规划算法的研究[J].自动化学报,2013,39(12):2012-2020

文献[16]提出一种基于运动微分约束的无人车辆纵、横向协同规划算法,实际上考虑了无人车辆通过某一路径点的速度要求,是一种轨迹规划算法。

无人车辆纵向速度规划与时间密切相关,而车辆横向动力学对纵向速度的影响非常大。

路径跟踪和轨迹跟踪

路径跟踪过程中,参考路径( Reference Path)曲线可与时间参数无关,跟踪控制时,可以假设无人车辆以当前速度匀速前进,以一定的代价规则形成行驶路径趋近于参考路径;

而轨迹跟踪时,参考路径曲线与时间和空间均相关,并要求无人车辆在规定的时间内到达某一预先设定好的参考路径点。

路径跟踪不同于轨迹跟踪,不受制于时间约束,只需要在一定误差范围内跟踪期望路径。路径跟踪中的运动控制就是寻找一个有界的控制输入序列,以使无人车辆从一个初始位形到设定的期望位形。

文献「26]指出,无人车辆系统是一个欠驱动的非完整约束系统,同时也是一个零动力学系统。轨迹跟踪问