您好、欢迎来到现金彩票网!
当前位置:PC蛋蛋 > 约束函数 >

使用模型预测控制和PID实现自动驾驶的车道保持

发布时间:2019-06-10 13:16 来源:未知 编辑:admin

  (视频)黄色的路径是目标轨迹,绿色的路径是我们的汽车如何使用MPC移动。

  自动驾驶的3大核心科技是定位(在哪里),感知(周围是啥)以及控制(咋开车呢)。通过车道检测,我们可以对车的行进路线进行路径规划。本篇文章主要通过一个自行车的动力学模型讨论车辆的加速、刹车和转向的模型预测控制。目的不仅在于尽可能地控制车辆轨迹,同时也还要尽可能使速度平滑以避免晕车和频繁的刹车。

  模型预测控制主要在约束条件下使损失函数最小。例如,我们想要以100ms的周期调整转向和速度,在转向角度不能超过25°的约束下,最小化以规划的路径和实际路径之间的误差。我们通过传感器获取车辆的状态,比如速度,而我们的动作基于传感器读数以一个短的周期执行(例如1s)。例如,我们顺时针转向20°,然后每100ms周期减小1°。加入这些动作可以1秒钟之后的损失函数最小,我们将会采用第一个动作:顺时针转动20°,但是却并不执行后续的动作,而是在100ms后,重复优化过程。100ms后,有了新的读数,我们就重新计算下一个最优动作。模型预测控制通过预测接下来一段较长时间(1s)的损失函数,来计算选择出下一个较短周期(100ms)的最优动作。相比于短视的贪心算法,模型预测控制更加健壮,因此能够控制得更好。

  (x, y)是车辆的质心,ψ是当前车身的角度,v是当前车辆的速度,lf是当前车辆质心到原点的距离, β是速度和车身的角度。在我们的例子中,我们假设β为零,也就是没有侧滑。

  在我们的模型中,我们可以通过控制前轮的转角δf 以及车辆的加速度a来控制车辆轨迹。简单起见,我们只考虑前轮驱动的车辆,并且将δf记作δ。

  我们的道路检测系统应该能够为我们规划好路线个航点的坐标的形式。在我们的例子中,我们使用6个航点去逼近一个3阶多项式函数。我们用这个模型去计算y坐标和相对于x轴的车身角度ψ。

  接下来,我们要创建动态模型利用t时刻的状态去预测在t+1拍时刻的车辆状态。利用动力学模型,我们可以轻易地从最新时刻地采样推导出下一时刻的位置,车身角度和速度。

  在模型预测控制中,我们需要定义损失函数来优化路径。如果模型不能保持目标速度,那么我们就要惩罚模型。如果可能的话,我们并不想要突然的加减速或者突然的转向。但是既然这些实际上是不可避免的,我们可以尽可能地抑制加减速和转向地变化率。这减轻了晕车同时更加省油(也省人民币)。模型的损失函数应当包含:雷锋网

  因为这些目标也许会相互冲突,我们需要给这些损失项定义权重以体现优先级。损失函数如下:

  我们需要用模型预测控制来寻找最优路径,那么就需要动力学模型来预测下一拍的状态,以下是动力学模型和系统约束:

  我们通过解决一个约束条件下优化损失函数的问题来解决了控制问题。这些约束条件包括油门和转向的控制。

  根据1秒内的车辆状态响应优化控制动作,控制的周期为100ms,所以1s内有10个周期

  模型预测控制的两个变量(也是控制量):加速度(油门对应正加速度,刹车对应负加速度)和转向角

  用1个优化器解算出在约束定义下周期1到周期9的最小总损失(注意,在我们的定义中,时间周期并不从0开始,而是从1开始到10)

  但是,我们延时100ms后再将控制量给模拟器。这样能够模拟现实世界,毕竟处理计算(读取传感器)和执行都需要时间。

  在我们的例子中,我们计算了1秒中内的最优解,这个参数是可以调节的。长时间窗口的优化会给控制器的动作漂亮的曲线,但是也会积累过多的误差。实际上,如果这个优化时间窗口太大,汽车反而会脱离期望轨迹。

  对于那些数学大神,以下有一个介绍自动驾驶会怎样出错的视频(原文并没有给出-_-)。雷锋网

  比例-积分-微分(PID)控制器是另一种在无人驾驶中应用的控制器,下方视频解释了它的工作原理。

  我们用下方的PID控制器进行了仿真。由于损失函数相对简单,所以运动存在一定的抖振。

  长按链接点击打开或点击【使用模型预测控制和PID实现自动驾驶的车道保持】:

  用Python实现遗传算法要找房,先用Python做个爬虫看看新手必看:深度学习是什么?它的工作原理是什么?Python高级技巧:用一行代码减少一半内存占用

  (Python)3D人脸处理工具face3d如何在大规模的数据库里中使用Dask如何在神经NLP处理中引用语义结构让你的电脑拥有“视力”,用卷积神经网络就可以!

  “华为P30 VS 风神WindLink,谁家“大脑”更聪明?”丨Eva的科技生活

http://beckymotew.com/yueshuhanshu/52.html
锟斤拷锟斤拷锟斤拷QQ微锟斤拷锟斤拷锟斤拷锟斤拷锟斤拷锟斤拷微锟斤拷
关于我们|联系我们|版权声明|网站地图|
Copyright © 2002-2019 现金彩票 版权所有