![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
calculate
Dependencies: mbed X_NUCLEO_IKS01A3 Mahony_Algorithm
Diff: CalculateData.cpp
- Revision:
- 6:4641f2b2684b
- Parent:
- 5:62994bb9fff9
--- 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]); }