# 基于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基于Matlab基于LQR实现车辆轨迹跟踪源码+详细文档+全部数据(高分课程设计).zip基于Matlab基于LQR实现车辆轨迹跟踪源码+详细文档+全部数据(高分课程设计).zip 【备注】 1、该资源内项目代码都经过测试运行成功,功能ok的情况下才上传的,请放心下载使用! 2、本项目适合计算机相关专业(如软件工程、计科、人工智能、通信工程、自动化、电子信息等)的在校学生、老师或者企业员工下载使用,也可作为毕设项目、课程设计、作业、项目初期立项演示等,当然也适合小白学习进阶。 3、如果基础还行,可以在此代码基础上进行修改,以实现其他功能,也可直接用于毕设、课设、作业等。 欢迎下载,沟通交流,互相学习,共同进步!
资源推荐
资源详情
资源评论
收起资源包目录
基于Matlab基于LQR实现车辆轨迹跟踪源码+详细文档+全部数据(高分课程设计).zip (10个子文件)
LQR-master
path_LQR.mat 2KB
path_S.mat 11KB
latError_LQR.mat 1KB
main.m 5KB
CircleGen.m 308B
path_Circle.mat 14KB
imgs
1.png 51KB
2.png 32KB
README.md 763B
171265889347208773632.zip 416B
共 10 条
- 1
资源评论
不走小道
- 粉丝: 3175
- 资源: 3971
下载权益
C知道特权
VIP文章
课程特权
开通VIP
上传资源 快速赚钱
- 我的内容管理 展开
- 我的资源 快来上传第一个资源
- 我的收益 登录查看自己的收益
- 我的积分 登录查看自己的积分
- 我的C币 登录后查看C币余额
- 我的收藏
- 我的下载
- 下载帮助
安全验证
文档复制为VIP权益,开通VIP直接复制
信息提交成功