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;