structix/libgy521
1
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity

#1 getAccelerometerAverage

Browse Source
This commit is contained in:
structix
2016-09-23 22:59:33 +02:00
parent 9e78615f9f
commit 5fb73dc12a
1 changed files with 10 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

10
libgy521.c
View File

@@ -197,6 +197,15 @@ float getAccelerometerData(char axis, int g) {
return result; 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) { void setGyroscopeRange(int range) {
//Same procedure as in setAccelerometerRange() //Same procedure as in setAccelerometerRange()
wiringPiI2CWriteReg8(id, GYRO_CONFIG, 0x00); wiringPiI2CWriteReg8(id, GYRO_CONFIG, 0x00);
@@ -287,6 +296,7 @@ float getGyroscopeData(char axis) {
return result; return result;
} }
float getAngleX(void) { float getAngleX(void) {
float x = getAccelerometerData('x', 0); float x = getAccelerometerData('x', 0);
float y = getAccelerometerData('y', 0); float y = getAccelerometerData('y', 0);