基于MATLAB的ACC控制算法设计及仿真测试

原创 汽车电子与软件 2024-09-20 08:53


作者 | 不可说
出品 | 汽车电子与软件


  

         

 

自适应巡航控制系统(ACC)是汽车自动驾驶技术研究中一项重要的纵向跟驰技术,通过有无前车、前车的加减速情况、跟车距离等传感器传递的信息,在控制系统中通过车间距、加速度控制等相关算法给定主车加速度,控制车辆的纵向跟驰速度,从而有效减轻驾驶员在驾驶过程中的频繁、持续的操作,降低驾驶员的负担,增强车辆的通行性,提高车辆行驶的主动安全性。

在以往的研究与应用中,ACC的实现大多基于毫米波雷达的测距功能来实现的,这是因为毫米波雷达的成本相对于激光雷达要低很多,同时,也较为便捷的集成与车身上。但是,激光雷达是智能车未来发展的必不可少的助力,它可以实现目标的测速、测距、目标的识别、定位与地图的构建等功能,因此,激光雷达极有可能成为今后智能车的标准配件,借助激光雷达实现目前已成功应用的智能辅助驾驶系统也是有研究必要的。



#01
自适应巡航系统的设计
 

1.1 稳态跟随车间距特性 


在车辆跟驰的车间距控制策略中,恒定时间间隔(constant time-gap,CTG)策略和恒定间隙策略适用广泛,在稳定跟随运动(即,)中, “跟车时间间距” 定义如下:


其中,是前面的车辆和本车之间的距离间隔,并且是本车车速,该间隙表示“从前方车辆的尾部表面到目标车辆的前表面的距离”。 
 
给出用于表示在稳定跟随情况下车间距和车速之间的关系的一阶和二阶回归模型:

车间距的一阶回归模型:


车间距的二阶回归模型:


其中,表示速度为0时的车间距,是线性系数,是二次系数。

Fancher.P.[3,11]等人采集了143位驾驶员的数据,对比稳态跟随情况下的车间距的一阶回归拟合与车间距的二阶回归拟合,发现车间距的一阶回归拟合就可以很好的描述驾驶员的稳态跟随情况,所以,在这里取

1.2 跟车模式的上层决策 


目前来讲,规划车辆正常跟随情况下的所需加速度常用的方法之一为线性最优控制理论。

解决最优控制问题的关键在于运动方程的建立,这个运动方程应当描述清楚受控运动的过程,同时也要给出受控系统中变量的范围,明确初始时的运动状态,与所要达到的目标,并选定某一个性能指标对运动过程进行评价。一般来讲,性能指标的选取与控制运动方程和运动状态息息相关。

使用积分器对车辆进行建模,受控车辆和前车的运动状态可以用状态空间模型表示如下:


是线性系数,即取“跟车时间间距”u 表示受控车辆的加速度,干扰量表示为前方车辆加速度,跟车的状态矩阵表示为:

   

上式中,表示期望的车间距,即利用车间距的一阶回归模型计算得到的结果,表示实际车间距,即利用激光雷达测得的车间距;表示前方车辆的速度,表示本车车辆的速度,稳态跟随情况下车辆的控制可以看作线性二次优化问题,最小跟随距离误差和速度误差的状态反馈控制原理及控制输入的设计如下:


权重矩阵有如下表示:


选择状态反馈原理的增益来使最代价函数小化。通过求解公式J可以确定受控车辆的期望加速度。根据李雅普诺夫的第二法和黎卡提方程有:


系数矩阵的计算表达式如下:



是黎卡提方程的正定稳态解。因此,期望的加速度表示为:


是受控车辆的速度的函数,表示控制增益,并且是通过调整加权矩阵得到的。由于加权矩阵对车辆系统的性能有影响,因此选择加权因子或者选择对应的来实现受控车辆的自动控制。

在跟车模式下,存在这样一种情况:旁边车道上行驶的车辆,突然并入本车车道,并且并入后车间距较小、目标车辆的速度较小。这样对于受控车辆来讲是危险的,因为上述的跟车加速度决策是考虑一般情况下的稳态跟车,主要考虑到驾驶员的乘坐主观感受,因此在下文中会对之前决策的加速度进行限制,但是有危险情况发生时,加速度则不应限制。是否为危险情况可以用来进行判断,当下式成立时则认为危险:

   

