a lot of changes. more conformity to the paper. improved merged testing for heuristic and vi. allow robot placement at current vertex through a parameter