一文读懂智能汽车轨迹跟踪控制方法

智驾最前沿 2023-06-07 08:45

--关注、星标、回复“40429”--

↓↓领取:《汽车驾驶自动化分级》(GB/T 40429-2021)↓↓

背景
1.1 国内智能车研究现状
我国智能驾驶车辆起源于1980年,然而在1992年国防科技大学研发真正第一辆智能车。2003年,清华大学研发的THMR-V可在清晰的车道线上完成车道保持,而且它的最高时速可达到150km/h,如图1所示。
图1 中国自主研发智能驾驶车辆

近几年来随着智能驾驶在全球范围内的不断发展与兴起,我国无论是高校还是企业都在大力发展智能驾驶技术。在2011年,国防科技大和一汽研发的红旗无人驾驶汽车HQ3实现了从长沙到武汉的无人驾驶,标志着我国在无人驾驶方面取得了标志性的进展。2015年12月,百度联合宝马的百度自主车在北京从百度大厦出发,然后绕城到奥林匹克森林公园,最后返回百度大厦。

从2015年至今,我国国内的智能驾驶发展在呈爆炸式增长。无论是高校、新兴造车品牌、乘用车、专用车智能驾驶、L4级智能驾驶科技公司、无人配送车、商用车智能驾驶、农机智能驾驶以及矿区智能驾驶正在国内快速发展。诸如新兴品牌的蔚来汽车、理想汽车、小鹏汽车以及传统乘用车的奔驰、大众、比亚迪、丰田等等都在结合自己的优势,并且大力发展智能驾驶技术,同时这些企业已经取得了一定不俗的成绩,如图2所示。从2017年,百度Apollo开发了智能驾驶软件研发平台之后,Apollo生态已经发展的如火如荼。

图2 国内部分智能驾驶行业

1.2 智能车换道避障运动控制研究现状

对于车辆换道避障来说,换道是前方车辆行驶车速较慢或者车辆处于静止状态,同时旁边车道无切入行为,本车行驶行为无法满足自身需求便产生了换道过程。针对车辆在行驶过程中的换道请求,智能驾驶域控制器通过CAN通信接收模块采集上层传感器信息包含了GPS导航系统、IMU惯性传感器、超声波雷达、激光雷达以及摄像头等传感器信息,并进行数据处理,从而得到最为合适的换道行为并基于车道线规划出一条最优路径。下层控制算法可根据行为决策结果和最优路径,实时求解出方向盘转角并通过CAN通信发送给线控转向系统,从而完成车辆的换道过程。

欢迎关注「智驾最前沿」微信视频号

运动控制作为智能车研究关键领域之一,它需要依据周围环境、车辆状态、车速以及车身位姿等信息做出一定的决策,为车辆的驱动、制动以及转向等执行器机构提供一些输入信号,使得车辆可以按照要求进行安全行驶。它主要包含了横向控制和纵向控制,通常以乘客乘坐的舒适性、安全性和车身稳定性作为最为关键的三大指标。其中车辆运动控制器主要包含了车辆模型建立、横向偏差和航向偏差的生成以及控制量等几方面。一般来说车辆模型包含了运动学模型、几何学模型以及动力学模型。目前使用最为广泛的控制方法有:经典控制(PID为例)、最优控制、自适应控制、模型预测控制。

PID控制器是智能驾驶领域应用极具广泛的控制算法之一,通常以原理简单容易实现被智能驾驶行业所熟知。2005年的DARPA挑战赛上,Thrun S等设计了PID反馈加曲率前馈的非线性控制器,使得横向偏差收敛至有界值。赵熙俊等利用鲁棒PID反馈控制方法设计了方位偏差估计器实现车辆较好的跟踪效果。

LQR(Linear Quadratic Regulator)是使用最为广泛的线性最优控制器。2000年,Sharp提出离散化最优预瞄理论车辆横向LQR控制器建模方法,并实现了车辆良好跟车效果。Park K等为了提高车辆在临界状态下横向稳定性,利用LQR对状态反馈进行估计,并利用非线性观测器对车身侧滑角进行估计,从而得到良好的控制效果。Yang T等提出了前馈+预测LQR的横向控制方法,能较好地适应复杂工况下智能车辆横向跟踪控制问题。LQR方法针对线性系统有效,同时忽略了系统的各类约束条件。

模型预测控制方法可根据不同对象和研究目标考虑各种不同的约束条件,非常善于处理非线性系统和含输入输出约束的各类复杂控制问题。Cheng S等提出一种基于模型预测控制方法的横向稳定协调碰撞系统,该系统基于车辆动力学来控制车辆的正常驾驶模式、全自动模式和稳定模式等,实验结果表明该系统具有良好的性能。Gutjahr B等采用线性时变模型预测方案同时结合二次代价函数实现了静态障碍物和动态障碍物的避障,该种方法可适用于不同场景比如静止车辆以及高速公路上动态车辆。Falcone P等提出利用MPC控制转向和制动的路径跟踪方案,它的控制目标是制动和转向联合实现一个较为理想的避障操纵路径。

