FUN FACT: Minecraft's mob pathfinding uses a system VERY similar to this one