车辆轨迹跟踪画出小车

zibianqu

关注

阅读 46

2022-01-08

提示:文章写完后,目录可以自动生成,如何生成可参考右边的帮助文档

文章目录


前言

使MATLAB出的图里有车辆轮廓


提示:以下是本篇文章正文内容,下面案例可供参考

一、车辆是什么?

阿克曼转向的车辆

二、使用步骤

1.

输入车辆中心坐标和航向角

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);


总结

提示:这里对文章进行总结:
例如:以上就是今天要讲的内容,本文仅仅简单介绍了pandas的使用,而pandas提供了大量能使我们快速便捷地处理数据的函数和方法。

精彩评论(0)

0 0 举报