TRR 2018 / Mbed 2 deprecated biniou-TRR2019

Dependencies:   mbed MPU6050

Committer:
GaspardD
Date:
Thu Oct 03 23:28:56 2019 +0000
Revision:
9:1b54bac6d9a7
Parent:
8:f23601373e8b
Child:
10:e63fe4080760
a tester ;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
GaspardD 1:8faddee0e52f 1 #include "utils.h"
GaspardD 9:1b54bac6d9a7 2 #include "log.h"
GaspardD 1:8faddee0e52f 3
GaspardD 8:f23601373e8b 4 bool b_UTILS_flag_button_ESC = false;
GaspardD 8:f23601373e8b 5 bool b_UTILS_flag_button_SECTIONS = false;
GaspardD 1:8faddee0e52f 6 bool b_UTILS_flag_emergency_stop = false;
GaspardD 8:f23601373e8b 7 Timer t_utils_timerSinceStart;
GaspardD 6:ab9f3695633f 8 s_Section* s_UTILS_currentSection = NULL;
GaspardD 4:efa207509f63 9
GaspardD 9:1b54bac6d9a7 10
GaspardD 8:f23601373e8b 11 Serial rs_UTILS_odroid(PC_10, PC_11,115200);
GaspardD 8:f23601373e8b 12 InterruptIn b_UTILS_button(USER_BUTTON);
GaspardD 8:f23601373e8b 13 InterruptIn b_UTILS_emergency_signal(PD_0);
GaspardD 1:8faddee0e52f 14
GaspardD 9:1b54bac6d9a7 15 int i,j;
GaspardD 1:8faddee0e52f 16
GaspardD 4:efa207509f63 17 void it_pressed()
GaspardD 4:efa207509f63 18 {
GaspardD 9:1b54bac6d9a7 19 rs_LOG_pc.printf("t_utils_timerSinceStart.read_ms(): %ld\r\n", t_utils_timerSinceStart.read_ms());
GaspardD 8:f23601373e8b 20 if(t_utils_timerSinceStart.read_ms() > 500) {
GaspardD 9:1b54bac6d9a7 21 rs_LOG_pc.printf("Button pressed\r\n");
GaspardD 9:1b54bac6d9a7 22 if(b_LOG_READY) {
GaspardD 9:1b54bac6d9a7 23 b_LOG_READY = false;
GaspardD 9:1b54bac6d9a7 24 } else {
GaspardD 9:1b54bac6d9a7 25 t_utils_timerSinceStart.reset();
GaspardD 9:1b54bac6d9a7 26 b_UTILS_flag_button_SECTIONS = true;
GaspardD 9:1b54bac6d9a7 27 b_UTILS_flag_button_ESC = true;
GaspardD 9:1b54bac6d9a7 28 b_UTILS_flag_emergency_stop = false;
GaspardD 9:1b54bac6d9a7 29 }
GaspardD 4:efa207509f63 30 }
GaspardD 4:efa207509f63 31 return;
GaspardD 1:8faddee0e52f 32 }
GaspardD 8:f23601373e8b 33
GaspardD 8:f23601373e8b 34 void it_emergency_signal_recieved()
GaspardD 8:f23601373e8b 35 {
GaspardD 8:f23601373e8b 36 b_UTILS_flag_emergency_stop = true;
GaspardD 9:1b54bac6d9a7 37 }
GaspardD 9:1b54bac6d9a7 38
GaspardD 9:1b54bac6d9a7 39 void bubbleSort(double arr[], int n)
GaspardD 9:1b54bac6d9a7 40 {
GaspardD 9:1b54bac6d9a7 41 for (i = 0; i < n-1; i++) {
GaspardD 9:1b54bac6d9a7 42 // Last i elements are already in place
GaspardD 9:1b54bac6d9a7 43 for (j = 0; j < n-i-1; j++) {
GaspardD 9:1b54bac6d9a7 44 if (arr[j] > arr[j+1]) {
GaspardD 9:1b54bac6d9a7 45 swap(&arr[j], &arr[j+1]);
GaspardD 9:1b54bac6d9a7 46 }
GaspardD 9:1b54bac6d9a7 47 }
GaspardD 8:f23601373e8b 48 }
GaspardD 9:1b54bac6d9a7 49 }
GaspardD 9:1b54bac6d9a7 50
GaspardD 9:1b54bac6d9a7 51 void swap(double *xp, double *yp)
GaspardD 9:1b54bac6d9a7 52 {
GaspardD 9:1b54bac6d9a7 53 double temp = *xp;
GaspardD 9:1b54bac6d9a7 54 *xp = *yp;
GaspardD 9:1b54bac6d9a7 55 *yp = temp;
GaspardD 9:1b54bac6d9a7 56 }