为危险临界的的值,一般可取0.5。

危险情况下的加速度可由下式决策:


表示的是紧急制动时的增益系数。

1.3 速度跟随模式的上层决策 


当车辆前方没有其他车辆或者障碍物时,即受控车辆前方的激光雷达返回点云不包含非地面点云。这时ACC的功能主要体现在对速度的跟随上,即受控车辆自动加减速,使其达到驾驶员所设定的速度,并维持这个设定的速度行驶。

对于某一个特定的设定速度,对于不同的速度差值,希望加速度变化可以是非线性的,并且希望尽可能的减少运算量,具有较强的鲁棒性和稳定性,因此,在这里采用模糊控制决策速度跟随模式下的加速度。

模糊控制器包括四部分:

(1)模糊化,(2)规则库,(3)模糊推理,(4)解模糊。

首先要确认模糊控制器的输入量,将其转变为模糊控制器可输入的需求量,确定每个输入的模糊语言值和相应的隶属函数,根据相关的专家经验建立合适的模糊规则,再基于模糊规则进行推理决策,最后进行解模糊,得到的量就是控制输出量。

模糊控制原理:


在模糊控制中,被控对象的元素的所有集合可称为论域,以表示论域,把上的实值函数记为 ,那么则有下式成立:    


如果中的任意一个元素,那么表示的就是对于的隶属度,因此,把称为隶属度函数。可以通过控制达到控制的目的。表示完全归属于表示完全不归属于表示不完全归属于,即介于前两者之间。

在模糊控制中,精确的变量通过隶属度函数将其转化为模糊量,是解决非线性时变问题的关键。隶属度函数的选择具有极大的主观性,视情况而定,但是要考虑到整个论域,不能遗漏论域里面的元素。以下三种隶属度函数在控制系统中应用广泛:正态分布型(高斯基函数)、三角形和梯形:

1)正态分布型数学表达式


其中,为函数的中心值,表示函数的宽度。

2)三角形数学表达式

 
其中,为三角形的三个形状参数。

3)梯形数学表达式:  


其中,为梯形的四个形状参数。

模糊控制器的结构设计,是指确定其输入变量与输出变量的个数,通常将一个输入一个输出的模糊控制器称为单变量模糊控制系统(SISO),又称为一维模糊控制器,其他数量的输入量/输出量的模糊控制器称为多变量模糊控制系统(MIMO),理论上,模糊控制器的维数越高,控制越为精细,但是模糊规则的制定相当复杂,同时,计算量也很大,车辆速度跟随模式下的加速度求解较为简单,应用一维模糊控制器即可,如图所示:


采用模糊控制器来决策出车辆的当前期望加速度,使车辆底层模型可以理想的跟踪上期望车速,选取期望车速与当前车速的速度差,作为模糊控制器的输入信号,即:


上式中,为驾驶员的期望车速,为受控车辆的本车车速。

对于而言,采用七个模糊语言子集来确定,即,分别对应负大、负中、负小、零、正小、正中、正大,输入变量的论域为;对于输出变量,即期望加速度,也采用七个模糊语言子集来确定,即,输出变量的论域为,这里主要考虑到速度跟随过程中的舒适性,所以不采用较大的加减速度。

参考专家经验,并依据车辆传动系统的动力学特性与驾驶员驾驶习惯,确定模糊控制规则的选取原则如下 : 
 
(1)速度误差较小时,应该产生较小的期望加速度,车辆可以平稳的达到期望速度;

(2)速度误差处于中等水平时,应该产生较大的期望加速度,这样可以很快的缩小速度误差,当其达到较小的水平时,又以较小的加速度值使车辆平稳的达到期望速度;

(3)速度误差处于较大水平时,应该产生一个中等的期望加速度,因为速度误差值较大时,根据驾驶员习惯,加速度变化规律往往是由小变大再变小,因此,速度差较大时应该产生一个中等加速度值,快速又不失平稳的过渡到(2)与(1)的状态。

根据上述的三条原则,确定模糊控制规则如下表:


