diff --git a/accelerometer.c b/accelerometer.c new file mode 100644 index 0000000..9f83f04 --- /dev/null +++ b/accelerometer.c @@ -0,0 +1,25 @@ +#include "accelerometer.h" +#include +#include //for fabs + +void setupAccelerometer(void) { + setupgy521(); +} + +float getaccelerometerdata(void) { + float xyz[] = {getAccelerometerData('x', 1), getAccelerometerData('y', 1), getAccelerometerData('z', 1)}; + float temp; + int i, z; + + for (i = 0, i < 3; i++) { + for (z = 0; z < 3 - i; z++) { + if (xyz[z] < xyz[z + 1]) { + temp = xyz[z]; + xyz[z] = xyz[z + 1]; + xyz[z + 1] = temp; + } + } + } + + return fabs(xyz[0]); //Absolutwert fuer float +} diff --git a/accelerometer.h b/accelerometer.h new file mode 100644 index 0000000..40aabdc --- /dev/null +++ b/accelerometer.h @@ -0,0 +1,2 @@ +void setupAccelerometer(void); +float getaccelerometerdata(void); diff --git a/makefile b/makefile index b2c5338..739e0ea 100644 --- a/makefile +++ b/makefile @@ -4,7 +4,7 @@ CFLAGS = -Wall -g -D_REENTRANT -DVERSION=\"$(VERSION)\" LDFLAGS = -lwiringPi -lpthread -OBJ = main.o player.o +OBJ = main.o player.o accelerometer.o pi2ezoplayer: $(OBJ) $(CC) $(CFLAGS) -o pi2ezoplayer $(OBJ) $(LDFLAGS)