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 |
--- 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]);
}