gpa in double prescision

Dependencies:   mbed

Revision:
21:c0d1a661f26e
Parent:
10:b7f142952df9
--- a/main.cpp	Mon Apr 09 07:05:11 2018 +0000
+++ b/main.cpp	Mon Apr 09 15:09:45 2018 +0000
@@ -104,9 +104,12 @@
 int NperMin = 1;
 float TmeasMin = 1.0;
 int NmeasMin = 1;//(int)ceil(TmeasMin/Ts);
-GPA Wobble(fMin, fMax, NfexcDes, NperMin, NmeasMin, Ts, Aexc0, Aexc1);
-float w0 = 2.0f*pi*3.0f;
-float D = 0.02f;
+// GPA Wobble(fMin, fMax, NfexcDes, NperMin, NmeasMin, Ts, Aexc0, Aexc1);
+GPA Wobble(1.0f, 200.0f,50, 5, 100, Ts, 1.0f,1.0f);       // init GPA, see references there
+// float w0 = 2.0f*pi*3.0f;
+// float D = 0.02f;
+float w0 = 2.0f*pi*5.0f;
+float D = 0.2f;
 IIR_filter SysSecOrder(w0, D, Ts, 10.0f);
 float u = Oexc;
 float y = 10.0f*u;
@@ -146,7 +149,7 @@
     FilterGYRZ.reset(u2gz(3.3f*gz.read()));
 
     Wobble.reset();
-    // SysSecOrder.reset(u);
+    SysSecOrder.reset(u);
 
     Wobble.printGPAmeasPara();
 
@@ -181,7 +184,7 @@
     y = SysSecOrder(u);
     k += 1;
 
-    if(k == 11000) {
+    if(k == 22000) {
         Wobble.printGPAmeasTime();
     }