Added BFS for getting distance in GridWorldDomain