ADD Control allocation node for finned AUVs

Computes the optimal thrust force and fin command displacement

Signed-off-by: Musa Morena Marcusso Manhaes <Musa.Marcusso@de.bosch.com>