防止加速过程产生加速度的跳变,同时保持加速过程的平稳变化,采用重心法进行加速度的决策。

输入变量和输出变量的模糊子集采用三角形隶属度函数,如图所示:

   
表达模糊控制器输入输出的关系如下图所示:


1.4 ACC模式的切换 


ACC主要分为速度跟随与跟车两个模式,这两个模式均可决策出车辆的加速度,在开启ACC后,应该决定进入哪个模式,或者,满足某种条件后,应由当前的模式切换到另一个模式。当没有前方目标车辆的时候,毫无疑问的应该为速度跟随模式;当存在前方目标车辆时,并且前方车辆与受控车辆距离足够近,此时应该为跟车模式。以往常用的模式切换条件可以用图来描述:


可以看出,在坐标系中,三四象限表示车间距为负值,即车辆会发生碰撞,这是不允许的,所以三四象限为死区,不需要考虑。模式切换线为一、二象限中的一条水平直线,这条直线表示车间距为,当车间距大于时,ACC处于速度跟随模式,当车间距介于之间时,ACC处于跟车模式,很显然,这种模式判别条件仅与车间距有关,而没有考虑车速、相对车速的影响。   

由于第二象限的是负的,在这象限内的沿任何轨迹的运动,所代表的车间距都不会增加,从物理上来说,这意味着主车(受控车辆)接近前车,因为它的速度比前车大,类似的推理表明,车辆的对应状态处于第一象限时,主车与前车的车间距不会减小,这意味着主车(受控车辆)远离前车。因此,可以说,车辆运动状态处于第一象限时比处于第二象限时更为安全,所以,当受控车辆由速度跟随模式切换到跟车模式时,车辆状态处于第一象限时比处于第二象限时可以 “更晚”的进行切换,并且,速度差值越大时,车辆间的安全性更高。所以,可以采取更为合理的模式切换线,如图所示


模式切换线可以表述为下式:



上式中,一般取值R表示两车相对速度为0时,理想的车间距,R, C0为两车静止时的理想车距,表示跟车时距,表示前车的车速。

车辆状态位于切换线右上方时,处于速度跟随模式;车辆状态位于切换线左下方时,处于速度跟随模式。

另外,还需要考虑驾驶员设定的期望车速与前方目标车速的关系:如果期望车速小于前方目标车速,车辆应该按照驾驶员的意图行驶,即进入速度跟随模式,不应该跟随前方较快的目标车辆,其余情况下,均按照ACC模式判别正常决策。
  
 

#02
仿真实验验证
 

2.1 实验场景的设计 


根据上文对于ACC系统的设计,设计四个常见的交通场景来验证ACC控制的准确性与激光雷达在ACC系统中的可应用性:

  • 实验场景1:不同车道的车辆切入实验车辆车道前方,一段时间后,又切出该车道;

  • 实验场景2:前方车辆位于实验车辆同车道,距离实验车较远,实验车逐渐接近前车。

基于以上仿真场景的设计,在仿真软件平台搭建实验场景,主要分为以下几个步骤:

(1)道路场景与行驶环境的构建;

(2)实验车辆模型与激光雷达传感器模型的添加;

(3)交通车辆模型的添加与行驶设定;

(4)实验车辆控制算法在Simulink中的搭建。
         

 

       

 


2.2 仿真实验结果与分析 


实验过程中记录车辆的相关参数与激光雷达的探测数据,同时判断激光雷达的探测目标是否位于实验车辆的前方车道内。   

实验中,会设定驾驶员的期望车速与前方车辆的速度(如果有前车),同时设定ACC的模式:1表示速度跟随模式,2表示跟车模式。

实验场景1:


实验刚开始时,激光雷达探测到目标车辆的航向角很大,这是因为目标车辆处于实验车辆的旁边车道内,同时判定0-2.27s时,目标车辆未在实验车辆的前方同一车道内,于2.27s左右切入实验车辆所在的车道,目标车辆在实验车辆的前方同一车道内,又于32s左右时,目标车辆又切出实验车辆所在的车道。


