
Ok
Dependencies: mbed_rtos_types Mutex mbed_rtos_storage mbed Semaphore
Accelerometer.cpp@1:c9ef27da97b5, 2019-11-27 (annotated)
- Committer:
- daniwestside
- Date:
- Wed Nov 27 11:16:17 2019 +0000
- Branch:
- Sinthreads
- Revision:
- 1:c9ef27da97b5
- Parent:
- 0:85df64b421a8
Ok
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
daniwestside | 0:85df64b421a8 | 1 | #include "mbed.h" |
daniwestside | 0:85df64b421a8 | 2 | |
daniwestside | 0:85df64b421a8 | 3 | extern Serial pc; |
daniwestside | 0:85df64b421a8 | 4 | extern int iteration; |
daniwestside | 0:85df64b421a8 | 5 | extern int x; |
daniwestside | 0:85df64b421a8 | 6 | extern int y; |
daniwestside | 0:85df64b421a8 | 7 | extern int z; |
daniwestside | 0:85df64b421a8 | 8 | float acc_max[3]={0}; |
daniwestside | 0:85df64b421a8 | 9 | float acc_min[3]={0}; |
daniwestside | 0:85df64b421a8 | 10 | |
daniwestside | 0:85df64b421a8 | 11 | // Prints maximum and minimum values of accelerometer in each axis (doesn't clean the array when finished). |
daniwestside | 0:85df64b421a8 | 12 | void printAccMinMax(){ |
daniwestside | 0:85df64b421a8 | 13 | pc.printf("\n\rAccelerometer:\n\r Max: X=%.5f Y=%.5f Z=%.5f\n\r Min: X=%.5f Y=%.5f Z=%.5f\n\r", acc_max[0], acc_max[1], acc_max[2], acc_min[0], acc_min[1], acc_min[2] ); |
daniwestside | 0:85df64b421a8 | 14 | /* for (int p=0; p<3; p++){ |
daniwestside | 0:85df64b421a8 | 15 | acc_max[p]=0; |
daniwestside | 0:85df64b421a8 | 16 | acc_min[p]=0; |
daniwestside | 0:85df64b421a8 | 17 | }*/ |
daniwestside | 0:85df64b421a8 | 18 | } |
daniwestside | 0:85df64b421a8 | 19 | //Keeps an array with max and min values of each axis |
daniwestside | 0:85df64b421a8 | 20 | void accMinMax (float a,float b,float c){ |
daniwestside | 0:85df64b421a8 | 21 | if (iteration == 0){ |
daniwestside | 0:85df64b421a8 | 22 | acc_min[0]=a; |
daniwestside | 0:85df64b421a8 | 23 | acc_min[1]=b; |
daniwestside | 0:85df64b421a8 | 24 | acc_min[2]=c; |
daniwestside | 0:85df64b421a8 | 25 | acc_max[0]=a; |
daniwestside | 0:85df64b421a8 | 26 | acc_max[1]=b; |
daniwestside | 0:85df64b421a8 | 27 | acc_max[2]=c; |
daniwestside | 0:85df64b421a8 | 28 | } |
daniwestside | 0:85df64b421a8 | 29 | else{ |
daniwestside | 0:85df64b421a8 | 30 | if(a>acc_max[0]){ |
daniwestside | 0:85df64b421a8 | 31 | acc_max[0]=a; |
daniwestside | 0:85df64b421a8 | 32 | } |
daniwestside | 0:85df64b421a8 | 33 | if(a<acc_min[0]){ |
daniwestside | 0:85df64b421a8 | 34 | acc_min[0]=a; |
daniwestside | 0:85df64b421a8 | 35 | } |
daniwestside | 0:85df64b421a8 | 36 | if(b>acc_max[1]){ |
daniwestside | 0:85df64b421a8 | 37 | acc_max[1]=b; |
daniwestside | 0:85df64b421a8 | 38 | } |
daniwestside | 0:85df64b421a8 | 39 | if(b<acc_min[1]){ |
daniwestside | 0:85df64b421a8 | 40 | acc_min[1]=b; |
daniwestside | 0:85df64b421a8 | 41 | } |
daniwestside | 0:85df64b421a8 | 42 | if(c>acc_max[2]){ |
daniwestside | 0:85df64b421a8 | 43 | acc_max[2]=c; |
daniwestside | 0:85df64b421a8 | 44 | } |
daniwestside | 0:85df64b421a8 | 45 | if(c<acc_min[2]){ |
daniwestside | 0:85df64b421a8 | 46 | acc_min[2]=c; |
daniwestside | 0:85df64b421a8 | 47 | } |
daniwestside | 0:85df64b421a8 | 48 | } |
daniwestside | 0:85df64b421a8 | 49 | } |