- removed stale code
- 2D simulation
  * visualization
  * way-point following