Ok

Dependencies:   mbed_rtos_types Mutex mbed_rtos_storage mbed Semaphore

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?

UserRevisionLine numberNew 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 }