Rapid development!
As usual, vast amount of changes.

Added Constant Bearing controller.
Prediction in DWA is working
A lot of other improvements to DWA.
Stepwise debug mode -- online plotting (see visualize methods)
...