2000年,Choi S B 等利用李雅普诺夫准则提出车辆的横向自适应控制器,搭建用于实时观测反馈参数的横向位移测量器,实验数据说明该控制器具有较强的鲁棒性。在2007年的DARPA挑战赛上,斯坦福大学团队设计了具有学习能力的自适应控制器,并且取得了亚军。Norouzi A等在车辆的换道横向控制中加入了自适应控制,为了防止车辆在行驶过程中的抖动问题。


智能车运动学模型及应用

2.1 引言

路径跟踪通过控制转向角度,实时对规划轨迹进行跟踪。车辆在进行路径跟踪过程中不仅仅要保证跟踪效果具有一定的准确性,同时从驾驶员和乘客的角度出发更要保证车辆在行驶过程中的稳定性及舒适性。

路径跟踪的控制算法现阶段较多,其中包括:基于道路几何原理的控制算法,如纯跟踪控制、Stanley控制、Alice控制等;基于经典控制理论的路径跟踪控制算法,如PID控制、线性反馈控制等;基于现代控制理论的路径跟踪控制算法,如MPC控制、LQR控制等。为了选出最为合适的控制方法确保智能车在行驶过程中的安全性、舒适性和稳定性,本文在车辆坐标系下进行了车辆的运动学建模,同时选择三种不同的控制算法使得车辆在同一环境场景下针对三种不同的评价指标进行对比,从而选出最为合适的控制算法。

图3运动学模型及应用示意图

2.2 车辆运动学建模

车辆运动学模型如图4(a)所示。在惯性坐标系XOY下,和分别是车辆前轴和后轴的轴心坐标,为车辆的横摆角,为前轮转角,为车辆的后轴中心速度,L为汽车轴距。车辆前轮转向示意图如图4(b)所示,其中M为后轴中心,N为前轴中心,为后轮转向半径,P为车辆瞬动中心。

由上图车辆运动学模型可知在后轴的速度为:
其中前后轴运动学约束为:

由(1)和(2)联合可得:

由前后轮几何关系得:

将(3)和(4)代入(2)可得:

由上式(3)和(5)可以得出车辆的运动学模型:

2. 3 基于LQR控制算法路径跟踪设计

2.3.1 运动学状态空间模型推导

基于车辆运动学模型(6),可将车辆运动学系统看作成一个输入以及状态参数的控制系统。可表示为:
在车辆控制系统中,期望轨迹可表示为:

上式中将公式(7)在处进行泰勒式展开,忽略最高项,可得:
式(9)与式(8)相互做差得:
即线性化之后的路径跟踪误差模型为:

进一步处理得:

2.3.2 LQR控制器设计

针对被控对象其线性表达式为:
采用二次型性能来描述最优控制问题:
上式中为半正定加权矩阵,为对称正定矩阵。其中最优控制的目标是对于给定系统在保证一定性能指标下,设计一个控制器,使得最小。
为了使性能指标最小化,需要具有以下线性反馈形式:
将(14)代入(12)中可得:
如果所设计的系统是渐近稳定的,则矩阵所有特征值具有负实部,根据Lyapunov稳定性定理可得式(15)必然存在正定对称矩阵的二次型Lyapunov函数为可得:
通过方程式变化可得:

最终对上述公式进行变化可得:

在求取最优控制问题过程中,需要选择一个最为合适的增益矩阵,可使得其性能指标最小化。由式(16)可得只有依赖,且非负,当且仅当可以找到一个对称矩阵,满足Riccati方程:
此时最优状态反馈控制器:

闭环方程为:

可证明:

由上式可证明最优状态反馈控制器

是稳定的。

车辆运动学模型(11)建立之后,可得车辆的运动状态空间方程如式(20)。LQR控制器无法处理

多变量的控制约束问题。即本文不考虑车辆在跟踪路径过程中的其他约束。

上式

为车辆在路径跟踪过程中当前状态下的状态量与期望位置状态量的偏差大小,是函数关于的雅可比矩阵。定义指标:
其中为加权矩阵,为结束位置下的加权矩阵,车辆在时刻的估计状态为;车辆在期望路径上第个目标点状态为;车辆在时刻下的控制参量为。对无约束优化问题进行构造,引入拉格朗日乘子:
构造哈密顿函数:

将式(23)代入(22)得:

当评价函数最小时,函数满足:
由式(22)可得:

根据公式(24),假设:

由公式(21)、公式(24)和公式(27)得:

