Vector thrust controller

[Azimath]

The core functionality of controlling the sub in all 6 degrees of freedom given a sufficient set of thrusters in arbitrary positions is complete, but the automatic detection and re-computation of the thruster matrix hasn't been tested pending the thruster manager being able to send thruster alive data

[Azimath]

We need to work on how the optimizer prioritizes things when it can't deliver the full output