Refactor of high-level code for D* Lite Visualization.
Actual visualization of D* Lite integrated again.
Now we need the rover to make the logical turns.