Added Magnetometer data ready check