     setupBluetooth();
     
     // Connect i2c accelerometer
+#if AccelerometerIntegration
     //setupAccelerometer();
 
-#if AccelerometerIntegration
     // get initial values
     lastAccTime = micros();
     float x, y, z;

    Bluetooth.print("DCalibrated: ");
    Bluetooth.println(zeroOffset*1000);
}

float trapezoidalRule(float fa, float fb, int dt) {
    return ((float) dt) * (fa + fb) * 0.5;

#define BluetoothSerialSpeed 9600
// serial config is default: 8, 1, n

#define AccelerometerIntegration 0

#if AccelerometerIntegration
// Pin that defines the address of accelerometer, (is grounded?)
#define SA0 1

#include <Wire.h>
#include <MMA8452.h>
//#include <MMA8452Reg.h>
#endif

// Software Filter for acceleration 
#define AccelerometerSoftFilter 1

#if AccelerometerIntegration
// accuracy: +- 2, +- 4, +- 8
#define AccelerationRange MMA_RANGE_2G
#define AccelerationDataRate MMA_12_5hz
#define AccelerometerNewDataInterrupt 1
#endif

#if AccelerometerSoftFilter and AccelerometerIntegration
#include <FilterOnePole.h>
