Added altimeter for baro_bmp.c and new message BMP_ALTITUDE