delete binaryheaptool  check gridmap is right and modify some variable tpye