无碳小车Matlab轨迹仿真及路径图(共5页).doc

精选优质文档-倾情为你奉上无碳小车Matlab仿真程序及路径图1.仿真程序clearclctic%符号定义%重物下降的高度h%驱动轴转过角度sd2%驱动轴传动比i%转向轮轴心距b%转向杆的长c%转向轮转过的角度af%驱动轮半径R%驱动轮A与转向轮横向偏距a1%驱动轮B与转向轮横向偏距a2%驱动轴与转向轮的距离d%小车行驶的路程s%小车x方向的位移x%小车y方向的位移y%轨迹曲率半径rou%曲柄半径r1%绳轮半径r2%参数输入n=1000;h=linspace(0,0.4,n);i1=0.5;i2=1.05;R=0.16;%驱动轮A与转向轮横向偏距a1a1=0.08;%驱动轮B与转向轮横向偏距a2a2=0.08;%曲柄半径r1r1=0.02;%绳轮半径r2r0=0.006;%驱动轴与转向轮的距离dd=0.2;%连杆与转向轮的距离cc=0.04;%算法g=-10;sd0=h/r0;sd1=sd0/i1;