分析实验结果可知:设定驾驶员期望巡航车速为50km/h,目标车辆初始车速为30km/h,最高车速为60km/h。初始0-2.27s时,ACC模式处于1,即速度跟随模式,此时目标车辆处于实验车辆的旁边车道内,本车应加速至巡航车速,但是2.27s时,目标车辆切入实验车辆前方,本车则切换到跟车模式,稳定跟随目标车辆,在大约26s的时候,目标车辆仍在实验车辆的前方同一车道内,但是前方车辆速度超过了设定的驾驶员设定的巡航车速,所以本车的ACC模式切换回1,即速度跟随模式,本车不再跟随目标车辆,而是进行速度跟随控制,稳定的达到巡航速度,目标车辆于32s左右时,切出本车所在车道,并未对本车行驶产生影响。从车间距特性图像中可以看出,期望车间距仅仅在ACC模式为2的时候进行计算,因为速度跟随模式下车间距没有意义。综合上述分析结果,验证了切入--切出工况下ACC控制的准确性与激光雷达在该系统中的可应用性。 
 
实验场景2:


与实验场景设定的一致,目标车辆一直处于本车车辆的前方同一车道内。
          

 

    

分析实验结果可知:设定驾驶员期望巡航车速为50km/h,目标车辆初始车速为30km/h,最高车速为60km/h。0-13s时,ACC模式处于1,即速度跟随模式,此时目标车辆处于实验车辆的同一车道的前方,但是距离很远,并且两车速度较低,所以处于速度跟随模式,本车应加速至巡航车速;在约6s的时候,本车车辆达到巡航车速,并维持巡航车速至13s,此时,控制参数达到了模式切换的标准,ACC模式切换到2状态,即跟车模式,车速平滑过渡到与前车保持一致,在约24s时,前车车速超过了设定的驾驶员设定的巡航车速,所以本车的ACC模式切换回1,即速度跟随模式,本车不再跟随目标车辆,而是进行速度跟随控制,稳定的达到巡航速度。综合上述分析结果,验证了实验场景4设定工况下ACC控制的准确性与激光雷达在该系统中的可应用性。



#03
总  结
 
虽然目前已有很多ACC产品化,但是实现大多基于毫米波雷达的测距功能来实现的,同时,激光雷达是智能车未来发展的必不可少的助力,它可以实现目标的测速与测距,因此,激光雷达极有可能成为今后智能车的标准配件,所以设计了上述基于激光雷达的ACC功能,借助了了激光雷达的测距与测速功能,经仿真实验验证,基于激光雷达的ACC功能完善,适应多种较为复杂的工况,同时对于速度跟随与跟车模式下的控制较为稳定,验证了ACC控制的准确性与激光雷达在该系统中的可应用性。   



/ END /


      

 

          

 

    

