![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
cv1
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);*/ } }