基于卡尔曼滤波器的自动驾驶算法

发布时间:2023-07-03  

组成自动驾驶的关键技术包括感知、规划和控制三大部分。自动驾驶车通过传感器感知环境并进行定位,根据感知系统获得的信息和行驶目标进行速度和路径的规划,并以控制系统为基础实现车辆的运动控制。


背景

导航是感知系统下重要的模块,其性能优越程度决定了自动驾驶的性能。基于扩展卡尔曼滤波器的GNSS/SINS松耦合组合是最常见的导航算法之一,但是此算法对GNSS的鲁棒性极低,不适用于狭窄的道路。另一个重要的方法是车道检测和跟踪。一种是基于霍夫变换表示的视觉,但这种方法要求路面高度清洁。另一种基于激光雷达,通过获取雷达扫描点的坐标并将其转换为光栅图像,然后利用光栅图像中的点密度提取车道线。


规划系统的经典形式是比例积分微分(PID)控制器,它不需要系统模型,并且基于误差信号设计了控制率。但当路径的曲率较大时,跟踪精度会降低。另一种典型的方法是基于车辆运动学模型。该方法利用车辆运动模型预测一段时间内的未来运动,并通过连续优化的控制参数来拟合这一系列运动,但此方法只考虑重心的偏差和预测时域中的偏差。


在这项研究中,研究人员基于平方根容积卡尔算法(SCKF),以二阶固定非线性展开为测量模型,设计了融合IMU、GNSS接收机和里程表的组合导航控制算法。导航控制算法将预期路线划分为多段,并根据电子地图的经纬度、航向角和关键点序列来进行计算,最终得到无人驾驶车辆与分段路线之间的角度偏差。该算法通过增量式PID控制器消除偏差,实现逐段路径跟踪。仿真实验结果表明,基于SCKF的组合导航算法的精度优于基于SKF的组合导航。该系统的组成如图1所示。

图片

图1

导航系统

基于惯性导航误差模型的滤波器在观测异常时容易出现异常甚至发散。其原因是基于小误差假设建立了组合导航的滤波观测方程。当惯性导航误差变大时,滤波观测方程的线性化过程将不理想。


因此,在本研究中,引入了一种非线性滤波器,立方体卡尔曼滤波器(SCKF),该滤波器使用三阶球面径向体积规则来近似非线性变换中所需的积分运算。为了避免矩阵计算过程中的失真,本文推导了与平方根卡尔曼滤波器相似的立方卡体尔曼滤波器。

最终的推导结果如下,Wk为反馈矩阵,X k|k为最佳状态,Pk|k为方差矩阵。

图片

引导算法

引导控制算法基于地图信息和关键点生成坐标序列,并生成用于分段运动控制的引导参数,以根据所建立的路线实现自动驾驶。制导控制算法的体系结构如图3所示。

图片

图3

考虑到具有轮距W和车轮半径r的四轮驱动车辆,四轮转向模型如图4所示。

图片

图4

制导参数由航向角偏差d和横向距离偏差r组成。制导参数与关键点坐标序列的关系如图5所示。

图片

图5

结论

研究人员对该系统进行了仿真测验,结果表明,基于SCKF的组合导航算法的精度优于基于SKF的组合导航。为了验证自动驾驶算法的有效性及其对卫星信号干扰的鲁棒性,进行了无人驾驶汽车的室外自动驾驶实验。该算法是自动驾驶仪的基本形式,具有很高的工程应用价值和参考价值。这项工作缺乏对环境感知的处理,例如障碍物的存在。因此,下一步的研究将集中于在线路径规划和重构。

文章来源于:电子工程世界    原文链接
本站所有转载文章系出于传递更多信息之目的,且明确注明来源,不希望被转载的媒体或个人可与我们联系,我们将立即进行删除处理。

