avoid collecting goal nodes several times in prepareCH; minor fix in Dijkstra and AStar
please no emails to private address :)