1.carsim相关设置
1.1输入输出设置
输入:无
输出:左前轮转角(deg)
侧向加速度(g)
质心侧偏角(deg)
横摆角速度(deg/s)
1.2车型、工况设置
车型:C-Class,Hatchback
工况:DLC@120km/h(Quick Start)
车速:120km/h
制动压力:0
转向系统:Double Lane Change(Quick Start)
其余保持不变即可
2.simulink模型、数据设置
2.1 车辆相关参数
m=1270;%质量
Iz=1536.7;%绕z轴转动惯量
a=1.015;%质心到前轴距离
b=1.895;%质心到后轴距离
k1=-25000;%前轮侧偏刚度
k2=-35000;%后轮侧偏刚度
u=120;%车速(km/h)
t=0.001;%采样时间
2.2二自由度相关方程
2.2.1状态方程(beta;wr)
![](https://i-blog.csdnimg.cn/blog_migrate/2a52fbfd4ee19a2c0177300ef7f0fae7.png)
2.2.2输出方程ay
![](https://i-blog.csdnimg.cn/blog_migrate/11d815976f9365cf8937fa576d22c2a3.png)
2.2 EKF相关设置
采用自带的EKF模块,对状态转移矩阵方程和观测方程进行m语言编程。
初始状态自行设置
![](https://i-blog.csdnimg.cn/blog_migrate/07b43abe4b2b9b228d0cbe6753973c95.png)
2.2.2 状态转移矩阵方程m语言编写
![](https://i-blog.csdnimg.cn/blog_migrate/542be36d085889f34cbc8a692f66df69.png)
2.2.2观测方程m语言编写
![](https://i-blog.csdnimg.cn/blog_migrate/a32f15f69f9b7692c1753d43bbccb2a2.png)
2.3模型搭建
![](https://i-blog.csdnimg.cn/blog_migrate/c9bc8b5cebbd455e9a8c53040ff6438e.png)
结果展示
![](https://i-blog.csdnimg.cn/blog_migrate/dcff31463e7a105bd288ff36b6be938f.png)
![](https://i-blog.csdnimg.cn/blog_migrate/cda563acd196befc8ad448e63fb31622.png)
4.结束