public void moveToShape(Collection<ShapeInArea> des, Class<? extends MoveType> type)
throws SOSActionException {
if (!(me.me() instanceof Human)) {
log().warn("can't use move in Center Agent " + me + "\n");
return;
}
try {
checkTraffic(); // TODO uncomment
MoveType mt = moves.get(type.hashCode());
if (mt != null) {
Path path = mt.getPathToShape(des);
log().debug("MOVE " + type.getSimpleName() + "\nTO : " + path + "\n");
move(path);
} else log().error(new Error("in move can not found type=" + type.getSimpleName()));
} catch (SOSActionException e) {
throw e;
} catch (Exception er) {
log().error(er);
log().warn("using bfs for finding path");
ArrayList<Area> goals = new ArrayList<Area>();
for (ShapeInArea shapeInArea : des) {
goals.add(shapeInArea.getArea(me.model()));
}
move(bfs.breadthFirstSearch((Area) me.location(), goals));
}
log().error("in move can not found type=" + type.getSimpleName());
me.problemRest("in move can not found type=" + type.getSimpleName());
}
public void moveXY(
Collection<Pair<? extends Area, Point2D>> destinations, Class<? extends MoveType> type)
throws SOSActionException {
if (!(me.me() instanceof Human)) {
log().warn("can't use move in Center Agent " + me + "\n");
return;
}
try {
checkTraffic();
MoveType mt = moves.get(type.hashCode());
if (mt != null) {
Path path = mt.getPathToPoints(destinations);
log().debug("MOVE XY" + type.getSimpleName() + "\nTO : " + path + "\n");
move(path);
} else log().error(new Error("in move can not found type=" + type.getSimpleName()));
} catch (SOSActionException e) {
throw e;
} catch (Exception er) {
log().error(er);
log().warn("using bfs for finding path");
move(bfs.breadthFirstSearchXY((Area) me.location(), destinations));
}
log().error("in move can not found type=" + type.getSimpleName());
me.problemRest("in move can not found type=" + type.getSimpleName());
}
public SOSFireProbability(SOSAgent agent) {
this.agent = agent;
log =
new SOSLoggerSystem(
(StandardEntity) agent.me(), "SOSFireProbability/", true, OutputType.File, true);
agent.sosLogger.addToAllLogType(log);
}
public boolean isReallyReacahble(Collection<Pair<? extends Area, Point2D>> targets) {
if (!(me.me() instanceof Human)) {
log()
.warn(
"can't use isReallyUnreachableXY in Center Agent "
+ me
+ " "
+ Arrays.toString(new Error().getStackTrace()));
return false;
}
PoliceReachablityMove pm = getMoveType(PoliceReachablityMove.class);
return pm.isReallyReachableXY(targets);
}
public boolean isReallyUnreachableXY(Collection<Pair<? extends Area, Point2D>> targets) {
if (!(me.me() instanceof Human)) {
log()
.warn(
"can't use isReallyUnreachableXY in Center Agent "
+ me
+ " "
+ Arrays.toString(new Error().getStackTrace()));
return false;
}
StandardMove sm = (StandardMove) moves.get(StandardMove.class.hashCode());
return sm.isReallyUnreachableXY(targets);
}
public long getWeightToLowProcess(List<ShapeInArea> targets, Class<? extends MoveType> type) {
long min = Long.MAX_VALUE;
MoveType movetype = moves.get(type.hashCode());
for (ShapeInArea shapeInArea : targets) {
if (shapeInArea
.getArea(me.model())
.equals(me.me().getAreaPosition())) { // source and destination is in same area
if (shapeInArea.contains(((Human) me.me()).getX(), ((Human) me.me()).getY())) {
log().debug("in shape--Yoosef");
return 0;
}
}
min =
Math.min(
min,
movetype.getWeightToLowProcess(
shapeInArea.getArea(me.model()),
shapeInArea.getCenterX(),
shapeInArea.getCenterY()));
}
if (min < 0) log().error(new Error("why it become negetive here???"));
return min;
}
public void move(Path path, Class<? extends MoveType> type) throws SOSActionException {
if (!(me.me() instanceof Human)) {
log().warn("can't use move in Center Agent " + me + "\n");
return;
}
MoveType mt = moves.get(type.hashCode());
if (mt != null) {
log().debug("MOVE " + type.getSimpleName() + "\nTO : " + path + "\n");
move(path);
} else log().error(new Error("in move can not found type=" + type.getSimpleName()));
log().error("in move can not found type=" + type.getSimpleName());
me.problemRest("in move can not found type=" + type.getSimpleName());
}
public SOSFireZoneManager(SOSWorldModel model, SOSAgent<?> me, AgentType agentType) {
this.me = me;
this.model = model;
log =
new SOSLoggerSystem(
me.me(),
"SOSFireSite/SOSFireSiteManager",
SOSConstant.CREATE_BASE_LOGS,
OutputType.File,
true);
fireSites = new ArrayList<Pair<ArrayList<SOSRealFireZone>, SOSEstimatedFireZone>>();
me.sosLogger.addToAllLogType(log);
merger = new SOSFireZoneMerger(this);
}
public void move(Path path, boolean checkStock) throws SOSActionException {
if (!(me.me() instanceof Human)) {
log().warn("can't use move in Center Agent " + me + "\n");
return;
}
if (path == null) {
log().error("move to null??....doing random walk");
((PlatoonAgent<?>) me).randomWalk(true);
}
log().debug("MOVE TO : " + path + "\n");
if (checkStock) checkStock(path);
Point2D xy = path.getDestination().second();
me.informationStacker.addInfo(me.model(), new MoveAction(path));
me.send(
new AKMove(me.getID(), me.model().time(), path.getIds(), (int) xy.getX(), (int) xy.getY()));
throw new SOSActionException("MoveXY(" + path + ", " + xy + ")");
}
private void sendStockMessage(Path path) {
if (me instanceof PoliceForceAgent) return;
if (!(me.me() instanceof Human)) return;
if (me.time() < 50) return;
Human meEntity = (Human) me.me();
if (meEntity.isBuriednessDefined() && meEntity.getBuriedness() > 0) return;
if (meEntity.getImReachableToEdges().isEmpty()) return;
if (me.isTimeToActFinished()) return;
if (me.lastException != null) return;
try {
// if (me.getMyClusterData().isCoverer())
// return;
if (me.me().getAreaPosition().isBlockadesDefined()
&& me.me().getAreaPosition().getBlockadesID().isEmpty()) {
boolean haveBlock = false;
for (Area neighbour : me.me().getAreaPosition().getNeighbours()) {
if (neighbour.isBlockadesDefined() && !neighbour.getBlockadesID().isEmpty())
haveBlock = true;
}
if (!haveBlock) return;
}
} catch (Exception e) {
e.printStackTrace();
}
log().debug("Sending Stock Message");
me.messageBlock = new MessageBlock(MessageXmlConstant.HEADER_AGENT_STOCK);
me.messageBlock.addData(
MessageXmlConstant.DATA_AREA_INDEX, me.me().getAreaPosition().getAreaIndex());
me.messages.add(me.messageBlock);
me.lowCommunicationMessages.add(me.messageBlock);
}
public boolean isReallyUnreachable(ShapeInArea sh) {
if (sh.contains(me.me().getPositionPoint().toGeomPoint())) return false;
long weightTo = moves.get(StandardMove.class.hashCode()).getWeightTo(sh);
if (weightTo < 0) log().error(new Error("why it become negetive here???"));
return weightTo > UNREACHABLE_COST;
}
private void check2CycleStock() throws SOSActionException {
CycleInformations cycleinfo1 = me.informationStacker.getInformations(1);
CycleInformations cycleinfo2 = me.informationStacker.getInformations(2);
if (!(cycleinfo1.getAct() instanceof MoveAction)
|| cycleinfo1.getAct() instanceof StockMoveAction) return;
if (!(cycleinfo2.getAct() instanceof MoveAction)
|| cycleinfo1.getAct() instanceof StockMoveAction) return;
Path path1 = ((MoveAction) cycleinfo1.getAct()).getPath();
// Path path2 = ((MoveAction) cycleinfo2.getAct()).getPath();
log().info("Two(2) cycle move ....");
log().debug("current position:" + me.me().getAreaPosition());
log().debug("1 cycle ago position:" + cycleinfo1.getPositionPair());
log().debug("2 cycle ago position:" + cycleinfo2.getPositionPair());
if (!cycleinfo1.getPositionPair().first().equals(cycleinfo2.getPositionPair().first())) return;
if (!cycleinfo1.getPositionPair().first().equals(me.me().getAreaPosition())) return;
if (SOSGeometryTools.getDistance(
cycleinfo1.getPositionPair().second(), cycleinfo2.getPositionPair().second())
> MoveConstants.TRAFFIC_CHECKING_DISTANCE) return;
//////////////// Stock Occured
log().debug("2 cycle stock occured!!!!!!!");
ArrayList<EntityID> entityPath = new ArrayList<EntityID>();
Area area = me.me().getAreaPosition();
log().debug("Current Position:" + area);
entityPath.add(area.getID());
Edge ed;
Area ne;
if (path1.getIds().size() > 0 && !path1.getIds().get(0).equals(area.getID())) {
ne = (Area) me.model().getEntity(path1.getIds().get(0));
ed = area.getEdgeTo(ne);
} else if (path1.getIds().size() > 1 && path1.getIds().get(0).equals(area.getID())) {
ne = (Area) me.model().getEntity(path1.getIds().get(1));
ed = area.getEdgeTo(ne);
} else {
ne = area.getNeighbours().get(0);
ed = area.getEdgeTo(ne);
}
log().debug("ne:" + ne + " ed:" + ed + " last move path:" + path1);
if (ed == null) {
log().error("[Move]edge is null!!!!!some problem!!!!");
ne = area.getNeighbours().get(0);
ed = area.getEdgeTo(ne);
log().debug("changed!!!! ne:" + ne + " ed:" + ed + " last move path:" + path1);
}
Point2D destXYAPointNearEdge;
if (ed != null) {
// if (area instanceof Road) {
Pair<Point2D, Point2D> points = getAPointInReachblePartEdges(area, ed);
destXYAPointNearEdge = points.second();
// } else {
// Line2D wallLine = ed.getLine();// new Line2D(edge.getStartX(), edge.getStartY(),
// edge.getEndX() - edge.getStartX(), edge.getEndY() - edge.getStartY());
// // ppp.add(new ShapeDebugFrame.Line2DShapeInfo(wallLine, "edge", Color.white.darker(),
// false, false));
// Vector2D offset;
// if (lastStockTime < me.time() - 4) {
// if (AliGeometryTools.havecorrectDirection(area)) {
// offset = wallLine.getDirection().getNormal().normalised().scale(1500);
// } else {
// offset = wallLine.getDirection().getNormal().normalised().scale(-1500);
// }
// } else {
// if (!AliGeometryTools.havecorrectDirection(area)) {
// offset = wallLine.getDirection().getNormal().normalised().scale(1500);
// } else {
// offset = wallLine.getDirection().getNormal().normalised().scale(-1500);
// }
// }
// destXYAPointNearEdge = ed.getMidPoint().plus(offset);
// }
} else {
log().error("[Move]edge is null!!!!!some problem!!!!");
destXYAPointNearEdge = area.getPositionPair().second();
}
log().debug("dest area for stock:" + area + " dst point:" + destXYAPointNearEdge);
me.send(
new AKMove(
me.getID(),
me.time(),
entityPath,
(int) destXYAPointNearEdge.getX(),
(int) destXYAPointNearEdge.getY()));
Path path =
new Path(
null,
null,
entityPath,
me.me().getPositionPair(),
new Pair<Area, Point2D>(area, destXYAPointNearEdge),
false);
me.informationStacker.addInfo(me.model(), new StockMoveAction(path));
// log().warn("Traffic Handeling should be change due to server doesn't support AKMotion");
lastStockTime = me.time();
throw new SOSActionException("Move Stock(" + area + " " + destXYAPointNearEdge + ")");
}
private void checkEarlyStock(Path path) throws SOSActionException {
Area source = me.me().getAreaPosition();
if (me.informationStacker.getInformations(1).getAct() instanceof MoveAction
&& me.informationStacker.getInformations(1).getPositionPair().first() instanceof Building) {
log()
.debug(
"last act is move and current position is in building ==> don't check early stock");
return;
}
if (me.informationStacker.getInformations(1).getAct() instanceof StockMoveAction) {
log().debug("last act is stock move ==> don't check early stock");
return;
}
if (source instanceof Building) {
log().debug("early stock detected!!! agent is in " + source);
ArrayList<EntityID> entityPath = new ArrayList<EntityID>();
entityPath.add(source.getID());
Area second = null;
Area third = null;
if (path.getIds().size() > 0 && !path.getIds().get(0).equals(source.getID())) {
second = (Area) me.model().getEntity(path.getIds().get(0));
if (path.getIds().size() > 1) third = (Area) me.model().getEntity(path.getIds().get(1));
} else if (path.getIds().size() > 1 && path.getIds().get(0).equals(source.getID())) {
second = (Area) me.model().getEntity(path.getIds().get(1));
if (path.getIds().size() > 2) third = (Area) me.model().getEntity(path.getIds().get(2));
} else {
log().warn("move path size is 0 can't checkEarlyStock!!!");
return;
}
if (second == null) {
log().warn("second is null can't checkEarlyStock!!!");
return;
} else {
ArrayList<Edge> edges = second.getEdgesTo(source);
int minDistance = Integer.MAX_VALUE;
for (Edge edge : edges) {
minDistance =
(int)
Math.min(
minDistance, SOSGeometryTools.distance(edge, me.me().getPositionPoint()));
}
// Edge fedge = second.getEdgeTo(source);
// if (SOSGeometryTools.distance(fedge, me.me().getPositionPoint()) <
// MoveConstants.ENTRACE_DISTANCE_MM+1000)
// return;
if (minDistance < MoveConstants.ENTRACE_DISTANCE_MM + 1000) {
log().debug("I'm too neat to edge in building... no need to check early stock");
return;
}
entityPath.add(second.getID());
}
if (third == null) {
log().debug("Move path is too small!!! no need to early stock handle");
return;
} else {
Edge ed = second.getEdgeTo(third);
Point2D destXYAPointNearEdge;
if (ed != null) {
Line2D wallLine =
ed
.getLine(); // new Line2D(edge.getStartX(), edge.getStartY(), edge.getEndX() -
// edge.getStartX(), edge.getEndY() - edge.getStartY());
// ppp.add(new ShapeDebugFrame.Line2DShapeInfo(wallLine, "edge", Color.white.darker(),
// false, false));
Vector2D offset;
if (AliGeometryTools.havecorrectDirection(second)) {
offset = wallLine.getDirection().getNormal().normalised().scale(15);
} else {
offset = wallLine.getDirection().getNormal().normalised().scale(-15);
}
destXYAPointNearEdge = ed.getMidPoint().plus(offset);
} else {
log().error("[Move]edge is null!!!!!some problem!!!!");
destXYAPointNearEdge = second.getPositionPair().second();
}
log()
.debug(
"source:"
+ source
+ " dest area for stock:"
+ second
+ " dst point:"
+ destXYAPointNearEdge);
me.send(
new AKMove(
me.getID(),
me.time(),
entityPath,
(int) destXYAPointNearEdge.getX(),
(int) destXYAPointNearEdge.getY()));
path =
new Path(
null,
null,
entityPath,
me.me().getPositionPair(),
new Pair<Area, Point2D>(second, destXYAPointNearEdge),
false);
me.informationStacker.addInfo(me.model(), new StockMoveAction(path));
throw new SOSActionException(
"Move Stock(" + source + "," + second + " " + destXYAPointNearEdge + ")");
}
}
}