Cleanup + more generalized code.

Added support for simulating multiple vessels at the same time with
unique set of controllers.
Support for N vessels, animation, restructuring...
Started sketch of DWA algorithm