Testing ekf implementation for Quadro_1.

Dependencies:   mbed Eigen

Revision:
1:6b803652d032
Parent:
0:a0e9705be9c4
Child:
7:bcbcc23983de
--- a/EKF_RPY.cpp	Fri Oct 18 14:55:53 2019 +0000
+++ b/EKF_RPY.cpp	Fri Oct 18 21:15:52 2019 +0000
@@ -75,12 +75,12 @@
 
 void EKF_RPY::update_angles()
 {
-    s1 = sinf(x(0));
-    c1 = cosf(x(0));
-    s2 = sinf(x(1));
-    c2 = cosf(x(1));
-    s3 = sinf(x(2));
-    c3 = cosf(x(2));   
+    s1 = sin(x(0));
+    c1 = cos(x(0));
+    s2 = sin(x(1));
+    c2 = cos(x(1));
+    s3 = sin(x(2));
+    c3 = cos(x(2));   
 }
 
 void EKF_RPY::update_F()