Started making the actual path finding
Pathfinding completed, first try
Pathfinding completed, second try
Pathfinding completed, third try
Somewhat working but still buggy version