Working about pathfinding

server/tests/LocationGameStateTests.cpp

@@ -276,5 +276,58 @@ int main()
 		return fail("Enabled player acquired an autonomous attack target");
 	}
 
+	FRG::CharacterState guardedMover;
+	guardedMover.configureAsPlayer();
+	guardedMover.enabled = true;
+	guardedMover.position = Eigen::Vector3f::Zero();
+	guardedMover.walkTarget = Eigen::Vector3f(2.f, 0.f, 0.f);
+	guardedMover.requestedWalkTarget = guardedMover.walkTarget;
+	guardedMover.pathWaypoints = {guardedMover.walkTarget};
+	const std::vector<FRG::CharacterMovementObstacle> movementObstacles{
+		{"mover", Eigen::Vector3f::Zero(), 0.45f},
+		{"blocker", Eigen::Vector3f(0.8f, 0.f, 0.f), 0.45f}};
+	FRG::CharacterUpdateContext guardedContext;
+	guardedContext.characterId = "mover";
+	guardedContext.movementObstacles = &movementObstacles;
+	FRG::CharacterUpdateEvents blockedEvents;
+	for (int i = 0; i < 3; ++i)
+		blockedEvents = guardedMover.update(100, guardedContext);
+	if (!guardedMover.position.isZero() ||
+		blockedEvents.forceNavigationReplan ||
+		!guardedMover.pathWaypoints.empty()) {
+		return fail("Movement guard did not cancel the blocked player action");
+	}
+	nlohmann::json guardedJson;
+	guardedMover.save(guardedJson);
+	FRG::CharacterState restoredGuardedMover;
+	restoredGuardedMover.load(guardedJson);
+	if (restoredGuardedMover.movementBlockedTicks !=
+			guardedMover.movementBlockedTicks ||
+		restoredGuardedMover.navigationRetryTicks !=
+			guardedMover.navigationRetryTicks) {
+		return fail("Movement blockage state did not round trip");
+	}
+
+	FRG::LocationGameState occupancyState;
+	auto stationary = std::make_shared<FRG::CharacterState>();
+	stationary->enabled = true;
+	stationary->hp = 10.f;
+	stationary->position = Eigen::Vector3f(4.f, 0.f, 0.f);
+	auto moving = std::make_shared<FRG::CharacterState>();
+	moving->enabled = true;
+	moving->hp = 10.f;
+	moving->pathWaypoints = {Eigen::Vector3f(8.f, 0.f, 0.f)};
+	moving->movedLastTick = true;
+	FRG::PlayerStateMap occupancyPlayers{
+		{"stationary", stationary}, {"moving", moving}};
+	if (occupancyState.collectPathObstacles(
+			"requester", occupancyPlayers).size() != 1 ||
+		occupancyState.collectPathObstacles(
+			"requester", occupancyPlayers, "moving").size() != 2 ||
+		!occupancyState.collectPathObstacles(
+			"stationary", occupancyPlayers).empty()) {
+		return fail("Stationary obstacle collection policy is incorrect");
+	}
+
 	return EXIT_SUCCESS;
 }