
cv2neurobene
main.cpp@0:9cfec087a1bf, 2017-10-16 (annotated)
- Committer:
- radovan
- Date:
- Mon Oct 16 14:47:31 2017 +0000
- Revision:
- 0:9cfec087a1bf
cvicenie2neurobene
Who changed what in which revision?
User | Revision | Line number | New 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 | } |