目录
1.课题概述
2.系统仿真结果
3.核心程序与模型
4.系统原理简介
5.完整工程文件
1.课题概述
小车侧方位停车过程的动态模拟matlab仿真。仿真得到小车的停车动画,小车移动的xy轴坐标以及角度变换。
2.系统仿真结果
3.核心程序与模型
版本:MATLAB2022a
..................................................................................
%阶段3
%车轮
pause(1);
for i=1:13
ya1=ya1+0.5;
yb1=yb1+0.5;
ya2=ya2+0.5;
yb2=yb2+0.5;
cla;
patch([Car2pos_x1 Car2pos_x2 Car2pos_x3 Car2pos_x4],[Car2pos_y1 Car2pos_y2 Car2pos_y3 Car2pos_y4],[0.7 0.7 0]);
patch([Car1pos_x1 Car1pos_x2 Car1pos_x3 Car1pos_x4],[Car1pos_y1 Car1pos_y2 Car1pos_y3 Car1pos_y4],[0.7 0.7 0]);
patch([xa1 xb1 xb2 xa2],[ya1 yb1 yb2 ya2],[0 1 0]);
ya11=ya1+(D-WLen/2);
yb11=ya11+WLen;
ya21=ya2+(D-WLen/2);
yb21=ya21+WLen;
xa11=xa2+(Wkd/2);
xb11=xa2+(Wkd/2);
xa21=xa2-(Wkd/2);
xb21=xa2-(Wkd/2);
patch([xa11 xb11 xb21 xa21],[ya11 yb11 yb21 ya21],[0 0 0]);
xa22=xa1-(Wkd/2);
xb22=xa1-(Wkd/2);
xa12=xa1+(Wkd/2);
xb12=xa1+(Wkd/2);
patch([xa12 xb12 xb22 xa22],[ya11 yb11 yb21 ya21],[0 0 0]);
ya13=ya11+Hcar;
yb13=yb11+Hcar;
patch([xa11 xb11 xb21 xa21],[ya13 yb13 yb13 ya13],[0 0 0]);
patch([xa12 xb12 xb22 xa22],[ya13 yb13 yb13 ya13],[0 0 0]);
pause(.02);
end
hold on
plot(-59*ones(1,121),[-20:100],'r','linewidth',2);
hold on
plot(-40*ones(1,121),[-20:100],'r','linewidth',2);
hold on
plot(-21*ones(1,121),[-20:100],'r','linewidth',2);
hold on
plot(-2*ones(1,121),[-20:100],'r','linewidth',2);
hold on
plot(17*ones(1,121),[-20:100],'r','linewidth',2);
hold on
plot(36*ones(1,121),[-20:100],'r','linewidth',2);
hold on
plot(55*ones(1,121),[-20:100],'r','linewidth',2);
hold on
plot(74*ones(1,121),[-20:100],'r','linewidth',2);
hold on
figure;
subplot(121);
plot(Xset,'b-o')
hold on
plot(Yset,'r-s')
legend('x坐标变化','y坐标变化');
subplot(122);
plot(thetas,'b-o')
legend('角度变化');
38
4.系统原理简介
假设小车是一个刚体,其侧方位停车过程中涉及到以下几个关键状态变量:
- 位置坐标:小车前端中心点在水平面上的坐标(x, y)。
- 角度:小车与垂直方向之间的夹角θ。
- 速度:小车向前和向侧面的线速度(vx, vy)。
- 角速度:小车转向的角度速度ω。
侧方位停车的过程可以拆分为直线行驶、转向、倒车和微调等阶段,对于每一个阶段,可以分别建立相应的运动学方程:
结合上述运动学模型和控制策略,构建小车侧方位停车的动态模拟流程,包括:
- 设定初始条件(小车位置、速度、目标车位位置等)。
- 设计和实现控制器,根据当前状态计算下一步的控制输入(驱动力矩、转向角等)。
- 更新小车的运动状态(位置、速度、角度)。
- 检查是否达到停车条件(如与车位边界点的距离是否小于阈值),未达到则重复步骤2和3,直至成功停车。
这样的模拟有助于验证控制策略的有效性,优化停车算法,并在实际应用前对停车过程进行预判和调试。在实际编程实现时,可以利用Matlab工具搭建仿真模型,并可视化整个停车过程。
5.完整工程文件
v