自动驾驶状态观测1-坡度估计

2024-01-05 12:14:04
开发
43

背景

自动驾驶坡度对纵向的跟踪精度和体感都有一定程度的影响。行车场景虽然一般搭载了GPS和IMU设备，但pitch角一般不准，加速度也存在波动大的特点。泊车场景一般在室内地库，受GPS信号遮挡影响，一般无法获取高程和坡度。搭载昂贵的传感器虽然也能获取所需的坡度，但成本高不利于量产。基于以上矛盾点，基于算法的状态观测器就显得尤为迫切。本文基于运动学方程和卡尔曼滤波，根据测量的速度v，底盘加速度a实时估计出坡度值slope.

1.建立运动学方程

在这里插入图片描述
由于自动驾驶场景坡度一般不大，可近似认为 sin(alpha)=alpha ,写成矩阵的形式如下：

2.使用卡尔曼滤波

由于本文建立的状态方程没有控制量u项，因此根据线性方程的卡尔曼滤波可得如下状态：

预测方程
在这里插入图片描述
校正方程

3.仿真效果

在这里插入图片描述

原文地址:https://blog.csdn.net/xiaohukuzai/article/details/135397644 本文来自互联网用户投稿，该文观点仅代表作者本人，不代表本站立场。本站仅提供信息存储空间服务，不拥有所有权，不承担相关法律责任。如若转载，请注明出处：https://www.suanlizi.com/kf/1743123672643801088.html 如若内容造成侵权/违法违规/事实不符，请联系《酸梨子》网邮箱：1419361763@qq.com进行投诉反馈，一经查实，立即删除！

阅读全部