Fixed header for MS5611
Magnetometer test (doesn't work yet)