基于PID算法控制车辆跟踪圆形轨迹 MATLAB代码


clear all;
close all;
clc;%% 参数
ts=0.1;
t=30;
d=1.45;
p=-0.6;%% 初始状态
x(1)=0;
y(1)=0;
xita(1)=0;
v=3;
w=0.2;
u=[v;w];
Z(:,1)=[-3;-3;0.2];
for k=1:1:t/tstimes(k+1)=k*ts;X(:,k)=[cos(xita(k)) -d*sin(xita(k));sin(xita(k)) d*cos(xita(k));0 1]*u;%% 状态更新x(k+1)=x(k)+X(1,k)*ts;y(k+1)=y(k)+X(2,k)*ts;xita(k+1)=xita(k)+X(3,k)*ts;Z_=p*Z(:,k);%每秒变化率Z(:,k+1)=Z(:,k)+Z_*ts;%每步变化率xc(k)=Z(1,k)+x(k);yc(k)=Z(2,k)+y(k);
endfigure(1);
for k=1:1:length(xc)
plot(x,y,'r','Linewidth',2);
hold on;
plot(xc(k),yc(k),'sb','MarkerSize',10);
pause(0.1);
end
figure(2);
plot(times,Z(1,:),'r');
figure(3);
plot(times,Z(2,:),'r');
figure(4);
plot(times,Z(3,:),'r');

基于PID算法控制车辆跟踪圆形轨迹 MATLAB代码相关推荐

基于MPC算法控制车辆的运动轨迹
资源下载地址:https://download.csdn.net/download/sheziqiong/85836018 资源下载地址:https://download.csdn.net/downl ...
基于双参数蜜蜂算法解决车辆路径问题（Matlab代码实现）
目录 1 概述 1.1研究背景 2 运行结果 3 Matlab代码实现 4 参考文献 1 概述群智能起源于自然环境中生物群体经过长期自然进化后具有的解决问题的能力,其中的许多问题在人类看来可以 ...
【优化布局】基于免疫算法求解充电站最优布局matlab代码
1 简介为了普及电动汽车,以缓解我国日益严重的环境能源问题,本文研究电动汽车充换电站的选址方法,旨在利用提高电动汽车充电设施的覆盖范围,加快电动汽车的普及发展.本文建立人们日常出行模型,模拟电动汽车 ...
【优化求解】基于秃鹰算法BES求解最优目标matlab代码
1 简介秃鹰搜索 (bald eagle search,BES) 优化是马来西亚学者Alsattar 于2020年提出的一种新型元启发式算法, 该算法具有较强的全局搜索能力, 能够有效地解决各类复杂 ...
【WSN通信】基于注水算法实现宽带无线通信资源分配附matlab代码
1 简介功率分配技术能有效提高认知网络传输链路的信道容量,而注水算法利用凸优化的思想能实现功率分配最优化.针对认知网络中使用注水算法分配信道功率时未考虑邻近认知信道干扰的情况,对认知网络中邻近认知信 ...
【优化求解】基于灰狼算法GWO求解最优目标matlab代码
1 简介 Mirjalili 等人提出了一种新的群体智能算法---灰狼优化算法(GWO),并通过多个基准测试函数进行测试,从结果上验证了该算法的可行性,通过对比,GWO 算法已被证明在算法对函数求解精 ...
【优化求解】基于蝗虫算法求解单目标问题附matlab代码
1 简介蝗虫算法( Grasshopper Optimization Algorithm,GOA ) 是由 Saremi 等[1]于2017 年提出的一种元启发式仿生优化算法.具体原理如下: 2 ...
【图像增强】基于萤火虫算法实现图像对比度增强附matlab代码
1 内容介绍由于图像本身的复杂性和数据量大,传统的图像处理和分析技术常存在计算复杂度高的问题,因此基于进化算法的图像处理方法得到广泛研究和关注.萤火虫算法(Firefly Algorithm,FA) ...
【图像分割】基于麻雀算法优化Kmeans实现图像分割附Matlab代码
1 内容介绍提出一种基于K-Means聚类的麻雀算法,该算法利用麻雀算法鲁棒性较强且不易陷入局部最优值的特点,动态的确定了聚类的数目和中心,解决了K-Means聚类初始点选择不稳定的缺陷,在此两种算 ...

基于PID算法控制车辆跟踪圆形轨迹 MATLAB代码

基于PID算法控制车辆跟踪圆形轨迹 MATLAB代码相关推荐

最新文章

热门文章