已知通过后迭代处理得最优反馈控制状态量:
LQR控制器最优控制量:

上式中为前馈控制量,为反馈控制量。

2.4 仿真分析

利用Simulink和Prescan进行联合仿真,其中,设定车辆初始时刻和终止时刻行驶过程中车速为,路面附着系数,单车道路宽度
为了验证本章节所搭建的运动学模型,本文利用三种不同控制方法(PID、Stanley、LQR)实现了车辆的路径跟踪算法设计,并且针对车辆三个性能指标(舒适性、安全性、可靠性)进行分析如图5所示。
图5 三种控制方法对比分析图

由上图5可知,针对PID、Stanley和LQR三种不同的控制方法分别从车辆的横向误差、横向加速度和横摆角速度来评判车辆的安全性、舒适性和稳定性。其中,基于经典控制理论的PID路径跟踪控制安全性较好,舒适性中等,稳定性较差;基于道路几何原理的Stanley路径跟踪控制安全性较差,舒适性较好,稳定性较差;基于现代控制理论的LQR路径跟踪控制安全性较好,舒适性中等,稳定性较好。

2.5 小结

车辆横向运动过程中最为主要的评价指标为安全性、稳定性和舒适性。从这三种评价指标入手,构建车辆运动学模型利用三种不同控制算法在同一道路工况进行路径跟踪仿真测试。测试结果表明:基于现代控制理论的LQR控制算法相对PID控制来说稳定性较好且调试过程方便简单;相对基于道路几何的Stanley来说安全性和稳定性较好。

转载自智能运载装备研究所,文中观点仅供分享交流,不代表本公众号立场,如涉及版权等问题,请您告知,我们将及时处理。

-- END --

