noselocation.m

该程序用PID系统实现差动转向车辆控制

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

function heading=NoseLocation(position,bw)
        theta=position(3);
        hx = position(1) + bw/2 * cos(theta);
        hy = position(2) + bw/2 * sin(theta);
        heading=[hx,hy];
end