From 6e78a156400742db24b5ce7175459bc484906361 Mon Sep 17 00:00:00 2001 From: structix Date: Sun, 11 Sep 2016 21:03:08 +0200 Subject: [PATCH] =?UTF-8?q?Accelerometer=20hinzugef=C3=BCgt=20(ungetestet)?= MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 8bit --- accelerometer.c | 25 +++++++++++++++++++++++++ accelerometer.h | 2 ++ makefile | 2 +- 3 files changed, 28 insertions(+), 1 deletion(-) create mode 100644 accelerometer.c create mode 100644 accelerometer.h 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)