add A star algorithm