SHORTEST_PATH: begun improvements + bugfix

- fixed a bug related to vertex indexing when adding and removing
  walls. now connections work properly.
- VERTICEWIDTH changed to 10
- added logic to skip some vertices when pushing their centers to
  path to allow following a straight line without too frequent
  stops (which are caused by getting updated location/angle info).