相关文章

    ②式知,当e EST ≫eMEA时,Kk = 1,将带入①式,即当估计误差比较大时我们选择相信测量值。相反,当e EST ≪eMEA时,Kk = 0,,此时我们选择相信估计值 该情形下卡尔曼滤波的一般步骤......
    基于扩展卡尔曼滤波EKF的无感控制+Matlab/Simulink仿真案例;前言 本章节采用扩展卡尔曼滤波进行永磁同步电机的无传感器控制,首先分析了扩展卡尔曼滤波的原理,然后基于扩展卡尔曼滤波......
    关于卡尔曼——卡尔曼滤波和他的现代控制理论;鲁道夫·埃米尔·卡尔曼 (Rudolf Emil Kalman) 是一位拥有匈牙利血统的美国数学家。 这位出生于布达佩斯的科学家于 1943 年与......
    值;Vpred(i) 为i 时刻信号强度变化率的预测值;a,b 为增益常量;TS 为采样时间间隔。基于速度常量的滤波算法能够有效地减小信号波动给测量带来的影响。 1.7 卡尔曼滤波 卡尔曼滤波的......
    基于双无迹卡尔曼滤波的自动驾驶状态惯性监测;摘要:本研究有助于提高自动驾驶状态惯性监测能力,对自动驾驶技术的提高有一定的理论支撑意义。本文引用地址:1 引言 为了对分布动力结构汽车进行主动控制,需要......
    自平衡小车系统的控制过程是微控制器对姿态检测传感器和编码器等采集的数据进行分析处理,计算出使系统恢复平衡的实时控制量,从而驱动电机实现系统的动态平衡。 针对小车系统的复杂性,本文提出了将卡尔曼滤波算法和双闭环PID控制......
    什么是电池管理系统(BMS)的算法?;什么是BMS算法?加减乘除,最小二乘法,安时积分,卡尔曼滤波等都是算法。 BMS算法中SOC是重要项,但优秀的BMS绝不是把SOC当作核心,而是......
    基于卡尔曼滤波器的自动驾驶算法;组成自动驾驶的关键技术包括感知、规划和控制三大部分。自动驾驶车通过传感器感知环境并进行定位,根据感知系统获得的信息和行驶目标进行速度和路径的规划,并以......
    了当下动力电池领域的研究热点。 卡尔曼滤波算法是有效的、经典的智能算法,能够实现最小方差的最优状态估计,目前被广泛应用于许多工程领域。由于其具有较好的估计精度和时效性,结合基尔霍夫定律搭建的二阶RC模型一起使用,已逐渐成为电池SOC......
    过程的初始状态,再根据如下所示的卡尔曼滤波的5个公式即可对车速进行滤波,最终得到车速的估计值及加速度的估计值。 其中,测量信息为:。 坡度估计 设上述通过卡尔曼滤波估计得到的加速度为,则可......

我们与500+贴片厂合作,完美满足客户的定制需求。为品牌提供定制化的推广方案、专属产品特色页,多渠道推广,SEM/SEO精准营销以及与公众号的联合推广...详细>>

利用葫芦芯平台的卓越技术服务和新产品推广能力,原厂代理能轻松打入消费物联网(IOT)、信息与通信(ICT)、汽车及新能源汽车、工业自动化及工业物联网、装备及功率电子...详细>>

充分利用其强大的电子元器件采购流量,创新性地为这些物料提供了一个全新的窗口。我们的高效数字营销技术,不仅可以助你轻松识别与连接到需求方,更能够极大地提高“闲置物料”的处理能力,通过葫芦芯平台...详细>>

我们的目标很明确:构建一个全方位的半导体产业生态系统。成为一家全球领先的半导体互联网生态公司。目前,我们已成功打造了智能汽车、智能家居、大健康医疗、机器人和材料等五大生态领域。更为重要的是...详细>>

我们深知加工与定制类服务商的价值和重要性,因此,我们倾力为您提供最顶尖的营销资源。在我们的平台上,您可以直接接触到100万的研发工程师和采购工程师,以及10万的活跃客户群体...详细>>

凭借我们强大的专业流量和尖端的互联网数字营销技术,我们承诺为原厂提供免费的产品资料推广服务。无论是最新的资讯、技术动态还是创新产品,都可以通过我们的平台迅速传达给目标客户...详细>>

我们不止于将线索转化为潜在客户。葫芦芯平台致力于形成业务闭环,从引流、宣传到最终销售,全程跟进,确保每一个potential lead都得到妥善处理,从而大幅提高转化率。不仅如此...详细>>