calculate
Dependencies: mbed X_NUCLEO_IKS01A3 Mahony_Algorithm
Revision 6:4641f2b2684b, committed 2020-05-01
- Comitter:
- zollecy1
- Date:
- Fri May 01 08:44:21 2020 +0000
- Parent:
- 5:62994bb9fff9
- Commit message:
- ..
Changed in this revision
CalculateData.cpp | Show annotated file Show diff for this revision Revisions of this file |
diff -r 62994bb9fff9 -r 4641f2b2684b CalculateData.cpp --- a/CalculateData.cpp Wed Apr 29 10:54:59 2020 +0000 +++ b/CalculateData.cpp Fri May 01 08:44:21 2020 +0000 @@ -177,7 +177,7 @@ mahony->getEuler(); transform(array_acc, i, acc, mahony->getRoll(), mahony->getPitch(), mahony->getYaw()); - //filterAcc(acc); + filterAcc(acc); integrate(acc, acc_old, speed, t[i], t_old); //in mm/s @@ -192,8 +192,8 @@ t_old=t[i]; } counter = 0; - //printf("Roll:\t%i\tPitch:\t%i\tYaw:\t%i\r\n",mahony->getRoll(),mahony->getPitch(),mahony->getYaw()); - printf("%f, %f, %f, %f, %f, %f, %f\r\n",acc[0],acc[1],acc[2], t_old/1000.0f, speed[0]/1000.0f,speed[1]/1000.0f,speed[2]/1000.0f); + printf("Roll:\t%i\tPitch:\t%i\tYaw:\t%i\r\n",mahony->getRoll(),mahony->getPitch(),mahony->getYaw()); + //printf("%f, %f, %f, %f, %f, %f, %f\r\n",acc[0],acc[1],acc[2], t_old/1000.0f, speed[0]/1000.0f,speed[1]/1000.0f,speed[2]/1000.0f); //printf("%f, %f, %f\r\n",acc[0],acc[1],acc[2]); }