objaxis.m

多智能体工具包

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;

ObjectCenter=ObjectPosition(1:2);
DeltaPosition=GoalPosition-ObjectCenter;

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