guldenst/projet_voilier
1
0
Fork 0
Code Issues Pull requests Releases Wiki Activity

angle calculation accelerometer

Browse source
This commit is contained in:
Jasper Güldenstein 2020-11-15 17:56:15 +01:00
parent bad2a4bd54
commit 3789f1b8ca
1 changed files with 2 additions and 2 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

4
keil_project/Services/Accelerometer.c
View file

@ -73,9 +73,9 @@ double ACCELEROMETER_GetY(void){
int ACCELEROMETER_AngleGood(void){ int ACCELEROMETER_AngleGood(void){
double x = ACCELEROMETER_GetX(); double x = ACCELEROMETER_GetX();
double y = ACCELEROMETER_GetY(); 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; return 0;
}else { }else {
return 1; return 1;