TRR 2018 / Mbed 2 deprecated biniou-TRR2019

Dependencies:   mbed MPU6050

Committer:
GaspardD
Date:
Fri Oct 04 22:20:23 2019 +0000
Revision:
12:58ad06f9847d
Parent:
10:e63fe4080760
dernier code

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 8:f23601373e8b 10 InterruptIn b_UTILS_button(USER_BUTTON);
GaspardD 8:f23601373e8b 11 InterruptIn b_UTILS_emergency_signal(PD_0);
GaspardD 12:58ad06f9847d 12 InterruptIn b_UTILS_startOnPin(PD_1);
GaspardD 1:8faddee0e52f 13
GaspardD 9:1b54bac6d9a7 14 int i,j;
GaspardD 1:8faddee0e52f 15
GaspardD 4:efa207509f63 16 void it_pressed()
GaspardD 4:efa207509f63 17 {
GaspardD 8:f23601373e8b 18 if(t_utils_timerSinceStart.read_ms() > 500) {
GaspardD 12:58ad06f9847d 19 rs_LOG.printf("Button pressed; log ready: %d\r\n",b_LOG_READY);
GaspardD 9:1b54bac6d9a7 20 if(b_LOG_READY) {
GaspardD 10:e63fe4080760 21 log_pc();
GaspardD 9:1b54bac6d9a7 22 b_LOG_READY = false;
GaspardD 9:1b54bac6d9a7 23 } else {
GaspardD 9:1b54bac6d9a7 24 t_utils_timerSinceStart.reset();
GaspardD 9:1b54bac6d9a7 25 b_UTILS_flag_button_SECTIONS = true;
GaspardD 9:1b54bac6d9a7 26 b_UTILS_flag_button_ESC = true;
GaspardD 9:1b54bac6d9a7 27 b_UTILS_flag_emergency_stop = false;
GaspardD 9:1b54bac6d9a7 28 }
GaspardD 4:efa207509f63 29 }
GaspardD 4:efa207509f63 30 return;
GaspardD 1:8faddee0e52f 31 }
GaspardD 8:f23601373e8b 32
GaspardD 8:f23601373e8b 33 void it_emergency_signal_recieved()
GaspardD 8:f23601373e8b 34 {
GaspardD 8:f23601373e8b 35 b_UTILS_flag_emergency_stop = true;
GaspardD 9:1b54bac6d9a7 36 }
GaspardD 9:1b54bac6d9a7 37
GaspardD 9:1b54bac6d9a7 38 void bubbleSort(double arr[], int n)
GaspardD 9:1b54bac6d9a7 39 {
GaspardD 9:1b54bac6d9a7 40 for (i = 0; i < n-1; i++) {
GaspardD 9:1b54bac6d9a7 41 // Last i elements are already in place
GaspardD 9:1b54bac6d9a7 42 for (j = 0; j < n-i-1; j++) {
GaspardD 9:1b54bac6d9a7 43 if (arr[j] > arr[j+1]) {
GaspardD 9:1b54bac6d9a7 44 swap(&arr[j], &arr[j+1]);
GaspardD 9:1b54bac6d9a7 45 }
GaspardD 9:1b54bac6d9a7 46 }
GaspardD 8:f23601373e8b 47 }
GaspardD 9:1b54bac6d9a7 48 }
GaspardD 9:1b54bac6d9a7 49
GaspardD 9:1b54bac6d9a7 50 void swap(double *xp, double *yp)
GaspardD 9:1b54bac6d9a7 51 {
GaspardD 9:1b54bac6d9a7 52 double temp = *xp;
GaspardD 9:1b54bac6d9a7 53 *xp = *yp;
GaspardD 9:1b54bac6d9a7 54 *yp = temp;
GaspardD 9:1b54bac6d9a7 55 }