christophe vermaelen
/
ER2_accelero_FRDM
Programme de base pour la machine à états sur l'accélomètre
Diff: main.cpp
- Revision:
- 1:a1664788d34a
- Parent:
- 0:c188fa46ae96
diff -r c188fa46ae96 -r a1664788d34a main.cpp --- a/main.cpp Wed Jun 03 00:32:28 2020 +0000 +++ b/main.cpp Wed Jun 03 00:36:56 2020 +0000 @@ -1,39 +1,17 @@ #include "mbed.h" #include "MMA8451Q.h" -#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) +#define I2C_ADDRESS (0x1d<<1) int main(void) { - MMA8451Q acc(SDA, SCL, MMA8451_I2C_ADDRESS); - PwmOut rled(LED1); - PwmOut gled(LED2); - PwmOut bled(LED3); - + MMA8451Q acc(PTE25, PTE24, I2C_ADDRESS); + float x, z; printf("MMA8451 ID: %d\n", acc.getWhoAmI()); - - 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", x, y, z); + while (1) { + x = acc.getAccX(); + z = acc.getAccZ(); + printf("X: %1.2f, Z: %1.2f\r\n", x, z); + wait(0.1); } }