AStar remove path fix for GridEnv