标签:angle 小车 路径 约束 start dt path vel steering
小车模型
matlab 仿真:
code:
clc; close all; clear all;
dt = 0.1; % delta t
L = 7.5; % 车长
%开始位置及其方向
x_start = 2; y_start = 7; theta_start = 0;
%画初始位置
figure(1); axis([0 12 0 14]); hold on; grid on;
plot(x_start, y_start, 'ko', 'MarkerSize',10, 'MarkerFaceColor','k');
%加入path
path = [x_start, y_start, theta_start];
deltastep = 10; %迭代步数
max_steering_angle = 1.05; %转向角
steering_angle = -max_steering_angle;
while steering_angle <= max_steering_angle
linear_vel = 10;
for i = 2:deltastep
path(i,1) = path(i-1,1) + linear_vel*cos(path(i-1,3))*dt;
path(i,2) = path(i-1,2) + linear_vel*sin(path(i-1,3))*dt;
path(i,3) = path(i-1,3) + (linear_vel/L)*tan(steering_angle)*dt;
end
for j = 2:size(path,1)
line([path(j,1), path(j-1,1)], [path(j,2), path(j-1,2)], 'Color', 'k', 'LineWidth', 2);
drawnow
hold on
end
plot(path(j,1), path(j,2), 'ko', 'MarkerSize',5, 'MarkerFaceColor','r');
steering_angle = steering_angle + 0.1;
end
标签:angle,小车,路径,约束,start,dt,path,vel,steering 来源: https://blog.csdn.net/ljq31446/article/details/78963978
本站声明: 1. iCode9 技术分享网(下文简称本站)提供的所有内容,仅供技术学习、探讨和分享; 2. 关于本站的所有留言、评论、转载及引用,纯属内容发起人的个人观点,与本站观点和立场无关; 3. 关于本站的所有言论和文字,纯属内容发起人的个人观点,与本站观点和立场无关; 4. 本站文章均是网友提供,不完全保证技术分享内容的完整性、准确性、时效性、风险性和版权归属;如您发现该文章侵犯了您的权益,可联系我们第一时间进行删除; 5. 本站为非盈利性的个人网站,所有内容不会用来进行牟利,也不会利用任何形式的广告来间接获益,纯粹是为了广大技术爱好者提供技术内容和技术思想的分享性交流网站。