public void followUpdate() {
ObjectStub followObj = (ObjectStub) followTarget.getEntity(Namespace.MOB);
Point followLoc = followObj.getWorldNode().getLoc();
InterpolatedWorldNode node = obj.getWorldNode();
Point myLoc = node.getLoc();
long oid = obj.getOid();
float fdist = Point.distanceTo(followLoc, destLoc);
float dist = Point.distanceTo(followLoc, myLoc);
if (Log.loggingDebug)
Log.debug(
"BaseBehavior.followUpdate: oid = "
+ oid
+ "; myLoc = "
+ myLoc
+ "; followLoc = "
+ followLoc
+ "; fdist = "
+ fdist
+ "; dist = "
+ dist);
long msToSleep = (long) 500;
// If the new target location is more than a meter from
// the old one, create a new path.
if (fdist > 1000) {
long msToDest = setupPathInterpolator(oid, myLoc, followLoc, true, node.getFollowsTerrain());
destLoc = followLoc;
msToSleep = msToDest == 0 ? (long) 500 : Math.min((long) 500, msToDest);
}
// Else if we're interpolating, interpolate the current path
else if (interpolatingPath) {
interpolatePath();
if (Log.loggingDebug)
Log.debug(
"baseBehavior.followUpdate: oid = "
+ oid
+ "; interpolated myLoc = "
+ obj.getWorldNode().getLoc());
}
scheduleMe(interpolatingPath ? msToSleep : pathState.pathTimeRemaining());
}
/**
* Test if the perceived object has come in or out of range of the perceiver object; if so, we
* change the inRangeOids set for the perceiver, and notify the perceiver.
*/
protected void testProximity(
PerceiverData perceiverData,
PerceiverData perceivedData,
boolean interpolatePerceiver,
boolean interpolatePerceived) {
Point perceiverLoc =
interpolatePerceiver ? perceiverData.wnode.getLoc() : perceiverData.lastLoc;
Point perceivedLoc =
interpolatePerceived ? perceivedData.wnode.getLoc() : perceivedData.lastLoc;
float distance = Point.distanceTo(perceiverLoc, perceivedLoc);
float reactionRadius = perceiverData.reactionRadius;
long perceiverInstance = perceiverData.wnode.getInstanceOid();
long perceivedInstance = perceivedData.wnode.getInstanceOid();
boolean sameInstance = perceiverInstance == perceivedInstance;
boolean inRadius = sameInstance && (distance < reactionRadius);
boolean wasInRadius = perceiverData.inRangeOids.contains(perceivedData.perceiverOid);
// if (Log.loggingDebug)
// Log.debug("ProximityTracker.testProximity: perceiver " +
// perceiverData.perceiverOid + ", perceiverLoc = " + perceiverLoc +
// ", perceived " + perceivedData.perceiverOid + ", perceivedLoc = " +
// perceivedLoc +
// ", distance " + distance + ", reactionRadius " + reactionRadius + ",
// perceiverInstance " + perceiverInstance +
// ", perceivedInstance " + perceivedInstance + ", inRadius " + inRadius + ",
// wasInRadius " + wasInRadius);
if (inRadius == wasInRadius) return;
if (sameInstance && hystericalMargin != 0f) {
if (wasInRadius) inRadius = distance < (reactionRadius + hystericalMargin);
else inRadius = distance < (reactionRadius - hystericalMargin);
// If they are the same after hysteresis was applied, skip.
if (inRadius == wasInRadius) return;
}
if (inRadius) {
perceiverData.inRangeOids.add(perceivedData.perceiverOid);
perceivedData.inRangeOids.add(perceiverData.perceiverOid);
} else {
perceiverData.inRangeOids.remove(perceivedData.perceiverOid);
perceivedData.inRangeOids.remove(perceiverData.perceiverOid);
}
performNotification(
perceiverData.perceiverOid, perceivedData.perceiverOid, inRadius, wasInRadius);
}