cv2neurobene

Dependencies:   MMA8451Q mbed

Committer:
radovan
Date:
Mon Oct 16 14:47:31 2017 +0000
Revision:
0:9cfec087a1bf
cvicenie2neurobene

Who changed what in which revision?

UserRevisionLine numberNew contents of line
radovan 0:9cfec087a1bf 1 #include "mbed.h"
radovan 0:9cfec087a1bf 2 #include "MMA8451Q.h"
radovan 0:9cfec087a1bf 3
radovan 0:9cfec087a1bf 4 #if defined (TARGET_KL25Z) || defined (TARGET_KL46Z)
radovan 0:9cfec087a1bf 5 PinName const SDA = PTE25;
radovan 0:9cfec087a1bf 6 PinName const SCL = PTE24;
radovan 0:9cfec087a1bf 7 #elif defined (TARGET_KL05Z)
radovan 0:9cfec087a1bf 8 PinName const SDA = PTB4;
radovan 0:9cfec087a1bf 9 PinName const SCL = PTB3;
radovan 0:9cfec087a1bf 10 #elif defined (TARGET_K20D50M)
radovan 0:9cfec087a1bf 11 PinName const SDA = PTB1;
radovan 0:9cfec087a1bf 12 PinName const SCL = PTB0;
radovan 0:9cfec087a1bf 13 #else
radovan 0:9cfec087a1bf 14 #error TARGET NOT DEFINED
radovan 0:9cfec087a1bf 15 #endif
radovan 0:9cfec087a1bf 16
radovan 0:9cfec087a1bf 17 #define MMA8451_I2C_ADDRESS (0x1d<<1)
radovan 0:9cfec087a1bf 18 Serial pc(USBTX, USBRX);
radovan 0:9cfec087a1bf 19 Timer timer;
radovan 0:9cfec087a1bf 20 int main(void)
radovan 0:9cfec087a1bf 21 {
radovan 0:9cfec087a1bf 22 MMA8451Q acc(SDA, SCL, MMA8451_I2C_ADDRESS);
radovan 0:9cfec087a1bf 23 PwmOut rled(LED1);
radovan 0:9cfec087a1bf 24 PwmOut gled(LED2);
radovan 0:9cfec087a1bf 25 PwmOut bled(LED3);
radovan 0:9cfec087a1bf 26
radovan 0:9cfec087a1bf 27 printf("MMA8451 ID: %d\n", acc.getWhoAmI());
radovan 0:9cfec087a1bf 28
radovan 0:9cfec087a1bf 29 while (true) {
radovan 0:9cfec087a1bf 30 timer.start();
radovan 0:9cfec087a1bf 31 float x, y, z;
radovan 0:9cfec087a1bf 32 x = abs(acc.getAccX());
radovan 0:9cfec087a1bf 33 y = abs(acc.getAccY());
radovan 0:9cfec087a1bf 34 z = abs(acc.getAccZ());
radovan 0:9cfec087a1bf 35 rled = 1.0f - x;
radovan 0:9cfec087a1bf 36 gled = 1.0f - y;
radovan 0:9cfec087a1bf 37 bled = 1.0f - z;
radovan 0:9cfec087a1bf 38 wait(0.1f);
radovan 0:9cfec087a1bf 39 // pc.printf("%d \n", i);
radovan 0:9cfec087a1bf 40 pc.printf("X: %1.2f, Y: %1.2f, Z: %1.2f\n\r", x, y, z);
radovan 0:9cfec087a1bf 41 }
radovan 0:9cfec087a1bf 42 }