angle calculation accelerometer

This commit is contained in:
Jasper Güldenstein 2020-11-15 17:56:15 +01:00
parent bad2a4bd54
commit 3789f1b8ca

View file

@ -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;