Diff: main.cpp

Revision:

0:386f6715c066

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Mon Oct 30 16:29:18 2017 +0000
@@ -0,0 +1,50 @@
+#include "mbed.h"
+#include "MMA8451Q.h"
+#if   defined (TARGET_KL25Z) || defined (TARGET_KL46Z)
+  PinName const SDA = PTE25;
+  PinName const SCL = PTE24;
+#elif defined (TARGET_KL05Z)
+  PinName const SDA = PTB4;
+  PinName const SCL = PTB3;
+#elif defined (TARGET_K20D50M)
+  PinName const SDA = PTB1;
+  PinName const SCL = PTB0;
+#else
+  #error TARGET NOT DEFINED
+#endif
+
+#define MMA8451_I2C_ADDRESS (0x1d<<1)
+Serial pc(USBTX, USBRX,115200);
+Ticker timeout;
+Ticker casovac;
+int pom=1;
+float a=0.95;
+float predposledney=0.0;
+float predposlednex=0.0;
+MMA8451Q acc(SDA, SCL, MMA8451_I2C_ADDRESS);
+   static float x;
+   
+   
+void attick(){
+    if(pom==1){
+            
+
+        x = (acc.getAccX());
+            predposledney=a*predposledney+predposlednex;
+
+        pc.printf("%f\n\r", predposledney);
+                predposlednex=x;
+
+        }
+    }
+    void atstop(){pom=0;}
+int main(void)
+
+{   
+
+    casovac.attach(&attick,0.00125);
+    timeout.attach(&atstop,15.0);
+    while (true) {
+    
+    }
+}