/* read Data */
        for(uint8_t i=0; i < samplesInFifo; i++){
            errorCode = adxl345bReadDataXYZ(sensor, rawData[alreadyReadData + i]);
            //sleep 5 μs to ensure data is ready
            sleep_for_ms(5);

            if(errorCode != ADXL345B_NO_ERROR){
                PRINT_DEBUG("ReadDataXYZ failed");
                return errorCode;
            }
        }

/* read Data */
        for (uint8_t i = 0; i < samplesInFifo; i++) {
            errorCode = adxl345bReadDataXYZ(sensor, rawData[alreadyReadSamples * 6]);
            alreadyReadSamples++;
            //sleep 5 μs to ensure data is ready
            sleep_for_ms(5);

            if (errorCode != ADXL345B_NO_ERROR) {
                PRINT_DEBUG("ReadDataXYZ failed");
                return errorCode;
            }
        }