add my darft code for A star searching