Zdenka Šibíková / Mbed 2 deprecated cv4

vlastny navrhnuty filter v Z rovine

Dependencies:   MMA8451Q mbed

main.cpp@0:386f6715c066, 2017-10-30 (annotated)

Committer:
zdenka
Date:
Mon Oct 30 16:29:18 2017 +0000
Revision:
0:386f6715c066
vlastny navrhnuty filter v Z rovine

Who changed what in which revision?

UserRevisionLine numberNew contents of line
zdenka 0:386f6715c066 1 #include "mbed.h"
zdenka 0:386f6715c066 2 #include "MMA8451Q.h"
zdenka 0:386f6715c066 3 #if defined (TARGET_KL25Z) || defined (TARGET_KL46Z)
zdenka 0:386f6715c066 4 PinName const SDA = PTE25;
zdenka 0:386f6715c066 5 PinName const SCL = PTE24;
zdenka 0:386f6715c066 6 #elif defined (TARGET_KL05Z)
zdenka 0:386f6715c066 7 PinName const SDA = PTB4;
zdenka 0:386f6715c066 8 PinName const SCL = PTB3;
zdenka 0:386f6715c066 9 #elif defined (TARGET_K20D50M)
zdenka 0:386f6715c066 10 PinName const SDA = PTB1;
zdenka 0:386f6715c066 11 PinName const SCL = PTB0;
zdenka 0:386f6715c066 12 #else
zdenka 0:386f6715c066 13 #error TARGET NOT DEFINED
zdenka 0:386f6715c066 14 #endif
zdenka 0:386f6715c066 15
zdenka 0:386f6715c066 16 #define MMA8451_I2C_ADDRESS (0x1d<<1)
zdenka 0:386f6715c066 17 Serial pc(USBTX, USBRX,115200);
zdenka 0:386f6715c066 18 Ticker timeout;
zdenka 0:386f6715c066 19 Ticker casovac;
zdenka 0:386f6715c066 20 int pom=1;
zdenka 0:386f6715c066 21 float a=0.95;
zdenka 0:386f6715c066 22 float predposledney=0.0;
zdenka 0:386f6715c066 23 float predposlednex=0.0;
zdenka 0:386f6715c066 24 MMA8451Q acc(SDA, SCL, MMA8451_I2C_ADDRESS);
zdenka 0:386f6715c066 25 static float x;
zdenka 0:386f6715c066 26
zdenka 0:386f6715c066 27
zdenka 0:386f6715c066 28 void attick(){
zdenka 0:386f6715c066 29 if(pom==1){
zdenka 0:386f6715c066 30
zdenka 0:386f6715c066 31
zdenka 0:386f6715c066 32 x = (acc.getAccX());
zdenka 0:386f6715c066 33 predposledney=a*predposledney+predposlednex;
zdenka 0:386f6715c066 34
zdenka 0:386f6715c066 35 pc.printf("%f\n\r", predposledney);
zdenka 0:386f6715c066 36 predposlednex=x;
zdenka 0:386f6715c066 37
zdenka 0:386f6715c066 38 }
zdenka 0:386f6715c066 39 }
zdenka 0:386f6715c066 40 void atstop(){pom=0;}
zdenka 0:386f6715c066 41 int main(void)
zdenka 0:386f6715c066 42
zdenka 0:386f6715c066 43 {
zdenka 0:386f6715c066 44
zdenka 0:386f6715c066 45 casovac.attach(&attick,0.00125);
zdenka 0:386f6715c066 46 timeout.attach(&atstop,15.0);
zdenka 0:386f6715c066 47 while (true) {
zdenka 0:386f6715c066 48
zdenka 0:386f6715c066 49 }
zdenka 0:386f6715c066 50 }