optmize astar algorithm and add jumpsearch algorithm