diff --git a/libgy521.c b/libgy521.c
index 38e5881..a93d660 100644
--- a/libgy521.c
+++ b/libgy521.c
@@ -197,6 +197,15 @@ float getAccelerometerData(char axis, int g) {
     return result;
 }
 
+float getAccelerometerAverage(char axis, int g, unsigned int measurements) {
+    int i;
+    float average = 0.0;
+    for (i = 0; i < measurements; i++) {
+        average += getAccelerometerData(axis, g);
+    }
+    return average / (float) measurements;
+}
+
 void setGyroscopeRange(int range) {
     //Same procedure as in setAccelerometerRange()
     wiringPiI2CWriteReg8(id, GYRO_CONFIG, 0x00);
@@ -287,6 +296,7 @@ float getGyroscopeData(char axis) {
     return result;
 }
 
+
 float getAngleX(void) {
     float x = getAccelerometerData('x', 0);
     float y = getAccelerometerData('y', 0);