Working Astar 
	TODO: avoid EMPTY if better