Stability checks & mag data

Added checks for stability
Started reading Magnetometer data