Zdenka Šibíková
/
FRDM_MMA8451Quhol
uhol
main.cpp@0:64e4a5045e52, 2017-11-13 (annotated)
- Committer:
- zdenka
- Date:
- Mon Nov 13 15:29:58 2017 +0000
- Revision:
- 0:64e4a5045e52
uhol
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
zdenka | 0:64e4a5045e52 | 1 | #include "mbed.h" |
zdenka | 0:64e4a5045e52 | 2 | #include "MMA8451Q.h" |
zdenka | 0:64e4a5045e52 | 3 | |
zdenka | 0:64e4a5045e52 | 4 | #if defined (TARGET_KL25Z) || defined (TARGET_KL46Z) |
zdenka | 0:64e4a5045e52 | 5 | PinName const SDA = PTE25; |
zdenka | 0:64e4a5045e52 | 6 | PinName const SCL = PTE24; |
zdenka | 0:64e4a5045e52 | 7 | #elif defined (TARGET_KL05Z) |
zdenka | 0:64e4a5045e52 | 8 | PinName const SDA = PTB4; |
zdenka | 0:64e4a5045e52 | 9 | PinName const SCL = PTB3; |
zdenka | 0:64e4a5045e52 | 10 | #elif defined (TARGET_K20D50M) |
zdenka | 0:64e4a5045e52 | 11 | PinName const SDA = PTB1; |
zdenka | 0:64e4a5045e52 | 12 | PinName const SCL = PTB0; |
zdenka | 0:64e4a5045e52 | 13 | #else |
zdenka | 0:64e4a5045e52 | 14 | #error TARGET NOT DEFINED |
zdenka | 0:64e4a5045e52 | 15 | #endif |
zdenka | 0:64e4a5045e52 | 16 | |
zdenka | 0:64e4a5045e52 | 17 | #define MMA8451_I2C_ADDRESS (0x1d<<1) |
zdenka | 0:64e4a5045e52 | 18 | Serial pc(USBTX,USBRX); |
zdenka | 0:64e4a5045e52 | 19 | int main(void) |
zdenka | 0:64e4a5045e52 | 20 | { |
zdenka | 0:64e4a5045e52 | 21 | MMA8451Q acc(SDA, SCL, MMA8451_I2C_ADDRESS); |
zdenka | 0:64e4a5045e52 | 22 | |
zdenka | 0:64e4a5045e52 | 23 | |
zdenka | 0:64e4a5045e52 | 24 | printf("MMA8451 ID: %d\n", acc.getWhoAmI()); |
zdenka | 0:64e4a5045e52 | 25 | |
zdenka | 0:64e4a5045e52 | 26 | while (true) { |
zdenka | 0:64e4a5045e52 | 27 | float x, y, z; |
zdenka | 0:64e4a5045e52 | 28 | x = abs(acc.getAccX()); |
zdenka | 0:64e4a5045e52 | 29 | y = abs(acc.getAccY()); |
zdenka | 0:64e4a5045e52 | 30 | z = abs(acc.getAccZ()); |
zdenka | 0:64e4a5045e52 | 31 | |
zdenka | 0:64e4a5045e52 | 32 | pc.printf("X: %1.2f, Y: %1.2f, Z: %1.2f\n\r", 180*asin(x/sqrt(x*x+z*z+y*y))/3.14159, 180*asin(y/sqrt(x*x+z*z+y*y))/3.14159, 180*asin(z/sqrt(x*x+z*z+y*y))/3.14159); |
zdenka | 0:64e4a5045e52 | 33 | } |
zdenka | 0:64e4a5045e52 | 34 | } |