bit freaky readme :)
fix hmap init inside A*
tail-rec cons_path
actual A* algo