智驾最前沿 「智驾最前沿」深耕自动驾驶领域技术、资讯等信息,解读行业现状、紧盯行业发展、挖掘行业前沿,致力于助力自动驾驶发展与落地!公众号:智驾最前沿
评论 (0)
  • 北京贞光科技有限公司作为紫光同芯授权代理商,专注于为客户提供车规级安全芯片的硬件供应与软件SDK一站式解决方案,同时配备专业技术团队,为选型及定制需求提供现场指导与支持。随着新能源汽车渗透率突破40%(中汽协2024数据),智能驾驶向L3+快速演进,车规级MCU正迎来技术范式变革。作为汽车电子系统的"神经中枢",通过AEC-Q100 Grade 1认证的MCU芯片需在-40℃~150℃极端温度下保持μs级响应精度,同时满足ISO 26262 ASIL-D功能安全要求。在集中式
    贞光科技 2025-04-02 14:50 128浏览
  • 提到“质量”这两个字,我们不会忘记那些奠定基础的大师们:休哈特、戴明、朱兰、克劳士比、费根堡姆、石川馨、田口玄一……正是他们的思想和实践,构筑了现代质量管理的核心体系,也深远影响了无数企业和管理者。今天,就让我们一同致敬这些质量管理的先驱!(最近流行『吉卜力风格』AI插图,我们也来玩玩用『吉卜力风格』重绘质量大师画象)1. 休哈特:统计质量控制的奠基者沃尔特·A·休哈特,美国工程师、统计学家,被誉为“统计质量控制之父”。1924年,他提出世界上第一张控制图,并于1931年出版《产品制造质量的经济
    优思学院 2025-04-01 14:02 148浏览
  • 职场之路并非一帆风顺,从初入职场的新人成长为团队中不可或缺的骨干,背后需要经历一系列内在的蜕变。许多人误以为只需努力工作便能顺利晋升,其实核心在于思维方式的更新。走出舒适区、打破旧有框架,正是让自己与众不同的重要法宝。在这条道路上,你不只需要扎实的技能,更需要敏锐的观察力、不断自省的精神和前瞻的格局。今天,就来聊聊那改变命运的三大思维转变,让你在职场上稳步前行。工作初期,总会遇到各式各样的难题。最初,我们习惯于围绕手头任务来制定计划,专注于眼前的目标。然而,职场的竞争从来不是单打独斗,而是团队协
    优思学院 2025-04-01 17:29 200浏览
  • 据先科电子官方信息,其产品包装标签将于2024年5月1日进行全面升级。作为电子元器件行业资讯平台,大鱼芯城为您梳理本次变更的核心内容及影响:一、标签变更核心要点标签整合与环保优化变更前:卷盘、内盒及外箱需分别粘贴2张标签(含独立环保标识)。变更后:环保标识(RoHS/HAF/PbF)整合至单张标签,减少重复贴标流程。标签尺寸调整卷盘/内盒标签:尺寸由5030mm升级至**8040mm**,信息展示更清晰。外箱标签:尺寸统一为8040mm(原7040mm),提升一致性。关键信息新增新增LOT批次编
    大鱼芯城 2025-04-01 15:02 202浏览
  • 文/Leon编辑/cc孙聪颖‍步入 2025 年,国家进一步加大促消费、扩内需的政策力度,家电国补政策将持续贯穿全年。这一利好举措,为行业发展注入强劲的增长动力。(详情见:2025:消费提振要靠国补还是“看不见的手”?)但与此同时,也对家电企业在战略规划、产品打造以及市场营销等多个维度,提出了更为严苛的要求。在刚刚落幕的中国家电及消费电子博览会(AWE)上,家电行业的竞争呈现出胶着的态势,各大品牌为在激烈的市场竞争中脱颖而出,纷纷加大产品研发投入,积极推出新产品,试图提升产品附加值与市场竞争力。
    华尔街科技眼 2025-04-01 19:49 210浏览
  • 探针本身不需要对焦。探针的工作原理是通过接触被测物体表面来传递电信号,其精度和使用效果取决于探针的材质、形状以及与检测设备的匹配度,而非对焦操作。一、探针的工作原理探针是检测设备中的重要部件,常用于电子显微镜、坐标测量机等精密仪器中。其工作原理主要是通过接触被测物体的表面,将接触点的位置信息或电信号传递给检测设备,从而实现对物体表面形貌、尺寸或电性能等参数的测量。在这个过程中,探针的精度和稳定性对测量结果具有至关重要的影响。二、探针的操作要求在使用探针进行测量时,需要确保探针与被测物体表面的良好
    锦正茂科技 2025-04-02 10:41 71浏览
  • 文/郭楚妤编辑/cc孙聪颖‍不久前,中国发展高层论坛 2025 年年会(CDF)刚刚落下帷幕。本次年会围绕 “全面释放发展动能,共促全球经济稳定增长” 这一主题,吸引了全球各界目光,众多重磅嘉宾的出席与发言成为舆论焦点。其中,韩国三星集团会长李在镕时隔两年的访华之行,更是引发广泛热议。一直以来,李在镕给外界的印象是不苟言笑。然而,在论坛开幕前一天,李在镕却意外打破固有形象。3 月 22 日,李在镕与高通公司总裁安蒙一同现身北京小米汽车工厂。小米方面极为重视此次会面,CEO 雷军亲自接待,小米副董
    华尔街科技眼 2025-04-01 19:39 209浏览
  • 退火炉,作为热处理设备的一种,广泛应用于各种金属材料的退火处理。那么,退火炉究竟是干嘛用的呢?一、退火炉的主要用途退火炉主要用于金属材料(如钢、铁、铜等)的热处理,通过退火工艺改善材料的机械性能,消除内应力和组织缺陷,提高材料的塑性和韧性。退火过程中,材料被加热到一定温度后保持一段时间,然后以适当的速度冷却,以达到改善材料性能的目的。二、退火炉的工作原理退火炉通过电热元件(如电阻丝、硅碳棒等)或燃气燃烧器加热炉膛,使炉内温度达到所需的退火温度。在退火过程中,炉内的温度、加热速度和冷却速度都可以根
    锦正茂科技 2025-04-02 10:13 73浏览
  • 在智能交互设备快速发展的今天,语音芯片作为人机交互的核心组件,其性能直接影响用户体验与产品竞争力。WT588F02B-8S语音芯片,凭借其静态功耗<5μA的卓越低功耗特性,成为物联网、智能家居、工业自动化等领域的理想选择,为设备赋予“听得懂、说得清”的智能化能力。一、核心优势:低功耗与高性能的完美结合超低待机功耗WT588F02B-8S在休眠模式下待机电流仅为5μA以下,显著延长了电池供电设备的续航能力。例如,在电子锁、气体检测仪等需长期待机的场景中,用户无需频繁更换电池,降低了维护成本。灵活的
    广州唯创电子 2025-04-02 08:34 152浏览
  • 随着汽车向智能化、场景化加速演进,智能座舱已成为人车交互的核心承载。从驾驶员注意力监测到儿童遗留检测,从乘员识别到安全带状态判断,座舱内的每一次行为都蕴含着巨大的安全与体验价值。然而,这些感知系统要在多样驾驶行为、复杂座舱布局和极端光照条件下持续稳定运行,传统的真实数据采集方式已难以支撑其开发迭代需求。智能座舱的技术演进,正由“采集驱动”转向“仿真驱动”。一、智能座舱仿真的挑战与突破图1:座舱实例图智能座舱中的AI系统,不仅需要理解驾驶员的行为和状态,还要同时感知乘员、儿童、宠物乃至环境中的潜在
    康谋 2025-04-02 10:23 98浏览
我要评论
0
0
点击右上角,分享到朋友圈 我知道啦
请使用浏览器分享功能 我知道啦