cv1

Dependencies:   MMA8451Q mbed

main.cpp

Committer:
zdenka
Date:
2017-10-30
Revision:
1:1567f5a4e96f
Parent:
0:0472d2623223

File content as of revision 1:1567f5a4e96f:

#include "mbed.h"
#include "MMA8451Q.h"
#include "SampleFilter.c"
#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 predposlednex=0.0;
MMA8451Q acc(SDA, SCL, MMA8451_I2C_ADDRESS);
   static float x, y, z;
   SampleFilter filter;
   
void attick(){
    if(pom==1){
            

        x = (acc.getAccX());
       // y = (acc.getAccY());
        //z = (acc.getAccZ());
        //pc.printf("skuska\n\r");
        SampleFilter_put(&filter,x);
        pc.printf("%f\n\r", SampleFilter_get(&filter));

        }
    }
    void atstop(){pom=0;}
int main(void)

{   
SampleFilter_init(&filter);
    casovac.attach(&attick,0.00125);
    timeout.attach(&atstop,15.0);
    //pc.printf("zaciatok\n\r");
    while (true) {
       /* float x, y, z;
        x = abs(acc.getAccX());
        y = abs(acc.getAccY());
        z = abs(acc.getAccZ());
        rled = 1.0f - x;
        gled = 1.0f - y;
        bled = 1.0f - z;
        wait(0.1f);
        printf("X: %1.2f, Y: %1.2f, Z: %1.2f\n\r", x, y, z);*/
    }
}