• butler
    了解作者
  • matlab
    开发工具
  • 3KB
    文件大小
  • rar
    文件格式
  • 0
    收藏次数
  • 10 积分
    下载积分
  • 50
    下载次数
  • 2017-08-17 02:04
    上传日期
提供机器人的轨迹跟踪控制MATLAB原代码,完成指定路径
backstepping path following using matlab.rar
  • yuanljtest1.m
    1.9KB
  • tuoyuan2lj.m
    1.3KB
  • zhixianljtest1.m
    1.9KB
  • renyilj.m
    2.1KB
  • www.pudn.com.txt
    218B
内容介绍
t=0:0.1:100; n=length(t); a=1;b=1.5; l=0.2005; r=0.097; e=[]; u=[]; se=[]; se(1)=pi*3/4; k1=0.01;k2=0.01;ky=1.5;ks=15.2; ser=[];vc=[]; x=[];y=[];xe=[];ye=[];see=[]; x(1)=1.2;y(1)=0.8; w=[];w(1)=0.3; v=[];v(1)=0.4; xr=[];yr=[];yr(1)=0;xr(1)=1;ser(1)=pi/2; p=[];seo=[]; for i=1:n vc=2.5-2*i*0.1/(0.1*i+5);wc=1+0.2*i/(0.1*i+5); vcd=-0.2*((0.1*i+5)^(-1))+0.02*i*((0.1*i+5)^(-2)); wcd=0.2*((0.1*i+5)^(-1))-0.02*i*((0.1*i+5)^(-2));rc=0.2; ser(i+1)=ser(i)+wc*0.1; xr(i+1)=xr(i)+0.1*vc*cos(ser(i+1));yr(i+1)=yr(i)+0.1*vc*sin(ser(i+1)); se(i+1)=se(i)+0.1*w(i); x(i+1)=x(i)+0.1*v(i)*cos(se(i)); y(i+1)=y(i)+0.1*v(i)*sin(se(i)); e=[cos(se(i))*(xr(i)-x(i))+sin(se(i))*(yr(i)-y(i)); -sin(se(i))*(xr(i)-x(i))+cos(se(i))*(yr(i)-y(i)); ser(i)-se(i)]; xe(i)=e(1);ye(i)=e(2);see(i)=e(3); jiaosd=wc+2*vc*ky*ye(i)*cos(see(i)/2)+ks*sin(see(i)/2); yed=-(wc+2*ky*ye(i)*vc*cos(see(i))+ks*sin(see(i)/2))*xe(i)+vc*sin(see(i)); sed=-2*ky*ye(i)*vc*cos(see(i)/2)-ks*sin(see(i)/2); jiaosdd=wcd+2*ky*(vc*yed+vcd*ye(i))*cos(see(i)/2)-ky*vc*ye(i)*sin(see(i)/2)*sed+0.5*ks*cos(see(i)/2)*sed; xiansd=vc*cos(see(i))+k1*sin(atan(jiaosd))*jiaosd*xe(i)-k1*vc*sin(atan(jiaosd))*sin(see(i))+k2*(xe(i)-k1*sin(atan(jiaosd))*ye(i))-k1*cos(atan(jiaosd))*(1/(1+jiaosd^2))*jiaosdd*ye(i); w(i+1)=jiaosd;v(i+1)=xiansd; end figure; plot(x(1:1000),y(1:1000),':k'); hold on; plot(xr(1:1000),yr(1:1000),'r');h_xlabel=xlabel('x/m');h_ylabel=ylabel('y/m');h_legend=legend('实际轨迹','期望轨迹',2);legend boxoff; set(h_xlabel,'fontsize',16);set(h_ylabel,'fontsize',16);set(gca,'fontsize',14); set(h_legend,'fontsize',18); saveas(gcf,'renyiyi','emf'); zuob1=(1:100)/10; figure;plot(zuob1,v(1:100),'r');hold on; plot(zuob1,w(1:100),'g'); zuob=(1:1000); figure;plot(zuob/10,xr(1:1000)-x(1:1000),'r');h_xlabel=xlabel('t/s');h_ylabel=ylabel('x_e/m, y_e/m, \theta_e/rad');hold on;plot(zuob/10,yr(1:1000)-y(1:1000),':k');hold on;plot(zuob/10,see(1:1000)+0.01,'--b'); h_legend=legend('x_e','y_e','\theta_e',1);legend boxoff; set(h_xlabel,'fontsize',16);set(h_ylabel,'fontsize',16);set(gca,'fontsize',14);set(h_legend,'fontsize',18); saveas(gcf,'renyier','emf');
评论
    相关推荐
    • matlab 实现backstepping控制.rar
      利用反步法实现路径跟踪,包括直线、椭圆,圆轨迹等
    • 基于反步法(backstepping)的船舶直线路径跟踪控制程序
      一个基于反步法(backstepping)的,能跟踪直线的matlab程序,
    • lzw_soft.zip
      lzw压缩解压算法源码
    • work.rar
      常用图像压缩编码码matlab实现。包括:DM编码、变换编码(FFT和DCT)、算术编码、行程编码、Huffman编码、线性预测编码和一个近似的JPEG编码过程。非常适合入门用户实践。
    • bzip.tar.gz
      高效率的一种通用压缩/解压程序
    • VBdesign.zip
      VB程序设计实例,可以实现俄罗斯方块游戏的设计,谢谢。
    • zipsrc.zip
      zip压缩算法,类似winzip
    • zlib.zip
      zlib源码
    • LZW算法源码C语言.rar
      LZW压缩算法简介 作者:宋成 描述:一篇关于LZW压缩算法简介的文章,通俗易懂,值得一看! 备注:该文章整理自软件报1998年合订本上册。 LZW压缩算法是一种新颖的压缩方法,由Lemple-Ziv-Welch 三人共同创造,用他们的名字命名。它采用了一种先进的串表压缩不,将每个第一次出现的串放在一个串表中,用一个数字来表示串,压缩文件只存贮数字,则不存贮串,从而使图象文件的压缩效率得到较大的提高。奇妙的是,不管是在压缩还是在解压缩的过程中都能正确的建立这个串表,压缩或解压缩完成后,这个串表又被丢弃。
    • H264资料集合.rar
      H264资料集合,一次下载,就可以拥有n多的代码, )希望大家喜欢