void MarkDiagonal()
{
// * N .
// W . .
// . . .
for (int y = 0; y < Height; ++y)
{ // NORTH & WEST
for (int x = 0; x < Width; ++x)
{
Int2 p = new Int2(x, y);
JPSPlusMapBakerBlock block = GetBlockOrNull(p);
if (block == null)
{
continue;
}
if (x == 0 || y == 0)
{
block.SetDistance(EDirFlags.NORTHWEST, 0); // Diagonal-Wall Distance
continue;
}
Int2 p1 = p.Foward(EDirFlags.NORTH);
Int2 p2 = p.Foward(EDirFlags.NORTHWEST);
Int2 p3 = p.Foward(EDirFlags.WEST);
bool p1Walkable = IsWalkable(p1);
bool p3Walkable = IsWalkable(p3);
if (!p1Walkable || !IsWalkable(p2) || !p3Walkable)
{
block.SetDistance(EDirFlags.NORTHWEST, 0); // Diagonal-Wall Distance
continue;
}
JPSPlusMapBakerBlock prevBlock = GetBlockOrNull(p2);
if (p1Walkable && p3Walkable &&
(prevBlock.GetDistance(EDirFlags.NORTH) > 0 || prevBlock.GetDistance(EDirFlags.WEST) > 0))
{
block.SetDistance(EDirFlags.NORTHWEST, 1); // Initial Diagonal Distance
continue;
}
int distanceFromPrev = prevBlock.GetDistance(EDirFlags.NORTHWEST);
if (distanceFromPrev > 0)
{
block.SetDistance(EDirFlags.NORTHWEST, distanceFromPrev + 1); // Diagonal Distance
}
else
{
block.SetDistance(EDirFlags.NORTHWEST, distanceFromPrev - 1); // Diagonal-Wall Distance
}
}
} // NORTH & WEST
// . N *
// . . E
// . . .
for (int y = 0; y < Height; ++y)
{ // NORTH & EAST
for (int x = Width - 1; x >= 0; --x)
{
Int2 p = new Int2(x, y);
JPSPlusMapBakerBlock block = GetBlockOrNull(p);
if (block == null)
{
continue;
}
if (x == Width - 1 || y == 0)
{
block.SetDistance(EDirFlags.NORTHEAST, 0); // Diagonal-Wall Distance
continue;
}
Int2 p1 = p.Foward(EDirFlags.NORTH);
Int2 p2 = p.Foward(EDirFlags.NORTHEAST);
Int2 p3 = p.Foward(EDirFlags.EAST);
bool p1Walkable = IsWalkable(p1);
bool p3Walkable = IsWalkable(p3);
if (!p1Walkable || !IsWalkable(p2) || !p3Walkable)
{
block.SetDistance(EDirFlags.NORTHEAST, 0); // Diagonal-Wall Distance
continue;
}
JPSPlusMapBakerBlock prevBlock = GetBlockOrNull(p2);
if (p1Walkable && p3Walkable &&
(prevBlock.GetDistance(EDirFlags.NORTH) > 0 || prevBlock.GetDistance(EDirFlags.EAST) > 0))
{
block.SetDistance(EDirFlags.NORTHEAST, 1); // Initial Diagonal Distance
continue;
}
int distanceFromPrev = prevBlock.GetDistance(EDirFlags.NORTHEAST);
if (distanceFromPrev > 0)
{
block.SetDistance(EDirFlags.NORTHEAST, distanceFromPrev + 1); // Diagonal Distance
}
else
{
block.SetDistance(EDirFlags.NORTHEAST, distanceFromPrev - 1); // Diagonal-Wall Distance
}
}
} // NORTH & EAST
// . . .
// W . .
// * S .
for (int y = Height - 1; y >= 0; --y)
{ // SOUTH & WEST
for (int x = 0; x < Width; ++x)
{
Int2 p = new Int2(x, y);
JPSPlusMapBakerBlock block = GetBlockOrNull(p);
if (block == null)
{
continue;
}
if (x == 0 || y == Height - 1)
{
block.SetDistance(EDirFlags.SOUTHWEST, 0); // Diagonal-Wall Distance
continue;
}
Int2 p1 = p.Foward(EDirFlags.SOUTH);
Int2 p2 = p.Foward(EDirFlags.SOUTHWEST);
Int2 p3 = p.Foward(EDirFlags.WEST);
bool p1Walkable = IsWalkable(p1);
bool p3Walkable = IsWalkable(p3);
if (!p1Walkable || !IsWalkable(p2) || !p3Walkable)
{
block.SetDistance(EDirFlags.SOUTHWEST, 0); // Diagonal-Wall Distance
continue;
}
JPSPlusMapBakerBlock prevBlock = GetBlockOrNull(p2);
if (p1Walkable && p3Walkable &&
(prevBlock.GetDistance(EDirFlags.SOUTH) > 0 || prevBlock.GetDistance(EDirFlags.WEST) > 0))
{
block.SetDistance(EDirFlags.SOUTHWEST, 1); // Initial Diagonal Distance
continue;
}
int distanceFromPrev = prevBlock.GetDistance(EDirFlags.SOUTHWEST);
if (distanceFromPrev > 0)
{
block.SetDistance(EDirFlags.SOUTHWEST, distanceFromPrev + 1); // Diagonal Distance
}
else
{
block.SetDistance(EDirFlags.SOUTHWEST, distanceFromPrev - 1); // Diagonal-Wall Distance
}
}
} // SOUTH & WEST
// . . .
// . . E
// . S *
for (int y = Height - 1; y >= 0; --y)
{ // SOUTH & EAST
for (int x = Width - 1; x >= 0; --x)
{
Int2 p = new Int2(x, y);
JPSPlusMapBakerBlock block = GetBlockOrNull(p);
if (block == null)
{
continue;
}
if (x == Width - 1 || y == Height - 1)
{
block.SetDistance(EDirFlags.SOUTHEAST, 0); // Diagonal-Wall Distance
continue;
}
Int2 p1 = p.Foward(EDirFlags.SOUTH);
Int2 p2 = p.Foward(EDirFlags.SOUTHEAST);
Int2 p3 = p.Foward(EDirFlags.EAST);
bool p1Walkable = IsWalkable(p1);
bool p3Walkable = IsWalkable(p3);
if (!p1Walkable || !IsWalkable(p2) || !p3Walkable)
{
block.SetDistance(EDirFlags.SOUTHEAST, 0); // Diagonal-Wall Distance
continue;
}
JPSPlusMapBakerBlock prevBlock = GetBlockOrNull(p2);
if (p1Walkable && p3Walkable &&
(prevBlock.GetDistance(EDirFlags.SOUTH) > 0 || prevBlock.GetDistance(EDirFlags.EAST) > 0))
{
block.SetDistance(EDirFlags.SOUTHEAST, 1); // Initial Diagonal Distance
continue;
}
int distanceFromPrev = prevBlock.GetDistance(EDirFlags.SOUTHEAST);
if (distanceFromPrev > 0)
{
block.SetDistance(EDirFlags.SOUTHEAST, distanceFromPrev + 1); // Diagonal Distance
}
else
{
block.SetDistance(EDirFlags.SOUTHEAST, distanceFromPrev - 1); // Diagonal-Wall Distance
}
}
} // SOUTH & EAST
}
void MarkStraight()
{
// . . .
// W . .
// . . .
for (int y = 0; y < Height; ++y)
{ // WEST
bool isJumpPointLastSeen = false;
int distance = -1;
for (int x = 0; x < Width; ++x)
{
Int2 p = new Int2(x, y);
JPSPlusMapBakerBlock block = GetBlockOrNull(p);
if (block == null)
{
distance = -1;
isJumpPointLastSeen = false;
continue;
}
distance++;
if (isJumpPointLastSeen)
{
block.SetDistance(EDirFlags.WEST, distance); // Straight Distance
}
else
{
block.SetDistance(EDirFlags.WEST, -distance); // Straight-Wall Distance
}
if (block.IsJumpable(EDirFlags.EAST))
{
distance = 0;
isJumpPointLastSeen = true;
}
}
} // WEST
// . . .
// . . E
// . . .
for (int y = 0; y < Height; ++y)
{ // EAST
bool isJumpPointLastSeen = false;
int distance = -1;
for (int x = Width - 1; x >= 0; --x)
{
Int2 p = new Int2(x, y);
JPSPlusMapBakerBlock block = GetBlockOrNull(p);
if (block == null)
{
distance = -1;
isJumpPointLastSeen = false;
continue;
}
distance++;
if (isJumpPointLastSeen)
{
block.SetDistance(EDirFlags.EAST, distance); // Straight Distance
}
else
{
block.SetDistance(EDirFlags.EAST, -distance); // Straight-Wall Distance
}
if (block.IsJumpable(EDirFlags.WEST))
{
distance = 0;
isJumpPointLastSeen = true;
}
}
} // EAST
// . . .
// . . .
// . S .
for (int x = 0; x < Width; ++x)
{ // SOUTH
bool isJumpPointLastSeen = false;
int distance = -1;
for (int y = Height - 1; y >= 0; --y)
{
Int2 p = new Int2(x, y);
JPSPlusMapBakerBlock block = GetBlockOrNull(p);
if (block == null)
{
distance = -1;
isJumpPointLastSeen = false;
continue;
}
distance++;
if (isJumpPointLastSeen)
{
block.SetDistance(EDirFlags.SOUTH, distance); // Straight Distance
}
else
{
block.SetDistance(EDirFlags.SOUTH, -distance); // Straight-Wall Distance
}
if (block.IsJumpable(EDirFlags.NORTH))
{
distance = 0;
isJumpPointLastSeen = true;
}
}
} // SOUTH
// . N .
// . . .
// . . .
for (int x = 0; x < Width; ++x)
{ // NORTH
bool isJumpPointLastSeen = false;
int distance = -1;
for (int y = 0; y < Height; ++y)
{
Int2 p = new Int2(x, y);
JPSPlusMapBakerBlock block = GetBlockOrNull(p);
if (block == null)
{
distance = -1;
isJumpPointLastSeen = false;
continue;
}
distance++;
if (isJumpPointLastSeen)
{
block.SetDistance(EDirFlags.NORTH, distance); // Straight Distance
}
else
{
block.SetDistance(EDirFlags.NORTH, -distance); // Straight-Wall Distance
}
if (block.IsJumpable(EDirFlags.SOUTH))
{
distance = 0;
isJumpPointLastSeen = true;
}
}
} // NORTH
}