noselocation.m

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

%% 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