1.课题概述
小车侧方位停车过程的动态模拟matlab仿真。仿真得到小车的停车动画，小车移动的xy轴坐标以及角度变换。
2.系统仿真结果
3.核心程序与模型
版本：MATLAB2022a
%阶段3
%车轮
pause(1);
for i=1:13ya1=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);endhold 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工具搭建仿真模型，并可视化整个停车过程。
