# 基于Matlab使用LQR实现车辆轨迹跟踪
1. 建立关于控制的误差微分方程
$\dot{e_{rr}}=Ae_{rr}+Bu$
2. 离散化
$e_{rr(k+1)}=\bar{A}e_{rr(k)}+\bar{B}u_{(k)}$
3. 迭代求解Raccati方程
$P_{k+1} = Q+\bar{A}^TP_{k}\bar{A}-\bar{A}^TP_{k}\bar{B}(R+\bar{B}^TP_{k}\bar{B})^{-1}\bar{B}^TP_{k}\bar{A}$
4. LQR求得的最优控制律u是关于状态量的线性函数
$K=(R+\bar{B}^TP\bar{B})^{-1}\bar{B}^TP\bar{A}$
$u_k=-Ke_{rr(k)}$
在参考资料1的基础上修正部分错误,优化代码,演示算法。
![跟踪效果](./imgs/1.png)
![横向误差](./imgs/2.png)
## 参考
1. [B站小黎](https://www.bilibili.com/video/BV1GN411X74z/?spm_id_from=333.999.0.0&vd_source=be5bd51fafff7d21180e251563899e5e)
毕设&课程作业_基于Matlab使用LQR实现车辆轨迹跟踪.zip
版权申诉
184 浏览量
2024-01-11
17:22:34
上传
评论
收藏 107KB ZIP 举报
学术菜鸟小晨
- 粉丝: 1w+
- 资源: 4941
最新资源
- html+css+'青春献礼二十大 红色旅游助乡村'为主题的网页设计 2022年参与学校网页设计比赛时完成的
- Unity 模型布尔运算插件
- eCANtools工具,CAN资料包
- 129335283047061xiazaigongjuxiang(去重软件).apk
- Android环境检测工具,检测ksu,lsp,magisk等
- WordPress后台美化插件QuarterAdmin分享
- PCB_Project单片机绘制 (2024-5-11 22-22-13).zip
- nccl-local-repo-ubuntu2204-2.21.5-cuda12.4-1.0-1-amd64
- STM32移植LVGL源码工程 stm32移植GUI-Guider源码 LVGL移植源码
- Screenshot_20240522_084328_com.tencent.mm.jpg
资源上传下载、课程学习等过程中有任何疑问或建议,欢迎提出宝贵意见哦~我们会及时处理!
点击此处反馈