Merge develop into sensor_readout to be able to work with Message in read_data methods.
develop
sensor_readout
Message
read_data