Акселерометр расчет

Я не могу найти, что здесь не так в этом коде. Я пытаюсь получить данные акселерометра, но когда я пытаюсь запустить его на устройстве, которое работает, но не правильное чтение, я думаю, что проблема в вычислениях, та же логика, которую я использовал для гироскопа и взял правильное чтение, но отображается вывод акселерометра Accelx :3.56023e-09 Accely :1.76423e-42 Accelz :1.77404e-42

    accelX = accelerometer->Loop_Accelx();
accelY = accelerometer->Loop_Accely();
accelZ = accelerometer->Loop_Accelz();

for(int i = 0; i<2; i++) //averaging of accelerometer data upto 3 readings
{
float accelX1 = accelerometer->Loop_Accelx(); //storing the Accelx value from DmpMPU6050_Demo class
float accelY1 = accelerometer->Loop_Accely(); //storing the Accely value from DmpMPU6050_Demo class
float accelZ1 = accelerometer->Loop_Accelz(); //storing the Accelz value from DmpMPU6050_Demo class

accelX = accelX + accelX1;
accelY = accelY + accelY1;
accelZ = accelZ + accelZ1;

delay(1);
}

accelX = accelX/3;
accelY = accelY/3;
accelZ = accelZ/3;

if(numbercount == number){

emit Accelx_Data(accelX);
emit Accely_Data(accelY);
emit Accelz_Data(accelZ);

cout<<"Accelx :"<<accelX<<"  Accely :"<<accelY<<"  Accelz :"<<accelZ<<endl;

Файл dmpmpu_demo для Accel X:

float DmpMPU6050_Demo::Loop_Accelx()
{
if (!dmpReady)
{
return 1;
}

fifoCount = mpu.getFIFOCount();

if (fifoCount == 1024)
{
mpu.resetFIFO();
printf("FIFO overflow!\n");
}

else if (fifoCount >= 42 )
{
mpu.getFIFOBytes(fifoBuffer, packetSize);

#ifdef OUTPUT_READABLE_REALACCEL

mpu.dmpGetQuaternion(&q, fifoBuffer);
mpu.dmpGetAccel(&aa, fifoBuffer);
mpu.dmpGetGravity(&gravity, &q);
mpu.dmpGetLinearAccel(&aaReal, &aa, &gravity);

#endif

printf("\n");

}

}