Nucleo-transfer
Dependencies: ADS1015 MPU6050 PixelArray PixelArray-Nucleo mbed WS2813
Fork of Nucleo-transfer by
Sensorplate/main.cpp@22:a09775c25890, 2017-10-02 (annotated)
- Committer:
- ricardo_95
- Date:
- Mon Oct 02 16:05:46 2017 +0000
- Revision:
- 22:a09775c25890
- Parent:
- 21:13e4824bc364
- Child:
- 23:4a09554bdc1a
Code for pilot 1.
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
ricardo_95 | 21:13e4824bc364 | 1 | /********************* CODE INFORMATIE ****************************** |
ricardo_95 | 12:7b3a5940f911 | 2 | Author : Danny Eldering & Ricardo Molenaar |
ricardo_95 | 12:7b3a5940f911 | 3 | Company : Momo Medical |
ricardo_95 | 12:7b3a5940f911 | 4 | Source : developer.mbed.org |
ricardo_95 | 12:7b3a5940f911 | 5 | File : main.cpp |
ricardo_95 | 12:7b3a5940f911 | 6 | Version | -date : 1.0 | 28-9-2017 |
ricardo_95 | 12:7b3a5940f911 | 7 | */ |
ricardo_95 | 12:7b3a5940f911 | 8 | |
ricardo_95 | 21:13e4824bc364 | 9 | /************************ CONFIG ***********************************/ |
ricardo_95 | 21:13e4824bc364 | 10 | |
DEldering | 0:c0e44c46c573 | 11 | #include "mbed.h" |
DEldering | 0:c0e44c46c573 | 12 | #include "Adafruit_ADS1015.h" |
DEldering | 0:c0e44c46c573 | 13 | #include "MPU6050.h" |
ricardo_95 | 7:dba5091c8b7d | 14 | #include "neopixel.h" |
ricardo_95 | 12:7b3a5940f911 | 15 | #define NLED (3) |
ricardo_95 | 7:dba5091c8b7d | 16 | #define ONE_COLOR |
ricardo_95 | 7:dba5091c8b7d | 17 | |
ricardo_95 | 7:dba5091c8b7d | 18 | InterruptIn lock(p16); // Interrupts for buttons. |
ricardo_95 | 7:dba5091c8b7d | 19 | InterruptIn reposition(p17); |
ricardo_95 | 7:dba5091c8b7d | 20 | InterruptIn mute(p15); |
ricardo_95 | 21:13e4824bc364 | 21 | InterruptIn new_patient(p18); |
ricardo_95 | 12:7b3a5940f911 | 22 | DigitalIn supplyvoltage(p20); // Analog input between 0 and 1 for reading supplyvoltage from measuringpoint before power supply. |
ricardo_95 | 7:dba5091c8b7d | 23 | |
ricardo_95 | 21:13e4824bc364 | 24 | DigitalOut LED_intern1(LED1); |
ricardo_95 | 12:7b3a5940f911 | 25 | DigitalOut LED_intern2(LED2); |
ricardo_95 | 12:7b3a5940f911 | 26 | DigitalOut LED_intern3(LED3); |
ricardo_95 | 7:dba5091c8b7d | 27 | neopixel::PixelArray array(p11); |
ricardo_95 | 7:dba5091c8b7d | 28 | |
ricardo_95 | 19:3b5999fa7b7e | 29 | Timer lock_hold_timer; |
ricardo_95 | 19:3b5999fa7b7e | 30 | Timer calibration_hold_timer; |
ricardo_95 | 7:dba5091c8b7d | 31 | Timer delay; |
ricardo_95 | 7:dba5091c8b7d | 32 | Timer speaker_timer; |
ricardo_95 | 21:13e4824bc364 | 33 | //Timer led_timer; |
ricardo_95 | 7:dba5091c8b7d | 34 | |
ricardo_95 | 7:dba5091c8b7d | 35 | DigitalOut speaker1(p21); |
ricardo_95 | 7:dba5091c8b7d | 36 | DigitalOut speaker2(p22); |
ricardo_95 | 21:13e4824bc364 | 37 | PwmOut lock_LED(p23); |
ricardo_95 | 21:13e4824bc364 | 38 | PwmOut reposition_LED(p24); |
ricardo_95 | 21:13e4824bc364 | 39 | PwmOut mute_LED(p25); |
ricardo_95 | 21:13e4824bc364 | 40 | PwmOut new_patient_LED(p26); |
DEldering | 0:c0e44c46c573 | 41 | |
DEldering | 1:a8e61f3910ad | 42 | I2C i2c(p28, p27); // I2C |
ricardo_95 | 21:13e4824bc364 | 43 | I2C i2cAccu(p9, p10); // I2C for accupack |
DEldering | 1:a8e61f3910ad | 44 | MPU6050 agu(p28,p27); // Accelerometer/Gyroscope Unit |
DEldering | 1:a8e61f3910ad | 45 | Adafruit_ADS1115 pr1(&i2c, 0x48); // first PiëzoResistive ADC |
DEldering | 1:a8e61f3910ad | 46 | Adafruit_ADS1115 pr2(&i2c, 0x49); // second PiëzoResistive ADC |
DEldering | 1:a8e61f3910ad | 47 | Adafruit_ADS1115 pel(&i2c, 0x4B); // PiëzoElectric ADC |
ricardo_95 | 21:13e4824bc364 | 48 | Adafruit_ADS1115 adsAccu(&i2cAccu, 0x48); |
DEldering | 1:a8e61f3910ad | 49 | Serial pc(USBTX, USBRX); // tx, rx // Serial USB connection |
ricardo_95 | 21:13e4824bc364 | 50 | Serial pi(p13, p14); // tx, rx // Setup serial communication for pi. |
DEldering | 1:a8e61f3910ad | 51 | Timer t; // Timer for equally time-spaced samples |
DEldering | 1:a8e61f3910ad | 52 | Ticker sample_cycle; // Polling cycle |
ricardo_95 | 8:bf0f7a6fb1fd | 53 | |
ricardo_95 | 12:7b3a5940f911 | 54 | int boot_delay_ms = 500; |
DEldering | 1:a8e61f3910ad | 55 | int cycle_time = 100000; // Cycle time in us |
DEldering | 1:a8e61f3910ad | 56 | int i2c_freq = 400000; // I2C Frequency |
ricardo_95 | 12:7b3a5940f911 | 57 | int baud = 115200; // Baud rate |
DEldering | 1:a8e61f3910ad | 58 | short res[8] = {0,0,0,0,0,0,0,0}; // 8 PR sensors 1 time per cycle |
DEldering | 1:a8e61f3910ad | 59 | short elec[5] = {0,0,0,0,0}; // 1 PE sensor 5 times per cycle |
DEldering | 1:a8e61f3910ad | 60 | int angle = 0; // Accelerometer Z-axis |
DEldering | 1:a8e61f3910ad | 61 | int k = 0; |
DEldering | 1:a8e61f3910ad | 62 | float acce[3]; // Raw accelerometer data |
DEldering | 1:a8e61f3910ad | 63 | float gyro[3]; // Raw gyroscope data |
ricardo_95 | 22:a09775c25890 | 64 | char LED_colour = 'g'; // Variable to set LED colour. |
ricardo_95 | 21:13e4824bc364 | 65 | bool lock_state = 0, lock_flag = 0, mute_state = 0, alarm = 0, calibration_flag = 0, intensity_select = 0; // Boolean variables for states logging. |
ricardo_95 | 21:13e4824bc364 | 66 | bool mute_flag = 0, new_patient_flag = 0, reposition_flag = 0, sensorplate_connect = 0; |
ricardo_95 | 21:13e4824bc364 | 67 | bool speaker_state = 0, LED_red_state = 0, LED_yellow_state = 0, LED_green_state = 0, power_plug_state = 0; |
ricardo_95 | 21:13e4824bc364 | 68 | bool speaker_logged = 0, LED_red_logged = 0, LED_yellow_logged = 0, LED_green_logged = 0, power_plug_logged = 0; |
ricardo_95 | 11:73c6def38fbd | 69 | int locktime_ms = 2000; // Waittime for lock user interface in ms. |
ricardo_95 | 12:7b3a5940f911 | 70 | int calibrationtime_ms = 5000; // Time to press new_patient button for calibration system. |
ricardo_95 | 12:7b3a5940f911 | 71 | int calibration_flash; // Variable for flash LED's to indicate calibration. |
ricardo_95 | 7:dba5091c8b7d | 72 | int buttondelay_ms = 750; // Button delay in ms. |
ricardo_95 | 7:dba5091c8b7d | 73 | int delay_lock_interface = 3000*60; // Delay for non using interface locktime. |
ricardo_95 | 12:7b3a5940f911 | 74 | int speaker_active_ms = 750; // Time to iterate speaker on and off when alarm occurs. |
ricardo_95 | 17:6ec7d594c1f1 | 75 | int alarm_voltage = 5867; // Needed voltage for alarm expressed as a digital 15 bit value (=20% of max battery voltage) |
ricardo_95 | 22:a09775c25890 | 76 | int red_var, green_var, blue_var; // Variables to set LED intensity. |
ricardo_95 | 21:13e4824bc364 | 77 | short batteryvoltage_current = 0, batteryvoltage_last = 0, powervoltage_current, powervoltage_last; // Variables to manage batteryvoltage. |
ricardo_95 | 12:7b3a5940f911 | 78 | int intensity_day = 50, intensity_night = 25; // Intensity settings for LED's to wall. |
ricardo_95 | 22:a09775c25890 | 79 | double intensity, control_LED_intensity = 0; // Variable between 0 and 1 to set the intensity of the LED's above the buttons. |
ricardo_95 | 21:13e4824bc364 | 80 | |
ricardo_95 | 21:13e4824bc364 | 81 | /*************************** CODE ********************************/ |
ricardo_95 | 7:dba5091c8b7d | 82 | |
ricardo_95 | 11:73c6def38fbd | 83 | void set_intensity() // Function to set the intensity for the LED's. |
ricardo_95 | 7:dba5091c8b7d | 84 | { |
ricardo_95 | 11:73c6def38fbd | 85 | if (intensity_select == 1) { |
ricardo_95 | 12:7b3a5940f911 | 86 | intensity = intensity_day; |
ricardo_95 | 12:7b3a5940f911 | 87 | } else { |
ricardo_95 | 12:7b3a5940f911 | 88 | intensity = intensity_night; |
ricardo_95 | 7:dba5091c8b7d | 89 | } |
ricardo_95 | 21:13e4824bc364 | 90 | control_LED_intensity = (intensity/100); |
ricardo_95 | 22:a09775c25890 | 91 | pc.printf("control_LED_intensity = %f\n", control_LED_intensity); |
ricardo_95 | 7:dba5091c8b7d | 92 | } |
ricardo_95 | 7:dba5091c8b7d | 93 | |
ricardo_95 | 12:7b3a5940f911 | 94 | void serial_read() // Serial read for select LED intensity and colour. |
ricardo_95 | 12:7b3a5940f911 | 95 | { |
ricardo_95 | 11:73c6def38fbd | 96 | if (pi.readable()) { |
ricardo_95 | 16:adbbac0c79f9 | 97 | char message[10]; |
ricardo_95 | 12:7b3a5940f911 | 98 | |
ricardo_95 | 11:73c6def38fbd | 99 | if (message[0] == '0') { |
ricardo_95 | 11:73c6def38fbd | 100 | intensity_select = 0; |
ricardo_95 | 12:7b3a5940f911 | 101 | } |
ricardo_95 | 12:7b3a5940f911 | 102 | |
ricardo_95 | 12:7b3a5940f911 | 103 | if (message[0] == '1') { |
ricardo_95 | 12:7b3a5940f911 | 104 | intensity_select = 1; |
ricardo_95 | 12:7b3a5940f911 | 105 | } |
ricardo_95 | 12:7b3a5940f911 | 106 | |
ricardo_95 | 11:73c6def38fbd | 107 | if (message[1] == 'g') { |
ricardo_95 | 12:7b3a5940f911 | 108 | LED_colour = 'g'; |
ricardo_95 | 11:73c6def38fbd | 109 | } |
ricardo_95 | 11:73c6def38fbd | 110 | |
ricardo_95 | 11:73c6def38fbd | 111 | if (message[1] == 'y') { |
ricardo_95 | 12:7b3a5940f911 | 112 | LED_colour = 'y'; |
ricardo_95 | 11:73c6def38fbd | 113 | } |
ricardo_95 | 12:7b3a5940f911 | 114 | |
ricardo_95 | 11:73c6def38fbd | 115 | if (message[1] == 'r') { |
ricardo_95 | 12:7b3a5940f911 | 116 | LED_colour = 'r'; |
ricardo_95 | 11:73c6def38fbd | 117 | } |
ricardo_95 | 11:73c6def38fbd | 118 | } |
ricardo_95 | 11:73c6def38fbd | 119 | } |
ricardo_95 | 11:73c6def38fbd | 120 | |
ricardo_95 | 21:13e4824bc364 | 121 | void serial_log() |
ricardo_95 | 7:dba5091c8b7d | 122 | { |
ricardo_95 | 7:dba5091c8b7d | 123 | if (mute_flag == 1) { |
ricardo_95 | 19:3b5999fa7b7e | 124 | pi.printf(">01\n"); |
ricardo_95 | 19:3b5999fa7b7e | 125 | pc.printf(">01\n"); |
ricardo_95 | 7:dba5091c8b7d | 126 | mute_flag = 0; |
ricardo_95 | 19:3b5999fa7b7e | 127 | } |
ricardo_95 | 12:7b3a5940f911 | 128 | |
ricardo_95 | 19:3b5999fa7b7e | 129 | if (new_patient_flag == 1) { |
ricardo_95 | 19:3b5999fa7b7e | 130 | pi.printf(">03\n"); |
ricardo_95 | 19:3b5999fa7b7e | 131 | pc.printf(">03\n"); |
ricardo_95 | 7:dba5091c8b7d | 132 | new_patient_flag = 0; |
ricardo_95 | 7:dba5091c8b7d | 133 | } |
ricardo_95 | 12:7b3a5940f911 | 134 | |
ricardo_95 | 19:3b5999fa7b7e | 135 | if (reposition_flag == 1) { |
ricardo_95 | 19:3b5999fa7b7e | 136 | pi.printf(">02\n"); |
ricardo_95 | 19:3b5999fa7b7e | 137 | pc.printf(">02\n"); |
ricardo_95 | 7:dba5091c8b7d | 138 | reposition_flag = 0; |
ricardo_95 | 7:dba5091c8b7d | 139 | } |
ricardo_95 | 12:7b3a5940f911 | 140 | |
ricardo_95 | 8:bf0f7a6fb1fd | 141 | if (batteryvoltage_current != batteryvoltage_last) { |
ricardo_95 | 8:bf0f7a6fb1fd | 142 | pi.printf("%%d\n", batteryvoltage_current); |
ricardo_95 | 16:adbbac0c79f9 | 143 | batteryvoltage_last = batteryvoltage_current; |
ricardo_95 | 12:7b3a5940f911 | 144 | } |
ricardo_95 | 12:7b3a5940f911 | 145 | |
ricardo_95 | 9:514a44bf510f | 146 | if (LED_red_logged != LED_red_state) { |
ricardo_95 | 12:7b3a5940f911 | 147 | if (LED_red_state == 1) { |
ricardo_95 | 9:514a44bf510f | 148 | pi.printf("&04\n"); |
ricardo_95 | 9:514a44bf510f | 149 | LED_red_logged = LED_red_state; |
ricardo_95 | 12:7b3a5940f911 | 150 | } |
ricardo_95 | 9:514a44bf510f | 151 | if (LED_red_state == 0) { |
ricardo_95 | 9:514a44bf510f | 152 | pi.printf("&40\n"); |
ricardo_95 | 12:7b3a5940f911 | 153 | LED_red_logged = LED_red_state; |
ricardo_95 | 9:514a44bf510f | 154 | } |
ricardo_95 | 8:bf0f7a6fb1fd | 155 | } |
ricardo_95 | 12:7b3a5940f911 | 156 | |
ricardo_95 | 9:514a44bf510f | 157 | if (LED_yellow_logged != LED_yellow_state) { |
ricardo_95 | 12:7b3a5940f911 | 158 | if (LED_yellow_state == 1) { |
ricardo_95 | 9:514a44bf510f | 159 | pi.printf("&06\n"); |
ricardo_95 | 9:514a44bf510f | 160 | LED_yellow_logged = LED_yellow_state; |
ricardo_95 | 12:7b3a5940f911 | 161 | } |
ricardo_95 | 9:514a44bf510f | 162 | if (LED_yellow_state == 0) { |
ricardo_95 | 9:514a44bf510f | 163 | pi.printf("&60\n"); |
ricardo_95 | 12:7b3a5940f911 | 164 | LED_yellow_logged = LED_yellow_state; |
ricardo_95 | 9:514a44bf510f | 165 | } |
ricardo_95 | 7:dba5091c8b7d | 166 | } |
ricardo_95 | 12:7b3a5940f911 | 167 | |
ricardo_95 | 9:514a44bf510f | 168 | if (LED_green_logged != LED_green_state) { |
ricardo_95 | 12:7b3a5940f911 | 169 | if (LED_green_state == 1) { |
ricardo_95 | 9:514a44bf510f | 170 | pi.printf("&05\n"); |
ricardo_95 | 9:514a44bf510f | 171 | LED_green_logged = LED_green_state; |
ricardo_95 | 12:7b3a5940f911 | 172 | } |
ricardo_95 | 9:514a44bf510f | 173 | if (LED_green_state == 0) { |
ricardo_95 | 9:514a44bf510f | 174 | pi.printf("&50\n"); |
ricardo_95 | 12:7b3a5940f911 | 175 | LED_green_logged = LED_green_state; |
ricardo_95 | 9:514a44bf510f | 176 | } |
ricardo_95 | 7:dba5091c8b7d | 177 | } |
ricardo_95 | 12:7b3a5940f911 | 178 | |
ricardo_95 | 9:514a44bf510f | 179 | if (speaker_logged != speaker_state) { |
ricardo_95 | 12:7b3a5940f911 | 180 | if (speaker_state == 1) { |
ricardo_95 | 9:514a44bf510f | 181 | pi.printf("&07\n"); |
ricardo_95 | 9:514a44bf510f | 182 | speaker_logged = speaker_state; |
ricardo_95 | 12:7b3a5940f911 | 183 | } |
ricardo_95 | 9:514a44bf510f | 184 | if (speaker_state == 0) { |
ricardo_95 | 9:514a44bf510f | 185 | pi.printf("&70\n"); |
ricardo_95 | 12:7b3a5940f911 | 186 | speaker_logged = speaker_state; |
ricardo_95 | 9:514a44bf510f | 187 | } |
ricardo_95 | 8:bf0f7a6fb1fd | 188 | } |
ricardo_95 | 9:514a44bf510f | 189 | |
ricardo_95 | 9:514a44bf510f | 190 | if (power_plug_logged != power_plug_state) { |
ricardo_95 | 12:7b3a5940f911 | 191 | if (power_plug_state == 1) { |
ricardo_95 | 10:6b3034ec3c47 | 192 | pi.printf("#08\n"); |
ricardo_95 | 21:13e4824bc364 | 193 | pc.printf("#08 power on\n"); |
ricardo_95 | 9:514a44bf510f | 194 | power_plug_logged = power_plug_state; |
ricardo_95 | 12:7b3a5940f911 | 195 | } |
ricardo_95 | 9:514a44bf510f | 196 | if (power_plug_state == 0) { |
ricardo_95 | 10:6b3034ec3c47 | 197 | pi.printf("#80\n"); |
ricardo_95 | 21:13e4824bc364 | 198 | pc.printf("#08 power off\n"); |
ricardo_95 | 12:7b3a5940f911 | 199 | power_plug_logged = power_plug_state; |
ricardo_95 | 9:514a44bf510f | 200 | } |
ricardo_95 | 9:514a44bf510f | 201 | } |
DEldering | 0:c0e44c46c573 | 202 | } |
DEldering | 0:c0e44c46c573 | 203 | |
ricardo_95 | 21:13e4824bc364 | 204 | void colour_select(char LED_colour) // Function to select the colour. |
ricardo_95 | 21:13e4824bc364 | 205 | { |
ricardo_95 | 21:13e4824bc364 | 206 | set_intensity(); // Call function set_intensity |
ricardo_95 | 21:13e4824bc364 | 207 | |
ricardo_95 | 21:13e4824bc364 | 208 | if (LED_colour == 'r') { |
ricardo_95 | 21:13e4824bc364 | 209 | red_var = (2.55*intensity); |
ricardo_95 | 21:13e4824bc364 | 210 | green_var = 0; |
ricardo_95 | 21:13e4824bc364 | 211 | blue_var = 0; |
ricardo_95 | 21:13e4824bc364 | 212 | LED_red_state = 1; |
ricardo_95 | 21:13e4824bc364 | 213 | } else { |
ricardo_95 | 21:13e4824bc364 | 214 | LED_red_state = 0; |
ricardo_95 | 21:13e4824bc364 | 215 | } |
ricardo_95 | 21:13e4824bc364 | 216 | |
ricardo_95 | 21:13e4824bc364 | 217 | if (LED_colour == 'y') { |
ricardo_95 | 21:13e4824bc364 | 218 | red_var = (2.55*intensity); |
ricardo_95 | 21:13e4824bc364 | 219 | green_var = (2.55*intensity); |
ricardo_95 | 21:13e4824bc364 | 220 | blue_var = 0; |
ricardo_95 | 21:13e4824bc364 | 221 | LED_yellow_state = 1; |
ricardo_95 | 21:13e4824bc364 | 222 | } else { |
ricardo_95 | 21:13e4824bc364 | 223 | LED_green_state = 0; |
ricardo_95 | 21:13e4824bc364 | 224 | } |
ricardo_95 | 21:13e4824bc364 | 225 | |
ricardo_95 | 21:13e4824bc364 | 226 | if (LED_colour == 'g') { |
ricardo_95 | 21:13e4824bc364 | 227 | red_var = 0; |
ricardo_95 | 21:13e4824bc364 | 228 | green_var = (2.55*intensity); |
ricardo_95 | 21:13e4824bc364 | 229 | blue_var = 0; |
ricardo_95 | 21:13e4824bc364 | 230 | LED_green_state = 1; |
ricardo_95 | 21:13e4824bc364 | 231 | } else { |
ricardo_95 | 21:13e4824bc364 | 232 | LED_green_state = 0; |
ricardo_95 | 21:13e4824bc364 | 233 | } |
ricardo_95 | 21:13e4824bc364 | 234 | |
ricardo_95 | 21:13e4824bc364 | 235 | if (calibration_flash >= 1) { |
ricardo_95 | 21:13e4824bc364 | 236 | if ((calibration_flash % 2) == 0) { |
ricardo_95 | 21:13e4824bc364 | 237 | red_var = 255; |
ricardo_95 | 21:13e4824bc364 | 238 | green_var = 255; |
ricardo_95 | 21:13e4824bc364 | 239 | blue_var = 255; |
ricardo_95 | 21:13e4824bc364 | 240 | } else { |
ricardo_95 | 21:13e4824bc364 | 241 | red_var = 0; |
ricardo_95 | 21:13e4824bc364 | 242 | green_var = 0; |
ricardo_95 | 21:13e4824bc364 | 243 | blue_var = 0; |
ricardo_95 | 21:13e4824bc364 | 244 | } |
ricardo_95 | 21:13e4824bc364 | 245 | calibration_flash--; |
ricardo_95 | 21:13e4824bc364 | 246 | } |
ricardo_95 | 21:13e4824bc364 | 247 | } |
ricardo_95 | 21:13e4824bc364 | 248 | |
ricardo_95 | 21:13e4824bc364 | 249 | void trigger_lock() // If rising edge lock button is detected start locktimer. |
ricardo_95 | 21:13e4824bc364 | 250 | { |
ricardo_95 | 21:13e4824bc364 | 251 | pc.printf("Lock triggered.\n"); |
ricardo_95 | 21:13e4824bc364 | 252 | lock_hold_timer.reset(); |
ricardo_95 | 21:13e4824bc364 | 253 | lock_hold_timer.start(); |
ricardo_95 | 21:13e4824bc364 | 254 | delay.reset(); |
ricardo_95 | 21:13e4824bc364 | 255 | delay.start(); |
ricardo_95 | 21:13e4824bc364 | 256 | } |
ricardo_95 | 21:13e4824bc364 | 257 | |
ricardo_95 | 21:13e4824bc364 | 258 | void timer_lock() // End timer lock. |
ricardo_95 | 21:13e4824bc364 | 259 | { |
ricardo_95 | 21:13e4824bc364 | 260 | lock_flag = 0; // Set lock_flag off. |
ricardo_95 | 21:13e4824bc364 | 261 | lock_hold_timer.stop(); // Stop and reset holdtimer |
ricardo_95 | 21:13e4824bc364 | 262 | lock_hold_timer.reset(); |
ricardo_95 | 21:13e4824bc364 | 263 | } |
ricardo_95 | 21:13e4824bc364 | 264 | |
ricardo_95 | 21:13e4824bc364 | 265 | void trigger_reposition() |
ricardo_95 | 21:13e4824bc364 | 266 | { |
ricardo_95 | 21:13e4824bc364 | 267 | if (lock_state == 1 | (delay.read_ms() < buttondelay_ms)) { // Control statement for lock interface and delay for non using buttons at the same time. |
ricardo_95 | 21:13e4824bc364 | 268 | } else { |
ricardo_95 | 21:13e4824bc364 | 269 | delay.reset(); |
ricardo_95 | 21:13e4824bc364 | 270 | delay.start(); |
ricardo_95 | 21:13e4824bc364 | 271 | pc.printf("Reposition triggered.\n"); |
ricardo_95 | 21:13e4824bc364 | 272 | if (LED_intern1 == 0) { |
ricardo_95 | 21:13e4824bc364 | 273 | LED_intern1 = 1; |
ricardo_95 | 21:13e4824bc364 | 274 | } else { |
ricardo_95 | 21:13e4824bc364 | 275 | LED_intern1 = 0; |
ricardo_95 | 21:13e4824bc364 | 276 | } |
ricardo_95 | 21:13e4824bc364 | 277 | |
ricardo_95 | 21:13e4824bc364 | 278 | reposition_flag = 1; |
ricardo_95 | 21:13e4824bc364 | 279 | |
ricardo_95 | 21:13e4824bc364 | 280 | reposition_LED = control_LED_intensity; |
ricardo_95 | 21:13e4824bc364 | 281 | } |
ricardo_95 | 21:13e4824bc364 | 282 | } |
ricardo_95 | 21:13e4824bc364 | 283 | |
ricardo_95 | 21:13e4824bc364 | 284 | void rise_reposition() |
ricardo_95 | 21:13e4824bc364 | 285 | { |
ricardo_95 | 21:13e4824bc364 | 286 | reposition_LED = 0; |
ricardo_95 | 21:13e4824bc364 | 287 | } |
ricardo_95 | 21:13e4824bc364 | 288 | |
ricardo_95 | 21:13e4824bc364 | 289 | void trigger_mute() |
ricardo_95 | 21:13e4824bc364 | 290 | { |
ricardo_95 | 21:13e4824bc364 | 291 | |
ricardo_95 | 21:13e4824bc364 | 292 | if (lock_state == 1 | (delay.read_ms() < buttondelay_ms)) { // Control statement for lock interface and delay for non using buttons at the same time. |
ricardo_95 | 21:13e4824bc364 | 293 | } else { |
ricardo_95 | 21:13e4824bc364 | 294 | delay.reset(); |
ricardo_95 | 21:13e4824bc364 | 295 | delay.start(); |
ricardo_95 | 21:13e4824bc364 | 296 | mute_state = !mute_state; |
ricardo_95 | 21:13e4824bc364 | 297 | if (mute_state == 1) { |
ricardo_95 | 21:13e4824bc364 | 298 | mute_LED = control_LED_intensity; |
ricardo_95 | 21:13e4824bc364 | 299 | } else { |
ricardo_95 | 21:13e4824bc364 | 300 | mute_LED = 0; |
ricardo_95 | 21:13e4824bc364 | 301 | } |
ricardo_95 | 21:13e4824bc364 | 302 | pc.printf("Mute triggered %d.\n",mute_state); |
ricardo_95 | 21:13e4824bc364 | 303 | if (LED_intern1 == 0) { |
ricardo_95 | 21:13e4824bc364 | 304 | LED_intern1 = 1; |
ricardo_95 | 21:13e4824bc364 | 305 | } else { |
ricardo_95 | 21:13e4824bc364 | 306 | LED_intern1 = 0; |
ricardo_95 | 21:13e4824bc364 | 307 | } |
ricardo_95 | 21:13e4824bc364 | 308 | |
ricardo_95 | 21:13e4824bc364 | 309 | mute_flag = 1; |
ricardo_95 | 21:13e4824bc364 | 310 | } |
ricardo_95 | 21:13e4824bc364 | 311 | } |
ricardo_95 | 21:13e4824bc364 | 312 | |
ricardo_95 | 21:13e4824bc364 | 313 | void trigger_new_patient() // Function to trigger hold timer for new patient calibration function. |
ricardo_95 | 21:13e4824bc364 | 314 | { |
ricardo_95 | 21:13e4824bc364 | 315 | |
ricardo_95 | 21:13e4824bc364 | 316 | if (lock_state == 1) { |
ricardo_95 | 21:13e4824bc364 | 317 | } else { |
ricardo_95 | 21:13e4824bc364 | 318 | calibration_hold_timer.reset(); |
ricardo_95 | 21:13e4824bc364 | 319 | calibration_hold_timer.start(); |
ricardo_95 | 21:13e4824bc364 | 320 | new_patient_LED = control_LED_intensity;; |
ricardo_95 | 21:13e4824bc364 | 321 | pc.printf("New patient triggered.\n"); |
ricardo_95 | 21:13e4824bc364 | 322 | } |
ricardo_95 | 21:13e4824bc364 | 323 | } |
ricardo_95 | 21:13e4824bc364 | 324 | |
ricardo_95 | 21:13e4824bc364 | 325 | void timer_calibration() // Timer calibration function. |
ricardo_95 | 21:13e4824bc364 | 326 | { |
ricardo_95 | 21:13e4824bc364 | 327 | new_patient_LED = 0; |
ricardo_95 | 21:13e4824bc364 | 328 | |
ricardo_95 | 21:13e4824bc364 | 329 | if (0 < calibration_hold_timer.read_ms() < calibrationtime_ms) { |
ricardo_95 | 21:13e4824bc364 | 330 | new_patient_flag = 1; |
ricardo_95 | 21:13e4824bc364 | 331 | } |
ricardo_95 | 21:13e4824bc364 | 332 | |
ricardo_95 | 21:13e4824bc364 | 333 | calibration_hold_timer.stop(); |
ricardo_95 | 21:13e4824bc364 | 334 | calibration_hold_timer.reset(); |
ricardo_95 | 21:13e4824bc364 | 335 | |
ricardo_95 | 21:13e4824bc364 | 336 | if (lock_state == 1 | (delay.read_ms() < buttondelay_ms)) { // Control statement for lock interface and delay for non using buttons at the same time. |
ricardo_95 | 21:13e4824bc364 | 337 | } else { |
ricardo_95 | 21:13e4824bc364 | 338 | if (calibration_flag == 0) { |
ricardo_95 | 21:13e4824bc364 | 339 | |
ricardo_95 | 21:13e4824bc364 | 340 | if (LED_intern1 == 0) { |
ricardo_95 | 21:13e4824bc364 | 341 | LED_intern1 = 1; |
ricardo_95 | 21:13e4824bc364 | 342 | } else { |
ricardo_95 | 21:13e4824bc364 | 343 | LED_intern1 = 0; |
ricardo_95 | 21:13e4824bc364 | 344 | } |
ricardo_95 | 21:13e4824bc364 | 345 | |
ricardo_95 | 21:13e4824bc364 | 346 | } else { |
ricardo_95 | 21:13e4824bc364 | 347 | calibration_flag = 0; |
ricardo_95 | 21:13e4824bc364 | 348 | } |
ricardo_95 | 21:13e4824bc364 | 349 | } |
ricardo_95 | 21:13e4824bc364 | 350 | } |
ricardo_95 | 21:13e4824bc364 | 351 | |
ricardo_95 | 21:13e4824bc364 | 352 | void timer_functions() |
ricardo_95 | 21:13e4824bc364 | 353 | { |
ricardo_95 | 21:13e4824bc364 | 354 | if ((lock_hold_timer.read_ms() > locktime_ms) && lock_flag == 0 && lock == 0) { // If statement for lock function. |
ricardo_95 | 21:13e4824bc364 | 355 | lock_flag = 1; |
ricardo_95 | 21:13e4824bc364 | 356 | LED_intern2 = !LED_intern2; |
ricardo_95 | 21:13e4824bc364 | 357 | lock_state = !lock_state; |
ricardo_95 | 21:13e4824bc364 | 358 | if (lock_state == 0) { |
ricardo_95 | 21:13e4824bc364 | 359 | lock_LED = control_LED_intensity; |
ricardo_95 | 21:13e4824bc364 | 360 | } else { |
ricardo_95 | 21:13e4824bc364 | 361 | lock_LED = 0; |
ricardo_95 | 21:13e4824bc364 | 362 | } |
ricardo_95 | 21:13e4824bc364 | 363 | } |
ricardo_95 | 21:13e4824bc364 | 364 | |
ricardo_95 | 21:13e4824bc364 | 365 | if ((calibration_hold_timer.read_ms() > calibrationtime_ms) && calibration_flag == 0 && new_patient == 0) { // If statement for calibration system. |
ricardo_95 | 21:13e4824bc364 | 366 | calibration_flag = 1; |
ricardo_95 | 21:13e4824bc364 | 367 | calibration_flash = 11; |
ricardo_95 | 21:13e4824bc364 | 368 | pc.printf("Calibrate triggered.\n"); |
ricardo_95 | 21:13e4824bc364 | 369 | pi.printf(">30\n"); // Print statement for serial communication to inform algorithm to calibrate. |
ricardo_95 | 21:13e4824bc364 | 370 | } |
ricardo_95 | 21:13e4824bc364 | 371 | |
ricardo_95 | 21:13e4824bc364 | 372 | if (delay.read_ms() > delay_lock_interface) { // If buttons are not pressed for 3 minutes, set lock active. |
ricardo_95 | 21:13e4824bc364 | 373 | lock_state = 1; |
ricardo_95 | 21:13e4824bc364 | 374 | LED_intern2 = 1; |
ricardo_95 | 21:13e4824bc364 | 375 | lock_LED = 0; |
ricardo_95 | 21:13e4824bc364 | 376 | } |
ricardo_95 | 21:13e4824bc364 | 377 | } |
ricardo_95 | 21:13e4824bc364 | 378 | |
ricardo_95 | 21:13e4824bc364 | 379 | void generate(neopixel::Pixel * out, uint32_t index, uintptr_t val) // Generate LED colour. |
ricardo_95 | 21:13e4824bc364 | 380 | { |
ricardo_95 | 21:13e4824bc364 | 381 | out->red = red_var; |
ricardo_95 | 21:13e4824bc364 | 382 | out->green = green_var; |
ricardo_95 | 21:13e4824bc364 | 383 | out->blue = blue_var; |
ricardo_95 | 21:13e4824bc364 | 384 | } |
ricardo_95 | 21:13e4824bc364 | 385 | |
ricardo_95 | 21:13e4824bc364 | 386 | void set_ui_LED() // Control functions for LED above buttons (added because of failures). |
ricardo_95 | 21:13e4824bc364 | 387 | { |
ricardo_95 | 21:13e4824bc364 | 388 | if (lock_state == 1) { |
ricardo_95 | 21:13e4824bc364 | 389 | } else { |
ricardo_95 | 21:13e4824bc364 | 390 | if (reposition == 0) { |
ricardo_95 | 22:a09775c25890 | 391 | reposition_LED = control_LED_intensity; |
ricardo_95 | 21:13e4824bc364 | 392 | } else { |
ricardo_95 | 21:13e4824bc364 | 393 | reposition_LED = 0; |
ricardo_95 | 21:13e4824bc364 | 394 | } |
ricardo_95 | 21:13e4824bc364 | 395 | |
ricardo_95 | 21:13e4824bc364 | 396 | if (new_patient == 0) { |
ricardo_95 | 22:a09775c25890 | 397 | new_patient_LED = control_LED_intensity; |
ricardo_95 | 21:13e4824bc364 | 398 | } else { |
ricardo_95 | 21:13e4824bc364 | 399 | new_patient_LED = 0; |
ricardo_95 | 21:13e4824bc364 | 400 | } |
ricardo_95 | 21:13e4824bc364 | 401 | } |
ricardo_95 | 21:13e4824bc364 | 402 | } |
ricardo_95 | 21:13e4824bc364 | 403 | |
ricardo_95 | 21:13e4824bc364 | 404 | void read_voltage() |
ricardo_95 | 21:13e4824bc364 | 405 | { |
ricardo_95 | 21:13e4824bc364 | 406 | if (power_plug_state == 1) { // If supplyvoltage (readed from input) is greater then the setted alarmvoltage. |
ricardo_95 | 21:13e4824bc364 | 407 | alarm = 0; // Alarm is off. |
ricardo_95 | 21:13e4824bc364 | 408 | speaker_state = 0; |
ricardo_95 | 21:13e4824bc364 | 409 | } else { |
ricardo_95 | 21:13e4824bc364 | 410 | alarm = 1; // Else alarm is on. |
ricardo_95 | 21:13e4824bc364 | 411 | speaker_state = 1; |
ricardo_95 | 21:13e4824bc364 | 412 | } |
ricardo_95 | 21:13e4824bc364 | 413 | |
ricardo_95 | 21:13e4824bc364 | 414 | |
ricardo_95 | 21:13e4824bc364 | 415 | if (alarm == 1 && mute_state == 1 && (batteryvoltage_current > alarm_voltage)) { // Set speaker on for 750 ms. |
ricardo_95 | 21:13e4824bc364 | 416 | speaker1 = 0; // Set speaker. |
ricardo_95 | 21:13e4824bc364 | 417 | speaker2 = 0; |
ricardo_95 | 21:13e4824bc364 | 418 | } |
ricardo_95 | 21:13e4824bc364 | 419 | |
ricardo_95 | 21:13e4824bc364 | 420 | if ((alarm == 1 && mute_state == 0 && (speaker_timer.read_ms() < speaker_active_ms)) || ((batteryvoltage_current < alarm_voltage) && (speaker_timer.read_ms() < speaker_active_ms))) { // Set speaker on for 750 ms. |
ricardo_95 | 21:13e4824bc364 | 421 | speaker1 = 1; // Set speaker. |
ricardo_95 | 21:13e4824bc364 | 422 | speaker2 = 1; |
ricardo_95 | 21:13e4824bc364 | 423 | speaker_timer.reset(); |
ricardo_95 | 21:13e4824bc364 | 424 | speaker_timer.start(); // Set timer for speaker to iterate on and off. |
ricardo_95 | 21:13e4824bc364 | 425 | } |
ricardo_95 | 21:13e4824bc364 | 426 | |
ricardo_95 | 21:13e4824bc364 | 427 | if ((speaker_timer.read_ms() > speaker_active_ms) && (speaker_timer.read_ms() < (speaker_active_ms*2))) { |
ricardo_95 | 21:13e4824bc364 | 428 | speaker1 = 0; // Turn off speaker (use two outputs because of currentlimiting of one). |
ricardo_95 | 21:13e4824bc364 | 429 | speaker2 = 0; |
ricardo_95 | 21:13e4824bc364 | 430 | } |
ricardo_95 | 21:13e4824bc364 | 431 | |
ricardo_95 | 21:13e4824bc364 | 432 | if (speaker_timer.read_ms() > (speaker_active_ms*2)) { |
ricardo_95 | 21:13e4824bc364 | 433 | speaker_timer.stop(); // Stop speaker timer. |
ricardo_95 | 21:13e4824bc364 | 434 | speaker_timer.reset(); |
ricardo_95 | 21:13e4824bc364 | 435 | } |
ricardo_95 | 21:13e4824bc364 | 436 | |
ricardo_95 | 21:13e4824bc364 | 437 | batteryvoltage_current = adsAccu.readADC_SingleEnded(0); // Read channel 0 from external ADC. |
ricardo_95 | 21:13e4824bc364 | 438 | powervoltage_current = adsAccu.readADC_SingleEnded(1); // Read channel 1 from external ADC. |
ricardo_95 | 21:13e4824bc364 | 439 | |
ricardo_95 | 21:13e4824bc364 | 440 | if (powervoltage_current < 20000) { |
ricardo_95 | 21:13e4824bc364 | 441 | power_plug_state = 0; |
ricardo_95 | 21:13e4824bc364 | 442 | } else { |
ricardo_95 | 21:13e4824bc364 | 443 | power_plug_state = 1; |
ricardo_95 | 21:13e4824bc364 | 444 | } |
ricardo_95 | 21:13e4824bc364 | 445 | } |
ricardo_95 | 21:13e4824bc364 | 446 | |
ricardo_95 | 21:13e4824bc364 | 447 | void read_adc() |
ricardo_95 | 21:13e4824bc364 | 448 | { |
ricardo_95 | 21:13e4824bc364 | 449 | t.reset(); |
ricardo_95 | 21:13e4824bc364 | 450 | t.start(); |
ricardo_95 | 21:13e4824bc364 | 451 | |
ricardo_95 | 21:13e4824bc364 | 452 | if (sensorplate_connect == 1) { |
ricardo_95 | 21:13e4824bc364 | 453 | elec[0] = pel.readADC_SingleEnded(0); // First PE readout |
ricardo_95 | 21:13e4824bc364 | 454 | |
ricardo_95 | 21:13e4824bc364 | 455 | for (k = 0; k < 4; k = k + 1) { |
ricardo_95 | 21:13e4824bc364 | 456 | res[k] = pr1.readADC_SingleEnded(k); // First 4 PR readout |
ricardo_95 | 21:13e4824bc364 | 457 | } |
ricardo_95 | 21:13e4824bc364 | 458 | while(t.read_us()<(1*(cycle_time/5))) {} // Wait untill 20% of cycle |
ricardo_95 | 21:13e4824bc364 | 459 | |
ricardo_95 | 21:13e4824bc364 | 460 | elec[1] = pel.readADC_SingleEnded(0); // Second PE readout |
ricardo_95 | 21:13e4824bc364 | 461 | |
ricardo_95 | 21:13e4824bc364 | 462 | for (k = 0; k < 4; k = k + 1) { |
ricardo_95 | 21:13e4824bc364 | 463 | res[k+4] = pr2.readADC_SingleEnded(k); // Last 4 PR readout |
ricardo_95 | 21:13e4824bc364 | 464 | } |
ricardo_95 | 21:13e4824bc364 | 465 | while(t.read_us()<(2*(cycle_time/5))) {} // Wait untill 40% of cycle |
ricardo_95 | 21:13e4824bc364 | 466 | |
ricardo_95 | 21:13e4824bc364 | 467 | elec[2] = pel.readADC_SingleEnded(0); // Third PE readout |
ricardo_95 | 21:13e4824bc364 | 468 | |
ricardo_95 | 21:13e4824bc364 | 469 | agu.getAccelero(acce); // Get accelerometer data |
ricardo_95 | 21:13e4824bc364 | 470 | angle = acce[2]*10; |
ricardo_95 | 21:13e4824bc364 | 471 | agu.getGyro(gyro); // Get gyroscope data |
ricardo_95 | 21:13e4824bc364 | 472 | |
ricardo_95 | 21:13e4824bc364 | 473 | while(t.read_us()<(3*(cycle_time/5))) {} // Wait untill 60% of cycle |
ricardo_95 | 21:13e4824bc364 | 474 | |
ricardo_95 | 21:13e4824bc364 | 475 | elec[3] = pel.readADC_SingleEnded(0); // Fourth PE readout |
ricardo_95 | 21:13e4824bc364 | 476 | } |
ricardo_95 | 21:13e4824bc364 | 477 | |
ricardo_95 | 21:13e4824bc364 | 478 | timer_functions(); |
ricardo_95 | 21:13e4824bc364 | 479 | |
ricardo_95 | 21:13e4824bc364 | 480 | batteryvoltage_current = batteryvoltage_last; |
ricardo_95 | 21:13e4824bc364 | 481 | powervoltage_current = powervoltage_last; |
ricardo_95 | 21:13e4824bc364 | 482 | read_voltage(); // Supplyvoltage control for alarm. |
ricardo_95 | 21:13e4824bc364 | 483 | pc.printf("Voltage = %d , %d\n", batteryvoltage_current, powervoltage_current); |
ricardo_95 | 21:13e4824bc364 | 484 | |
ricardo_95 | 21:13e4824bc364 | 485 | uint32_t val = 0; |
ricardo_95 | 21:13e4824bc364 | 486 | colour_select(LED_colour); |
ricardo_95 | 21:13e4824bc364 | 487 | array.update(generate, NLED, val); |
ricardo_95 | 21:13e4824bc364 | 488 | set_ui_LED(); |
ricardo_95 | 21:13e4824bc364 | 489 | |
ricardo_95 | 21:13e4824bc364 | 490 | while(t.read_us()<(4*(cycle_time/5))) {} // Wait untill 80% of cycle |
ricardo_95 | 21:13e4824bc364 | 491 | |
ricardo_95 | 21:13e4824bc364 | 492 | if (sensorplate_connect == 1) { |
ricardo_95 | 21:13e4824bc364 | 493 | elec[4] = pel.readADC_SingleEnded(0); // Fifth PE readout |
ricardo_95 | 21:13e4824bc364 | 494 | } |
ricardo_95 | 21:13e4824bc364 | 495 | |
ricardo_95 | 21:13e4824bc364 | 496 | while(t.read_us()<(4.25*(cycle_time/5))) {} // Wait untill 85% of cycle |
ricardo_95 | 21:13e4824bc364 | 497 | pi.printf("!,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%f,%f,%f,%f,%f,%f,\n", res[4], res[7], res[6], res[5], res[1], res[0], res[2], res[3], elec[0], elec[1], elec[2], elec[3], elec[4], acce[0]*100, acce[1]*100, acce[2]*100, gyro[0]*100, gyro[1]*100, gyro[2]*100); // print all to serial port |
ricardo_95 | 21:13e4824bc364 | 498 | //receiving order: 8 resistive sensors, 5 electric readings, 3 accelerometer axes, 3 gyroscope axes |
ricardo_95 | 21:13e4824bc364 | 499 | serial_read(); |
ricardo_95 | 21:13e4824bc364 | 500 | serial_log(); |
ricardo_95 | 21:13e4824bc364 | 501 | } |
ricardo_95 | 21:13e4824bc364 | 502 | |
DEldering | 0:c0e44c46c573 | 503 | int main() |
DEldering | 0:c0e44c46c573 | 504 | { |
ricardo_95 | 12:7b3a5940f911 | 505 | wait_ms(boot_delay_ms); // Wait to boot sensorplate first |
DEldering | 1:a8e61f3910ad | 506 | i2c.frequency(i2c_freq); |
ricardo_95 | 21:13e4824bc364 | 507 | i2cAccu.frequency(i2c_freq); |
ricardo_95 | 12:7b3a5940f911 | 508 | pc.baud(baud); |
ricardo_95 | 12:7b3a5940f911 | 509 | pi.baud(baud); |
DEldering | 1:a8e61f3910ad | 510 | pr1.setGain(GAIN_TWOTHIRDS); // set range to +/-6.144V |
ricardo_95 | 17:6ec7d594c1f1 | 511 | pr2.setGain(GAIN_TWOTHIRDS); // set range to +/-6.144V |
DEldering | 1:a8e61f3910ad | 512 | pel.setGain(GAIN_TWOTHIRDS); // set range to +/-6.144V |
ricardo_95 | 17:6ec7d594c1f1 | 513 | adsAccu.setGain(GAIN_TWOTHIRDS); // set range to +/-6.144V |
ricardo_95 | 7:dba5091c8b7d | 514 | pi.format(8, SerialBase::None, 1); |
ricardo_95 | 7:dba5091c8b7d | 515 | |
ricardo_95 | 21:13e4824bc364 | 516 | lock.fall(&trigger_lock); // Interrupt for rising edge lock button. |
ricardo_95 | 21:13e4824bc364 | 517 | lock.rise(&timer_lock); |
ricardo_95 | 21:13e4824bc364 | 518 | reposition.fall(&trigger_reposition); |
ricardo_95 | 21:13e4824bc364 | 519 | reposition.rise(&rise_reposition); |
ricardo_95 | 21:13e4824bc364 | 520 | mute.fall(&trigger_mute); |
ricardo_95 | 21:13e4824bc364 | 521 | new_patient.fall(&trigger_new_patient); // New patient/calibration button rising event. |
ricardo_95 | 21:13e4824bc364 | 522 | new_patient.rise(&timer_calibration); // Falling edge for calibration algorithm option. |
ricardo_95 | 7:dba5091c8b7d | 523 | delay.reset(); // Delaytimer reset en start. |
ricardo_95 | 7:dba5091c8b7d | 524 | delay.start(); |
ricardo_95 | 22:a09775c25890 | 525 | |
ricardo_95 | 22:a09775c25890 | 526 | set_intensity(); |
ricardo_95 | 22:a09775c25890 | 527 | lock_LED = control_LED_intensity; // Lock LED initialization. |
ricardo_95 | 21:13e4824bc364 | 528 | |
ricardo_95 | 19:3b5999fa7b7e | 529 | sample_cycle.attach_us(&read_adc, cycle_time); |
ricardo_95 | 19:3b5999fa7b7e | 530 | |
DEldering | 0:c0e44c46c573 | 531 | while (1) { |
DEldering | 1:a8e61f3910ad | 532 | wait_us(cycle_time+1); // wait indefinitely because the ticker restarts every 50 ms |
DEldering | 0:c0e44c46c573 | 533 | } |
ricardo_95 | 12:7b3a5940f911 | 534 | } |