汽车电子与软件 主要介绍汽车电子软件设计相关内容,每天分享一篇技术文章!
评论
  • PLC组态方式主要有三种,每种都有其独特的特点和适用场景。下面来简单说说: 1. 硬件组态   定义:硬件组态指的是选择适合的PLC型号、I/O模块、通信模块等硬件组件,并按照实际需求进行连接和配置。    灵活性:这种方式允许用户根据项目需求自由搭配硬件组件,具有较高的灵活性。    成本:可能需要额外的硬件购买成本,适用于对系统性能和扩展性有较高要求的场合。 2. 软件组态   定义:软件组态主要是通过PLC
    丙丁先生 2025-01-06 09:23 71浏览
  • 本文介绍Linux系统更换开机logo方法教程,通用RK3566、RK3568、RK3588、RK3576等开发板,触觉智能RK3562开发板演示,搭载4核A53处理器,主频高达2.0GHz;内置独立1Tops算力NPU,可应用于物联网网关、平板电脑、智能家居、教育电子、工业显示与控制等行业。制作图片开机logo图片制作注意事项(1)图片必须为bmp格式;(2)图片大小不能大于4MB;(3)BMP位深最大是32,建议设置为8;(4)图片名称为logo.bmp和logo_kernel.bmp;开机
    Industio_触觉智能 2025-01-06 10:43 72浏览
  • 在智能家居领域中,Wi-Fi、蓝牙、Zigbee、Thread与Z-Wave等无线通信协议是构建短距物联局域网的关键手段,它们常在实际应用中交叉运用,以满足智能家居生态系统多样化的功能需求。然而,这些协议之间并未遵循统一的互通标准,缺乏直接的互操作性,在进行组网时需要引入额外的网关作为“翻译桥梁”,极大地增加了系统的复杂性。 同时,Apple HomeKit、SamSung SmartThings、Amazon Alexa、Google Home等主流智能家居平台为了提升市占率与消费者
    华普微HOPERF 2025-01-06 17:23 97浏览
  • 彼得·德鲁克被誉为“现代管理学之父”,他的管理思想影响了无数企业和管理者。然而,关于他的书籍分类,一种流行的说法令人感到困惑:德鲁克一生写了39本书,其中15本是关于管理的,而其中“专门写工商企业或为企业管理者写的”只有两本——《为成果而管理》和《创新与企业家精神》。这样的表述广为流传,但深入探讨后却发现并不完全准确。让我们一起重新审视这一说法,解析其中的矛盾与根源,进而重新认识德鲁克的管理思想及其著作的真正价值。从《创新与企业家精神》看德鲁克的视角《创新与企业家精神》通常被认为是一本专为企业管
    优思学院 2025-01-06 12:03 77浏览
  • 随着市场需求不断的变化,各行各业对CPU的要求越来越高,特别是近几年流行的 AIOT,为了有更好的用户体验,CPU的算力就要求更高了。今天为大家推荐由米尔基于瑞芯微RK3576处理器推出的MYC-LR3576核心板及开发板。关于RK3576处理器国产CPU,是这些年的骄傲,华为手机全国产化,国人一片呼声,再也不用卡脖子了。RK3576处理器,就是一款由国产是厂商瑞芯微,今年第二季推出的全新通用型的高性能SOC芯片,这款CPU到底有多么的高性能,下面看看它的几个特性:8核心6 TOPS超强算力双千
    米尔电子嵌入式 2025-01-03 17:04 48浏览
  • 光耦合器,也称为光隔离器,是一种利用光在两个隔离电路之间传输电信号的组件。在医疗领域,确保患者安全和设备可靠性至关重要。在众多有助于医疗设备安全性和效率的组件中,光耦合器起着至关重要的作用。这些紧凑型设备经常被忽视,但对于隔离高压和防止敏感医疗设备中的电气危害却是必不可少的。本文深入探讨了光耦合器的功能、其在医疗应用中的重要性以及其实际使用示例。什么是光耦合器?它通常由以下部分组成:LED(发光二极管):将电信号转换为光。光电探测器(例如光电晶体管):检测光并将其转换回电信号。这种布置确保输入和
    腾恩科技-彭工 2025-01-03 16:27 171浏览
  • 这篇内容主要讨论三个基本问题,硅电容是什么,为什么要使用硅电容,如何正确使用硅电容?1.  硅电容是什么首先我们需要了解电容是什么?物理学上电容的概念指的是给定电位差下自由电荷的储藏量,记为C,单位是F,指的是容纳电荷的能力,C=εS/d=ε0εrS/4πkd(真空)=Q/U。百度百科上电容器的概念指的是两个相互靠近的导体,中间夹一层不导电的绝缘介质。通过观察电容本身的定义公式中可以看到,在各个变量中比较能够改变的就是εr,S和d,也就是介质的介电常数,金属板有效相对面积以及距离。当前
    知白 2025-01-06 12:04 111浏览
  • 在快速发展的能源领域,发电厂是发电的支柱,效率和安全性至关重要。在这种背景下,国产数字隔离器已成为现代化和优化发电厂运营的重要组成部分。本文探讨了这些设备在提高性能方面的重要性,同时展示了中国在生产可靠且具有成本效益的数字隔离器方面的进步。什么是数字隔离器?数字隔离器充当屏障,在电气上将系统的不同部分隔离开来,同时允许无缝数据传输。在发电厂中,它们保护敏感的控制电路免受高压尖峰的影响,确保准确的信号处理,并在恶劣条件下保持系统完整性。中国国产数字隔离器经历了重大创新,在许多方面达到甚至超过了全球
    克里雅半导体科技 2025-01-03 16:10 122浏览
  • 车身域是指负责管理和控制汽车车身相关功能的一个功能域,在汽车域控系统中起着至关重要的作用。它涵盖了车门、车窗、车灯、雨刮器等各种与车身相关的功能模块。与汽车电子电气架构升级相一致,车身域发展亦可以划分为三个阶段,功能集成愈加丰富:第一阶段为分布式架构:对应BCM车身控制模块,包含灯光、雨刮、门窗等传统车身控制功能。第二阶段为域集中架构:对应BDC/CEM域控制器,在BCM基础上集成网关、PEPS等。第三阶段为SOA理念下的中央集中架构:VIU/ZCU区域控制器,在BDC/CEM基础上集成VCU、
    北汇信息 2025-01-03 16:01 193浏览
  • 每日可见的315MHz和433MHz遥控模块,你能分清楚吗?众所周知,一套遥控设备主要由发射部分和接收部分组成,发射器可以将控制者的控制按键经过编码,调制到射频信号上面,然后经天线发射出无线信号。而接收器是将天线接收到的无线信号进行解码,从而得到与控制按键相对应的信号,然后再去控制相应的设备工作。当前,常见的遥控设备主要分为红外遥控与无线电遥控两大类,其主要区别为所采用的载波频率及其应用场景不一致。红外遥控设备所采用的射频信号频率一般为38kHz,通常应用在电视、投影仪等设备中;而无线电遥控设备
    华普微HOPERF 2025-01-06 15:29 94浏览
  • 根据Global Info Research项目团队最新调研,预计2030年全球封闭式电机产值达到1425百万美元,2024-2030年期间年复合增长率CAGR为3.4%。 封闭式电机是一种电动机,其外壳设计为密闭结构,通常用于要求较高的防护等级的应用场合。封闭式电机可以有效防止外部灰尘、水分和其他污染物进入内部,从而保护电机的内部组件,延长其使用寿命。 环洋市场咨询机构出版的调研分析报告【全球封闭式电机行业总体规模、主要厂商及IPO上市调研报告,2025-2031】研究全球封闭式电机总体规
    GIRtina 2025-01-06 11:10 89浏览
  •     为控制片内设备并且查询其工作状态,MCU内部总是有一组特殊功能寄存器(SFR,Special Function Register)。    使用Eclipse环境调试MCU程序时,可以利用 Peripheral Registers Viewer来查看SFR。这个小工具是怎样知道某个型号的MCU有怎样的寄存器定义呢?它使用一种描述性的文本文件——SVD文件。这个文件存储在下面红色字体的路径下。    例:南京沁恒  &n
    电子知识打边炉 2025-01-04 20:04 85浏览
  • 物联网(IoT)的快速发展彻底改变了从智能家居到工业自动化等各个行业。由于物联网系统需要高效、可靠且紧凑的组件来处理众多传感器、执行器和通信设备,国产固态继电器(SSR)已成为满足中国这些需求的关键解决方案。本文探讨了国产SSR如何满足物联网应用的需求,重点介绍了它们的优势、技术能力以及在现实场景中的应用。了解物联网中的固态继电器固态继电器是一种电子开关设备,它使用半导体而不是机械触点来控制负载。与传统的机械继电器不同,固态继电器具有以下优势:快速切换:确保精确快速的响应,这对于实时物联网系统至
    克里雅半导体科技 2025-01-03 16:11 181浏览
  • 自动化已成为现代制造业的基石,而驱动隔离器作为关键组件,在提升效率、精度和可靠性方面起到了不可或缺的作用。随着工业技术不断革新,驱动隔离器正助力自动化生产设备适应新兴趋势,并推动行业未来的发展。本文将探讨自动化的核心趋势及驱动隔离器在其中的重要角色。自动化领域的新兴趋势智能工厂的崛起智能工厂已成为自动化生产的新标杆。通过结合物联网(IoT)、人工智能(AI)和机器学习(ML),智能工厂实现了实时监控和动态决策。驱动隔离器在其中至关重要,它确保了传感器、执行器和控制单元之间的信号完整性,同时提供高
    腾恩科技-彭工 2025-01-03 16:28 166浏览
我要评论
0
点击右上角,分享到朋友圈 我知道啦
请使用浏览器分享功能 我知道啦