Erfahrungswerte L3G4200D (Offset)

[Florian K. (f-kae)]

Hallo, mal wieder geht es für mich um das Gyroscope L3G4200D!

Hat jemand Erfahrungswerte mit diesem Gyroscope gesammelt?

Ich hänge an der Offset Eliminierung.

Folgendermaßen habe ich versucht den Offset raus zu rechnen:

float X_Offset = 0;

void Clean_Offset(void)
{
  for(uint8_t i = 0; i<200; i++)
  {
    uint8_t XH = ReadByteSPI(OUT_X_H);
    uint8_t XL = ReadByteSPI(OUT_X_L);
    X_Offset += (((XH << 8) | XL));
  }
  X_Offset /= -200;
}

float Refresh_Gyro_Data_X(void)
{
  uint8_t XH = ReadByteSPI(OUT_X_H);
  uint8_t XL = ReadByteSPI(OUT_X_L);
  X = ((((XH << 8) | XL)+X_Offset) * 0.00875);
  return X;
}

X wird alle 10ms (über Refresh_Gyro_Data_X) neu ausgelesen und soll dann 
der Wert in dps sein!

Dann wird ebenfalls alle 10ms zusätzlich folgende Zeile ausgeführt um 
die ausgeführte Drehung in Grad zu erhalten:

float refresh_time = 0.01;
float X_add = 0;
float X;

...

X = Refresh_Gyro_Data_X();
X_add += X*refresh_time;     //<-- diese Zeile

Nach dieser Berechnung treten trotzdem immer wieder Offsets bis zu 1Grad 
pro Sekunde auf, was nun doch recht viel ist.

Sieht jemand einen grundlegenden Fehler in der Berechnung, oder ist 
diese in Ordnung so?