objaxis.m

来自「多智能体工具包」· M 代码 · 共 14 行

function objaxis
% OBJAXIS	Calculate the absolute angle of the moving coordinate axis.

%     Copyright (c) 1998-2000 Jiming Liu and Jianbing Wu

global AxisDirection ObjectPosition GoalPosition;

DeltaPosition=GoalPosition-ObjectPosition;

AxisDirection=atan2(DeltaPosition(2),DeltaPosition(1));
if AxisDirection<0
  AxisDirection=2*pi+AxisDirection;
end;