ADD Reimplementation of DVL sensor

Adding altitude information and beam link pose to the output.

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