前言
使MATLAB出的图里有车辆轮廓
一、车辆是什么?
阿克曼转向的车辆
二、使用步骤
1.
输入车辆中心坐标和航向角
newfile
function [x,y] = plot_Car(x,y,fi)
L=4;
H=1.6;
d=0.5*(L^2+H^2)^0.5;
a=atan(H/L);
x1=[x+d*cos(fi-a),y+d*sin(fi-a)];
x2=[x+d*cos(fi+a),y+d*sin(fi+a)];
x3=[x+d*cos(fi-a+pi),y+d*sin(fi-a+pi)];
x4=[x+d*cos(fi+a+pi),y+d*sin(fi+a+pi)];
X=[x1(1),x2(1),x3(1),x4(1),x1(1)];
Y=[x1(2),x2(2),x3(2),x4(2),x1(2)];
plot(X,Y);
end
2.
当要画出轨迹图时就可以调用上面的函
clear ;
close all ;
clc ;
dt=.1;
%基线
t=0:dt:60;
path(:,1)=t;
path(:,2)=10*sin(0.1*t);
path(:,3)=atan(cos(0.1*t));
figure(1);
v = VideoWriter('newfile.avi');
open(v)
for i=1:length(path)
plot(path(:,1),path(:,2),'k');
hold on
lunk(i,:)=plot_Car(path(i,1),path(i,2),path(i,3));
axis ([0 60 -30 30]);
pause(0.01);
hold off
F(i) = getframe;
end
writeVideo(v,F);
close(v);