output_low(ACC_CS);                               // Enable accelerometer
   spi_write((ACC_MODE_REG * 2) + 0x80);      // Write command to ACC_MODE_REG register 
   spi_write(0x05);                                       // 4 for 2g range + 1 for measuring mode
   output_high(ACC_CS);                               // Disable accelerometer
   delay_ms(10);
   output_low(ACC_CS);                                // Enable accelerometer

  // Take 20 accelerometer values
   for (i = 0; i < 20; i ++)
   {
      delay_ms(10);                     // Short delay
     // Wait for data
      while (1)
      {   
         spi_write(ACC_STAT_REG*2);         // Read command from ACC_STAT_REG register
         X_Buffer[i] = spi_read(0);         // Read register value

        // Exit loop if DRDY=1 or DOVR=DRDY=1
         if ((X_Buffer[i] == 0x01) || (X_Buffer[i] == 0x03))      {break;}
      }
     // Take X-value   
      spi_write(ACC_X_OUT_REG*2);      // Read command from ACC_X_OUT_REG register
      X_Buffer[i] = spi_read(0);      // Read register value
     // Take Y-value   
      spi_write(ACC_Y_OUT_REG*2);      // Read command from ACC_Y_OUT_REG register
      Y_Buffer[i] = spi_read(0);      // Read register value
     // Take Z-value   
      spi_write(ACC_Z_OUT_REG*2);      // Read command from ACC_Z_OUT_REG register
      Z_Buffer[i] = spi_read(0);      // Read register value
   }
   output_high(ACC_CS);   // Disable accelerometer