资源简介
adapt.m
代码片段和文件信息
%两轮差分驱动机器人轨迹跟踪adapt
clear all;clc;
c1=3.6;c2=2.1;c3=-2.5;
dt=0.2;d=0.05; %时间间隔
xc=[2 4 10 13 15 18 23 20 6 14 18 16];
yc=[8 15 21 26 28 27 21 12 14 16 22 21]; %被跟踪轨迹(路径),以离散点表示
wr(1)=0;vr(1)=1.4; %被跟踪轨迹初始角速度、初始线速度
a=length(xc); %离散点个数
xs(1)=12;ys(1)=1;ths(1)=pi/14;ws(1)=1;vs(1)=1.2; %实际轨迹的初始点信息,即出发点位置、角度、角速度、线速度
k=1;
%将被跟踪轨迹分段作为跟踪直线处理,相邻离散点之间为一段新的被跟踪轨迹
for i=1:a-1
dy=yc(i+1)-yc(i);
dx=xc(i+1)-xc(i);
n(i)=sqrt(dy^2+dx^2)/dt; %每个分段再分为若干时间段
thr(1)=atan(dy/dx);th(1)=ths(k); %每个分段轨迹的初始角度,实际轨迹的初始角度
if dx<0
thr(1)=pi+atan(dy/dx);th(1)=pi+ths(k);
end
x(1)=xs(k);y(1)=ys(k);w(1)=ws(k); v(1)=vs(k); %每个分段实际轨迹的初始点信息,即出发点位置、角速度、线速度
xr(1)=xc(i);yr(1)=yc(i);wr=0;vr=1; %每个分段被跟踪轨迹的初始点信息,即出发点位置、角速度、线速度
for j=1:n(i)-1
%运动学模型
thr(j)=thr(1);
xr(j+1)=xr(j)+dt*vr*cos(thr(j));
yr(j+1)=yr(j)+dt*vr*sin(thr(j));
%运动学模型
th(j+1)=th(j)+dt*w(j);
x(j+1)=x(j)+dt*v(j)*cos(th(j));
y(j+1)=y(j)+dt*v(j)*sin(th(j));
%每个分段的跟踪误差
e=[ cos(th(j))*(xr(j)-x(j))+sin(th(j))*(yr(j)-y(j));
-sin(th(j))*(xr(j)-x(j))+cos(th
相关资源
- 《MATLAB仿真在现代通信中的应用》徐
- KECA1.m
- zw_支持向量机与朴素贝叶斯算法matl
- test1_mat.m
- Finnal6.m
- odefun1.m
-
飞控simuli
nk仿真.zip -
光伏发电最大功率点跟踪simuli
nk仿真 - MATLAB全球磁场绘图程序.zip
- MATLAB人脸识别考勤系统摄像头,记录
- MATLAB多方法车牌识别系统bp+模板+GUI
- 四旋翼MATLAB仿真文件实验报告.zip
-
4.1基于Simuli
nk的图像、视频处理.z -
Simuli
nk的低通数字滤波器的仿真分析 - matlabR2017b迅雷种子文件及安装教程.
- 最优化方法及其matlab程序实现.zip
- 5d5680a96365f0e9a0c7114890f97460.mobi
- 《全面详解LTE:MATLAB建模、仿真与实
- XXXXXXRobustControlDesignwithMATLAB.pdf
- matlab图像处理包括数据反演以及其他
- Matlab常用32种算法.zip
- 传感器网络节点定位算法matlab代码.
- 基于DCT变换和DFT变换的数字图像压缩
- 10900257雷达系统设计MATLAB仿真.pdf
- 神经网络、遗传算法、支持向量机、
- 《先进PID控制MATLAB仿真第3版》仿真程
- 雷达系统设计MATLAB仿真.pdf196612
- 滑模变结构控制MATLAB仿真(第1版)(
- [Matlab作品]matlab实现视频中动态目标跟
- zw_qq_15023225-7501331-S函数的BP神经网络
评论
共有 条评论