From 5fb73dc12a67b53657932f65ef9b69aade59f1b8 Mon Sep 17 00:00:00 2001 From: structix Date: Fri, 23 Sep 2016 22:59:33 +0200 Subject: [PATCH] #1 getAccelerometerAverage --- libgy521.c | 10 ++++++++++ 1 file changed, 10 insertions(+) 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);