d2ydt2.m

来自「该程序用PID系统实现差动转向车辆控制」· M 代码 · 共 8 行

%% Author: epokh
%% Website: www.epokh.org/drupy
%% This software is under GPL

function yrate=d2ydt2(vr,vl,theta0,t,b)
%% This function calculate the drift rate from center line (x axis)
    yrate=(vr+vl)*(vr-vl)*cos((vr-vl)*t/b+theta0);
end