珠海市官网网站建设品牌,深圳创业补贴去哪里申请,网站搭建,手机加速器在上一讲《Coursera自动驾驶课程第5讲#xff1a;Vehicle Dynamic Modeling》中我们了解了汽车运动学和动力学模块。
本讲我们继续学习新的模块#xff1a;汽车纵向控制。具体地#xff0c;我们将学习PID控制算法#xff0c;看看该算法是如何在自动驾驶汽车中应用的。
B站…在上一讲《Coursera自动驾驶课程第5讲Vehicle Dynamic Modeling》中我们了解了汽车运动学和动力学模块。
本讲我们继续学习新的模块汽车纵向控制。具体地我们将学习PID控制算法看看该算法是如何在自动驾驶汽车中应用的。
B站视频链接https://www.bilibili.com/video/BV1WE411D74g?p1 文章目录1. Proportional Integral Derivative Control1.1 Overview1.2 PID Controller 重点1.3 Second Order System2. Longitudinal Speed Control with PID2.1 Vehicle Longitudinal cruise control2.2 High Low-level controller3. Feedforward Speed Control3.1 Feedback vs. Feedforward Control3.2 Vehicle Speed Control1. Proportional Integral Derivative Control
1.1 Overview
在上一节我们学习了如何基于自行车模型开发汽车运动学和动力学模型。
在下图中汽车运动学和动力学模型通过捕获驾驶员输入的命令例如转向和刹车以及外界扰动进行响应。 然后控制器通过传感器感知汽车当前的状态向量并随后生成执行器信号来调节车辆状态。 对于纵向控制控制器通过调节油门和制动命令以匹配汽车行驶所需的速度。下面 让我们看一个典型的反馈控制回路。
Plant或Process模型将执行器信号作为输入输出为系统状态变量。 然后传感器对系统状态变量进行测量然后Estimators进行估计。 系统将估计值与所需参考输入进行比较并将误差传递给控制器以上就是一个完整的反馈控制回路。
下面我们介绍状态转移函数。
传递函数G是在拉普拉斯域中定义的系统输入U和输出Y之间的关系它是复数域变量S的函数。
Y(s)G(s)U(s)sσjωY(s) G(s)U(s)\\ s \sigma j\omega Y(s)G(s)U(s)sσjω 1.2 PID Controller 重点
PID控制包含三项
与误差eee成比例的比例项KPK_{P}KP,与误差积分成比例的积分项KIK_IKI,与误差导数成比例的导数项KDK_DKD。
下面直接给出其时间域公式 u(t)KPe(t)KI∫01e(t)dtKDe˙(t)u(t) K_{P}e(t)K_I\int_0^1 e(t)dt K_D\dot{e}(t)u(t)KPe(t)KI∫01e(t)dtKDe˙(t) 对其进行拉普拉斯转换转换后的形式为 U(s)Gc(s)E(s)(KPKIsKDs)E(s)(KDs2KPsKIs)E(s)U(s) G_c(s)E(s) (K_P \frac{K_I}{s}K_Ds)E(s) (\frac{K_Ds^2 K_Ps K_I}{s})E(s)U(s)Gc(s)E(s)(KPsKIKDs)E(s)(sKDs2KPsKI)E(s) 下面我们来讨论状态转移函数Gc(s)G_c(s)Gc(s)的一些特性 PID传递函数在原点处包含一个单极还包含含零二阶分子可以通过选择适当的增益值将其放置在复平面上的任何位置。 有多种算法可以调节PID增益其中齐格勒·尼科尔斯Ziegler Nichols是最受欢迎的算法之一。
对于系统响应我们定义几个评价指标
将Rise Time 上升时间定义为达到所需参考值90所需要的时间。Overshoot为系统输出超出此参考的最大百分比。Settling Time稳定时间是指系统输出稳定在参考值范围的5之内所需时间Steady State Error稳态误差是稳态下输出与参考值之间的误差。
比例项KpK_pKp的增加会导致Overshoot的增加相应地上升时间会减少。 类似地由于微分项KdK_dKd对误差的变化率做出反应因此增大KdK_dKd会导致Overshoot减小和稳定时间减少。最后KIK_IKI的增加可以消除稳态误差。 下面的表格总结了以上特性。 1.3 Second Order System
现在让我们看一下图中所示的著名的二阶弹簧质量阻尼模型。
系统受到输入力FFF的作用模型的输出为物体位移xxx。 质量块MMM通过具有常数KKK的弹簧和具有阻尼系数bbb的阻尼器连接墙面。 现在将方程转换为Laplace域最终我们得到图中的状态转移函数G(s)G(s)G(s)。 为了评估系统特性我们使用单位阶跃输入来激励系统。 此时系统响应为开环响应因为此时没有控制器应用于系统。 我们得到的系统响应如下图 如果将控制器添加到模型中并且模型的输出与所需的参考信号进行比较则系统的响应称为闭环响应。
下图给出了几种不同PID控制器的阶跃响应。
水平虚线表示所需输出控制器的目标是使实际输出接近该参考值。在第一个示例中阶跃响应为纯比例控制。在PPP控制器响应中我们看到上升时间快明显的过冲和延长的振荡。增加微分控制可改善过冲和建立时间方面的阶跃响应但会降低上升时间。相反添加积分项可保持较短的上升时间并且能够减少振荡和过冲从而也缩短了建立时间
下面我们给出PIDPIDPID控制器 GPID(s)(KPKDsKIs)G_{PID}(s) (K_P K_Ds \frac{K_I}{s})GPID(s)(KPKDssKI) 系统响应如图右所示系统通过PID控制可以以更快的速度接近参考点而没有任何过冲。 2. Longitudinal Speed Control with PID
2.1 Vehicle Longitudinal cruise control
在上一节我们介绍了PID控制原理。 在本节我们将PID控制应用于车辆纵向控制。
现在让我们仔细研究一下车辆控制架构。 我们可以将整个架构分为四部分如下左图所示 第一部分是环境感知。车辆通过传感器对周围环境进行感知并为系统生成输入参考。第二部分路径生成和速度生成。路径和速度是我们控制器所需的参考输入。第三部分车辆横向和纵向控制目的是最大程度地减小实际和参考路径与速度之间的误差。-最后控制器发出信号执行器执行相应命令。正如我们在上一节中所看到的包括用于横向控制的转向以及用于纵向控制的油门和制动命令。 下面让我们看一个车辆纵向控制的例子。
目前汽车控制中最常用的控制应用就是巡航控制。通常巡航控制系统主要功能就是通过节气门或制动命令维持车辆速度。
通常控制器可以分为两个级别高级控制器和低级控制器。尽管低级控制器对于控制任务有时候不是必需的。高级控制器根据车辆参考速度和实际速度之差生成所需的加速度以减小速度差。低级控制器获取车辆加速度并产生节气门命令或制动命令来最终控制车速。 2.2 High Low-level controller
High-level controller 高级控制器根据速度差确定需要的加速度大小。 高级别控制器的输入是速度差输出是车辆的期望加速度。 根据PID原理我们所需的加速度可以写成 x¨desKP(x˙ref−x˙)KI∫01(x˙ref−x˙)dtKDd(x˙ref−x˙)dt\ddot{x}_{des} K_{P}(\dot{x}_{ref}-\dot{x})K_I\int_0^1 (\dot{x}_{ref}-\dot{x})dt K_D\frac{d\left(\dot{x}_{r e f}-\dot{x}\right)}{d t}x¨desKP(x˙ref−x˙)KI∫01(x˙ref−x˙)dtKDdtd(x˙ref−x˙)
Low-level controller 在设计低级控制器时我们会进行一些假设以简化问题 仅考虑节气门命令无制动命令 在巡航控制中仅需要油门即可控制车辆速度。变矩器锁定齿轮3假设我们以三档或更高档位操作从而变矩器被锁定这意味着来自发动机的扭矩直接通过变速器而不会造成损失。轮胎滑移率较小纵向控制柔和。 低级控制器通过增加或减小发动机产生的扭矩来产生期望的加速度。将期望的加速度转换为扭矩需求然后将扭矩需求转换为节气门角度指令。
在下面的仿真结果图中我们看到根据PID控制实际车速如何随时间变化实际车速最终达到所需的参考速度。 3. Feedforward Speed Control
3.1 Feedback vs. Feedforward Control
在上一小节我们了解了如何构建用于纵向速度跟踪的反馈控制器我们使用PID来生成加速命令并使用一个低级控制器来定义油门和制动器命令。
现在让我们看一下Feedvack图和Feedforward图。 Feedback图是一个典型的闭环结构将输出与参考信号做比较。 并将两者之差输入到反馈控制器中。Feedforward图是一个开环结构其中参考信号直接馈入前馈控制器。
在许多应用中通常前馈回路和反馈回路会结合使用以提高控制器性能。 右图为一个典型的反馈、前馈控制工作原理图。
反馈和前馈控制器均用于控制系统的主要原因是前馈控制器在产生参考输出以实现特定跟踪响应时会提供预测响应尤其是在所需输入为非零时。反馈控制器会修正响应从而消除由于干扰而引起的控制误差。由于这种互补关系反馈和前馈控制的组合被广泛使用。 3.2 Vehicle Speed Control
现在让我们看一下反馈和前馈控制器如何用于汽车纵向速度控制。
在左图中参考速度是前馈控制器的输入速度差是反馈控制器的输入。 两个控制器均产生两个车辆控制信号即节气门和制动命令。
让我们看一下从前馈查询表中开发执行器命令所需的步骤。
在示例中根据车辆速度和车轮角速度之间的运动关系我们可以计算所需的车轮角速度。同时我们也可以通过建模模块中定义的运动关系来计算与所需车轮角速度相对应的发动机RPM。然后假设汽车处于稳态运行状态发动机扭矩必须等于作用在车辆上的总负载扭矩。负载扭矩的来源是空气阻力滚动阻力和车辆重力阻力。我们可以使用车辆的当前状态来计算载扭矩。现在我们有了所需的发动机扭矩并且可以将其与RPM中的当前发动机运行速度结合起来求出所需扭矩对应的节气门位置。
让我们比较一下组合的前馈反馈法与PID控制法之间的效果。
我们使用了与上一小节相同的模拟参数。 随着参考速度的变化可以看见由于PID控制器是对其误差进行修正因此其响应会滞后于前馈方法。 总结本讲我们学习了
经典控制概念并定义了PID控制器。建立了一个PID控制器来对汽车纵向速度控制。结合使用前馈控制来改善速度控制性能。
