From 3789f1b8ca0578af9c61247528c64696adb5af1e Mon Sep 17 00:00:00 2001 From: =?UTF-8?q?Jasper=20G=C3=BCldenstein?= Date: Sun, 15 Nov 2020 17:56:15 +0100 Subject: [PATCH] angle calculation accelerometer --- keil_project/Services/Accelerometer.c | 4 ++-- 1 file changed, 2 insertions(+), 2 deletions(-) diff --git a/keil_project/Services/Accelerometer.c b/keil_project/Services/Accelerometer.c index a140276..4a09e07 100644 --- a/keil_project/Services/Accelerometer.c +++ b/keil_project/Services/Accelerometer.c @@ -73,9 +73,9 @@ double ACCELEROMETER_GetY(void){ int ACCELEROMETER_AngleGood(void){ double x = ACCELEROMETER_GetX(); double y = ACCELEROMETER_GetY(); - double angle = x/y; + double angle = atan(x/y); - if (angle>tan(ANGLE_LIMIT_RAD)){ + if (fabs(angle)>ANGLE_LIMIT_RAD){ return 0; }else { return 1;