Den basis offset ist :
// Get hard iron correction
mag_bias[0] = (mag_max[0] + mag_min[0])/2; // get average x mag bias in counts
mag_bias[1] = (mag_max[1] + mag_min[1])/2; // get average y mag bias in counts
mag_bias[2] = (mag_max[2] + mag_min[2])/2; // get average z mag bias in counts
Spater wird dan noch korrigiert mit die mRes (= empfundlichkeit in mGauss/rawValue) und MagCalibration (= Linearisierung ). Zum Anfang konnen sie sicher die RawWerte benutzen.
Ihre Heading (in Radialen) wird dan gegeben durch :
Atan2((Rawvalue_X-Magbias_X),(Rawvalue_Y-Magbias_Y))
Für ° zu bekommen nochmal multiplizieren mit 180/PI.
Lesezeichen