Olivier Nastorg / Mbed OS ARNSRS_testDFU

mbed-os github

Dependencies:   ADS1015 Faulhaber HTU21D_mod MS5837_potless Sensor_Head_RevB_3 USBDevice_dfu Utilsdfu beep

Fork of ARNSRS_testDFU by POTLESS

main.cpp@41:51ba69648f9d, 2018-03-30 (annotated)

Committer:
POTLESS_2
Date:
Fri Mar 30 10:29:10 2018 +0000
Revision:
41:51ba69648f9d
Parent:
40:32d89e04ead1
Child:
42:3591ec9903b4
update

Who changed what in which revision?

UserRevisionLine numberNew contents of line
potless 1:bef7856b5c0a 1 #include "mbed.h"
potless 2:4a8bf1d53439 2 #include <string>
POTLESS_2 7:ad15c386e960 3 #include "Sensor_head_revB.h"
POTLESS_2 8:a750d531b381 4 #include "HTU21D.h"
POTLESS_2 12:7f3aadd79f89 5 #include "PID.h"
POTLESS_2 19:cac3761a5d0b 6 #include "Faulhaber.h"
POTLESS_2 29:5b822d18bce6 7 #include "Utils.h"
POTLESS_2 4:d84250f67dec 8
POTLESS_2 17:bef8abc445f2 9 //Commandes des servos
POTLESS_2 19:cac3761a5d0b 10 #define PWM_SERVO_POUMON PB_15
POTLESS_2 19:cac3761a5d0b 11 #define nSleep_SERVO_POUMON PC_6
POTLESS_2 19:cac3761a5d0b 12 #define FWD_SERVO_POUMON PB_14
POTLESS_2 19:cac3761a5d0b 13 #define REV_SERVO_POUMON PB_13
POTLESS_2 19:cac3761a5d0b 14 #define Channel_A_SERVO_POUMON PB_1
POTLESS_2 19:cac3761a5d0b 15 #define Channel_B_SERVO_POUMON PB_2
POTLESS_2 19:cac3761a5d0b 16 #define HOME_SERVO_POUMON 0
POTLESS_2 17:bef8abc445f2 17
POTLESS_2 19:cac3761a5d0b 18 #define PWM_SERVO_FUITE PB_10
POTLESS_2 19:cac3761a5d0b 19 #define nSleep_SERVO_FUITE PC_5
POTLESS_2 19:cac3761a5d0b 20 #define FWD_SERVO_FUITE PB_4
POTLESS_2 19:cac3761a5d0b 21 #define REV_SERVO_FUITE PB_5
POTLESS_2 19:cac3761a5d0b 22 #define Channel_A_SERVO_FUITE PB_8
POTLESS_2 19:cac3761a5d0b 23 #define Channel_B_SERVO_FUITE PB_9
POTLESS_2 19:cac3761a5d0b 24 #define HOME_SERVO_FUITE 90
POTLESS_2 17:bef8abc445f2 25
POTLESS_2 17:bef8abc445f2 26 //Ecrit dans le moniteur série de la tablette à 115200 bds si sur 1, penser à mettre NEED_CONSOLE_OUTPUT à 0
POTLESS_2 41:51ba69648f9d 27 #define NEED_ANDROID_OUTPUT 0
POTLESS_2 9:04bfdfc029cb 28
POTLESS_2 17:bef8abc445f2 29 //Mode PID, STD à commenter / décommenter
POTLESS_2 17:bef8abc445f2 30 #define STD_MODE
POTLESS_2 17:bef8abc445f2 31 //#define PID_MODE
POTLESS_2 11:b2feed92584a 32
POTLESS_2 12:7f3aadd79f89 33 #ifdef STD_MODE
POTLESS_2 12:7f3aadd79f89 34 int MODE_FLAG = 0;
POTLESS_2 11:b2feed92584a 35 #endif
POTLESS_2 11:b2feed92584a 36
POTLESS_2 12:7f3aadd79f89 37 #ifdef PID_MODE
POTLESS_2 12:7f3aadd79f89 38 int MODE_FLAG = 2;
POTLESS_2 11:b2feed92584a 39 #endif
POTLESS_2 11:b2feed92584a 40
POTLESS_2 9:04bfdfc029cb 41 #if NEED_ANDROID_OUTPUT
POTLESS_2 9:04bfdfc029cb 42 #define ANDROID(...) { android.printf(__VA_ARGS__); }
POTLESS_2 9:04bfdfc029cb 43 #else
POTLESS_2 9:04bfdfc029cb 44 #define ANDROID(...)
POTLESS_2 9:04bfdfc029cb 45 #endif
POTLESS_2 9:04bfdfc029cb 46
POTLESS_2 33:f5d4bae05f16 47 #if DEBUG_MODE
POTLESS_2 33:f5d4bae05f16 48 #define DEBUG(...) { serialMonit.printf(__VA_ARGS__); fflush(stdout);}
POTLESS_2 29:5b822d18bce6 49 #else
POTLESS_2 33:f5d4bae05f16 50 #define DEBUG(...)
POTLESS_2 29:5b822d18bce6 51 #endif
POTLESS_2 29:5b822d18bce6 52
POTLESS_2 34:26f6e3dbefb9 53
POTLESS_2 25:322ef9488e65 54 //PinName pwm, PinName nSleep, PinName fwd, PinName rev, PinName channelA, PinName channelB, int pulsesPerRev, int Rapport, Encoding encoding = X2_ENCODING
POTLESS_2 25:322ef9488e65 55 Faulhaber Servo_Poumon("Servo_Poumon", PWM_SERVO_POUMON, nSleep_SERVO_POUMON, FWD_SERVO_POUMON, REV_SERVO_POUMON, Channel_A_SERVO_POUMON, Channel_B_SERVO_POUMON, 16, 207, Faulhaber::X2_ENCODING);
POTLESS_2 22:555c2930e8e0 56 //Faulhaber Servo_Fuite("Servo_Fuite", PWM_SERVO_FUITE, nSleep_SERVO_FUITE, FWD_SERVO_FUITE, REV_SERVO_FUITE, 1, Channel_A_SERVO_FUITE, Channel_B_SERVO_FUITE, 16, 207, Faulhaber::X2_ENCODING);
POTLESS_2 17:bef8abc445f2 57
POTLESS_2 17:bef8abc445f2 58 //Moniteur série, Serial 2
POTLESS_2 17:bef8abc445f2 59 Serial serialMonit(USBTX,USBRX,115200);
POTLESS_2 10:aca745a66d51 60
POTLESS_2 9:04bfdfc029cb 61 //COM Série vers Android, Serial 3
POTLESS_2 17:bef8abc445f2 62 Serial android(PC_10,PC_11,115200);
POTLESS_2 4:d84250f67dec 63
POTLESS_2 7:ad15c386e960 64 //Init de la lib ARNSRS;
POTLESS_2 7:ad15c386e960 65 SENSOR_HEAD_REV_B sensors;
potless 2:4a8bf1d53439 66
POTLESS_2 34:26f6e3dbefb9 67 //pour Param Venant du PV
POTLESS_2 34:26f6e3dbefb9 68 const int sizeParam = 30;
POTLESS_2 11:b2feed92584a 69 char param[sizeParam];
POTLESS_2 11:b2feed92584a 70 volatile int indexParam = 0;
POTLESS_2 6:ebed9093d661 71 bool newParamFlag = false;
potless 2:4a8bf1d53439 72
POTLESS_2 9:04bfdfc029cb 73 //pour Commandes Android
POTLESS_2 9:04bfdfc029cb 74 const int sizeAndroid = 20;
POTLESS_2 11:b2feed92584a 75 char Android[sizeAndroid];
POTLESS_2 11:b2feed92584a 76 volatile int indexAndroid = 0;
POTLESS_2 9:04bfdfc029cb 77 bool newAndroidFlag = false;
POTLESS_2 12:7f3aadd79f89 78 char to_android[100];
POTLESS_2 9:04bfdfc029cb 79
POTLESS_2 25:322ef9488e65 80 //Flag pour interrompre l'affichage si on veut...
POTLESS_2 25:322ef9488e65 81 bool FLAG_AFF = true;
POTLESS_2 25:322ef9488e65 82
POTLESS_2 40:32d89e04ead1 83 //Flag pour envoyer à l'app windev...
POTLESS_2 40:32d89e04ead1 84 bool FLAG_WINDEV = false;
POTLESS_2 40:32d89e04ead1 85
POTLESS_2 29:5b822d18bce6 86 //Flag pour interrompre l'enregistrement si on veut...
POTLESS_2 29:5b822d18bce6 87 bool FLAG_REC = true;
POTLESS_2 29:5b822d18bce6 88
POTLESS_2 33:f5d4bae05f16 89 //Flag pour interrompre les demandes O2 en cours ed calibration...
POTLESS_2 33:f5d4bae05f16 90 bool FLAG_O2 = true;
POTLESS_2 33:f5d4bae05f16 91
POTLESS_2 7:ad15c386e960 92 //Variables de stockage des infos capteurs
POTLESS_2 7:ad15c386e960 93 int co2 = 0;
POTLESS_2 7:ad15c386e960 94 float pression = 0;
POTLESS_2 9:04bfdfc029cb 95 float Temp1 = 0;
POTLESS_2 7:ad15c386e960 96 int ppO2 = 0;
POTLESS_2 7:ad15c386e960 97 int CellO2_1 = 0;
POTLESS_2 7:ad15c386e960 98 int CellO2_2 = 0;
POTLESS_2 36:1f5e2247b073 99
POTLESS_2 18:bfd78c05b589 100 //Variables et constantes OTU
POTLESS_2 18:bfd78c05b589 101 float OTU = 0;
POTLESS_2 18:bfd78c05b589 102 float COEF_OTU = 0.83;
POTLESS_2 18:bfd78c05b589 103
POTLESS_2 17:bef8abc445f2 104 //Mesure du temps d'éxecution du loop
POTLESS_2 7:ad15c386e960 105 Timer REAL_RATE;
POTLESS_2 7:ad15c386e960 106 float RATE = 0;
POTLESS_2 11:b2feed92584a 107 float RATE_TRUE = 0;
POTLESS_2 29:5b822d18bce6 108 float Ref_Time = 2.0; //La durée de la boucle désirée...
POTLESS_2 7:ad15c386e960 109
POTLESS_2 17:bef8abc445f2 110 //HTU21D sur l'I2C
POTLESS_2 8:a750d531b381 111 HTU21D temphumid(PB_9, PB_8); //Temp humid sensor || SDA, SCL
POTLESS_2 9:04bfdfc029cb 112 float Temp2;
POTLESS_2 9:04bfdfc029cb 113 int Humid;
POTLESS_2 9:04bfdfc029cb 114
POTLESS_2 9:04bfdfc029cb 115 //Data LOG
POTLESS_2 9:04bfdfc029cb 116 char to_store[50];
POTLESS_2 9:04bfdfc029cb 117 time_t seconds;
POTLESS_2 25:322ef9488e65 118 char Log_File_Name[] = " ";
POTLESS_2 8:a750d531b381 119
POTLESS_2 10:aca745a66d51 120 //Contrôle des servos
POTLESS_2 19:cac3761a5d0b 121 float Consigne_poumon = 0;
POTLESS_2 19:cac3761a5d0b 122 float volet_poumon_Position = 0;
POTLESS_2 19:cac3761a5d0b 123 float Consigne_fuite = 0;
POTLESS_2 19:cac3761a5d0b 124 float volet_fuite_Position = 0;
POTLESS_2 25:322ef9488e65 125 float Volets_Speed = 0.1;
POTLESS_2 26:a2fe19341f92 126 float Volet_DeadBand = 5;
POTLESS_2 10:aca745a66d51 127
POTLESS_2 12:7f3aadd79f89 128 #ifdef PID_MODE
POTLESS_2 12:7f3aadd79f89 129 //Paramètre du PID
POTLESS_2 12:7f3aadd79f89 130 float Kc = 40;
POTLESS_2 12:7f3aadd79f89 131 float Ti = 0;
POTLESS_2 12:7f3aadd79f89 132 float Td = 0;
POTLESS_2 12:7f3aadd79f89 133 float RATE_PID = Ref_Time;
POTLESS_2 12:7f3aadd79f89 134 float Commande_PID;
POTLESS_2 15:efd3b3bf3f37 135 float consigne = 210;
POTLESS_2 15:efd3b3bf3f37 136 float Max_Input = 1000;
POTLESS_2 15:efd3b3bf3f37 137 float Min_Input = 80;
POTLESS_2 19:cac3761a5d0b 138 float Max_Output = 85;//Vérifier la valeur pour angle à laisser ouvert...
POTLESS_2 19:cac3761a5d0b 139 float Min_Output = 5;
POTLESS_2 10:aca745a66d51 140
POTLESS_2 12:7f3aadd79f89 141 //Init PID
POTLESS_2 17:bef8abc445f2 142 PID control_Servo(Kc, Ti, Td, RATE_PID);
POTLESS_2 12:7f3aadd79f89 143 #endif
POTLESS_2 10:aca745a66d51 144
POTLESS_2 19:cac3761a5d0b 145 //Boolean du status de l'appareil, en mode SECU ou nominal
POTLESS_2 19:cac3761a5d0b 146 bool EN_MODE_SECU = false;
POTLESS_2 31:231a96d1d1c8 147
POTLESS_2 31:231a96d1d1c8 148 //Test des alim
POTLESS_2 39:65ff3c4f9675 149 //DigitalIn V_USB(PA_0, PullUp);
POTLESS_2 39:65ff3c4f9675 150
POTLESS_2 31:231a96d1d1c8 151 DigitalIn V_PILES_2(PC_3);
POTLESS_2 31:231a96d1d1c8 152 AnalogIn V_PILES(PA_1);
POTLESS_2 31:231a96d1d1c8 153
POTLESS_2 31:231a96d1d1c8 154 int Vusb = 1;
POTLESS_2 31:231a96d1d1c8 155 int VPiles = 1;
POTLESS_2 31:231a96d1d1c8 156 float VPiles_2 = 1;
POTLESS_2 18:bfd78c05b589 157
POTLESS_2 21:b8900130ca05 158 //Interruption user button
POTLESS_2 21:b8900130ca05 159 InterruptIn button(USER_BUTTON);
potless 38:fe77b68eec37 160 InterruptIn vpile_off_on(PA_0); // TODO mettre un define sur PA_0
POTLESS_2 23:7477dc855fad 161 volatile int GO = 0;
POTLESS_2 21:b8900130ca05 162
POTLESS_2 29:5b822d18bce6 163 void Affichage()
POTLESS_2 29:5b822d18bce6 164 {
POTLESS_2 41:51ba69648f9d 165 NVIC_DisableIRQ(USART2_IRQn);
POTLESS_2 29:5b822d18bce6 166 serialMonit.printf("\r\n");
POTLESS_2 29:5b822d18bce6 167 serialMonit.printf(" CO2 = %d ppm\r\n" , co2);
POTLESS_2 29:5b822d18bce6 168 serialMonit.printf(" PPO2 = %d mb\r\n", ppO2);
POTLESS_2 31:231a96d1d1c8 169 serialMonit.printf(" OTU = %d \r\n", (int)OTU);
POTLESS_2 29:5b822d18bce6 170 serialMonit.printf(" Pression = %f msw\r\n", pression);
POTLESS_2 29:5b822d18bce6 171 serialMonit.printf(" Temp MS5837 = %f C\r\n", Temp1);
POTLESS_2 29:5b822d18bce6 172 serialMonit.printf(" Temp HTU21D = %f C\n\r", Temp2);
POTLESS_2 29:5b822d18bce6 173 serialMonit.printf(" Humidity = %d %%\n\r", Humid);
POTLESS_2 29:5b822d18bce6 174 serialMonit.printf("\n\r");
POTLESS_2 29:5b822d18bce6 175 serialMonit.printf(" Cell O2 n 1 = %d\r\n" , CellO2_1);
POTLESS_2 29:5b822d18bce6 176 serialMonit.printf(" Cell O2 n 2 = %d\r\n" , CellO2_2);
POTLESS_2 29:5b822d18bce6 177 serialMonit.printf("\r\n");
POTLESS_2 29:5b822d18bce6 178 serialMonit.printf(" Volet Poumon = %f\r\n" , volet_poumon_Position);
POTLESS_2 29:5b822d18bce6 179 serialMonit.printf(" Volet Fuite = %f\r\n" , volet_fuite_Position);
POTLESS_2 29:5b822d18bce6 180 serialMonit.printf("\r\n");
POTLESS_2 29:5b822d18bce6 181 serialMonit.printf(" Temps d execution de la boucle = %f seconde(s)\n", (RATE + RATE_TRUE / 1000));
POTLESS_2 29:5b822d18bce6 182 serialMonit.printf("\r\n");
POTLESS_2 30:7a16a66d76f3 183 if (FLAG_REC) serialMonit.printf(" Chaine enregistrée = %s\n", to_store);
POTLESS_2 30:7a16a66d76f3 184 else serialMonit.printf(" Pas d'enregistrement en cours.");
POTLESS_2 29:5b822d18bce6 185 serialMonit.printf("\r\n");
POTLESS_2 29:5b822d18bce6 186 serialMonit.printf(" V_USB = %f", Vusb);
POTLESS_2 29:5b822d18bce6 187 serialMonit.printf("\r\n\r\n");
POTLESS_2 29:5b822d18bce6 188 fflush(stdout);
POTLESS_2 41:51ba69648f9d 189 NVIC_EnableIRQ(USART2_IRQn);
POTLESS_2 29:5b822d18bce6 190 }
POTLESS_2 29:5b822d18bce6 191
POTLESS_2 34:26f6e3dbefb9 192 void pressed()
POTLESS_2 34:26f6e3dbefb9 193 {
POTLESS_2 34:26f6e3dbefb9 194 GO = GO + 1;
POTLESS_2 34:26f6e3dbefb9 195 if (GO > 1) NVIC_SystemReset();
POTLESS_2 21:b8900130ca05 196 }
POTLESS_2 21:b8900130ca05 197
POTLESS_2 39:65ff3c4f9675 198 //Pas nécessaire
POTLESS_2 39:65ff3c4f9675 199 /*
potless 38:fe77b68eec37 200 void retour_alim()
potless 38:fe77b68eec37 201 {
potless 38:fe77b68eec37 202 DEBUG("-------------- interruption retour alim en cours ---------------\r\n");
potless 38:fe77b68eec37 203 NVIC_SystemReset();
potless 38:fe77b68eec37 204 }
POTLESS_2 39:65ff3c4f9675 205 */
POTLESS_2 39:65ff3c4f9675 206
potless 38:fe77b68eec37 207
POTLESS_2 19:cac3761a5d0b 208 //Passage en mode SECU
POTLESS_2 19:cac3761a5d0b 209 void Mode_SECU()
POTLESS_2 18:bfd78c05b589 210 {
POTLESS_2 19:cac3761a5d0b 211 #ifdef PID_MODE
POTLESS_2 18:bfd78c05b589 212 //Mise du PID en mode manuel (desactivation...)
POTLESS_2 18:bfd78c05b589 213 control_Servo.setMode(MANUAL_MODE);
POTLESS_2 18:bfd78c05b589 214 #endif
POTLESS_2 19:cac3761a5d0b 215 Consigne_poumon = HOME_SERVO_POUMON;
POTLESS_2 19:cac3761a5d0b 216 Consigne_fuite = HOME_SERVO_FUITE;
POTLESS_2 34:26f6e3dbefb9 217
POTLESS_2 25:322ef9488e65 218 Volets_Speed = 0.1;
POTLESS_2 25:322ef9488e65 219 Volet_DeadBand = 10;
POTLESS_2 25:322ef9488e65 220
POTLESS_2 19:cac3761a5d0b 221 while(1) {
POTLESS_2 25:322ef9488e65 222 wait_ms(100);
POTLESS_2 19:cac3761a5d0b 223 if (Servo_Poumon.Pos_OK() == true) break;
POTLESS_2 19:cac3761a5d0b 224 //if (Servo_Poumon.Pos_OK() == true && Servo_Fuite.Pos_OK() == true) break;
POTLESS_2 19:cac3761a5d0b 225 }
POTLESS_2 33:f5d4bae05f16 226 DEBUG("-------------- Appareil en mode SECU ---------------\r\n");
POTLESS_2 34:26f6e3dbefb9 227
POTLESS_2 25:322ef9488e65 228 wait_ms(100);
POTLESS_2 34:26f6e3dbefb9 229
POTLESS_2 19:cac3761a5d0b 230 EN_MODE_SECU = true;
POTLESS_2 25:322ef9488e65 231 wait_ms(100);
POTLESS_2 19:cac3761a5d0b 232 int Pos = Servo_Poumon.getPulses();
POTLESS_2 19:cac3761a5d0b 233 UTILS::Store_A_Val((float)Pos, "Servo_Poumon");
POTLESS_2 33:f5d4bae05f16 234 DEBUG(" position volet poumon sauvegardée = %d pulse(s)\r\n", Pos);
POTLESS_2 19:cac3761a5d0b 235 //Pos = Servo_Fuite.getPulses();
POTLESS_2 19:cac3761a5d0b 236 //UTILS::Store_A_Val((float)Pos, "Servo_Fuite");
POTLESS_2 33:f5d4bae05f16 237 //DEBUG(" position volet fuite sauvegardée = %d pulse(s)\r\n", Pos);
POTLESS_2 23:7477dc855fad 238 Servo_Poumon.Sleep();
POTLESS_2 19:cac3761a5d0b 239 }
POTLESS_2 19:cac3761a5d0b 240
POTLESS_2 19:cac3761a5d0b 241 //Sequence d'arrêt
POTLESS_2 19:cac3761a5d0b 242 void Stop_Sequence()
POTLESS_2 34:26f6e3dbefb9 243 {
POTLESS_2 34:26f6e3dbefb9 244 Mode_SECU();
POTLESS_2 39:65ff3c4f9675 245 //ejection de la flash pour pas crasher le system de fichiers
POTLESS_2 39:65ff3c4f9675 246 UTILS::UnMount_Flash();
POTLESS_2 40:32d89e04ead1 247
POTLESS_2 33:f5d4bae05f16 248 DEBUG("----------------ARRET DE L'APPAREIL--------------------\r\n");
POTLESS_2 40:32d89e04ead1 249
potless 37:f9461c6592f2 250 // préparation deepsleep
POTLESS_2 40:32d89e04ead1 251
potless 37:f9461c6592f2 252 /*
potless 37:f9461c6592f2 253 //première méthode mais je ne sais pas ce que ça consomme et il faut normalement reduire le frequence d'horloge avant
potless 37:f9461c6592f2 254 //il est possible que ça génère un plantage et la rtc ne fonctionnera pas?
potless 37:f9461c6592f2 255 HAL_PWREx_EnableLowPowerRunMode();
potless 37:f9461c6592f2 256 DEBUG("----------------LOW POWER RUN MODE--------------------\r\n");
POTLESS_2 40:32d89e04ead1 257
potless 37:f9461c6592f2 258 bool isDSallowed;
potless 37:f9461c6592f2 259 isDSallowed = sleep_manager_can_deep_sleep();
potless 37:f9461c6592f2 260 DEBUG(" Deep sleep autorisé ? %i\r\n", isDSallowed);
potless 37:f9461c6592f2 261 wait(1.0);
POTLESS_2 34:26f6e3dbefb9 262
potless 37:f9461c6592f2 263 DEBUG("\n\r Deepsleep tentative normale !(bouton bleu pour ressortir)\n");
potless 37:f9461c6592f2 264 wait(0.1);
POTLESS_2 40:32d89e04ead1 265
potless 37:f9461c6592f2 266 sleep_manager_sleep_auto(); // ne marche pas, je ne sais pas pk
potless 37:f9461c6592f2 267 */
POTLESS_2 40:32d89e04ead1 268
POTLESS_2 40:32d89e04ead1 269
potless 37:f9461c6592f2 270 DEBUG("\n\r Deepsleep méthode offensive !\n");
POTLESS_2 40:32d89e04ead1 271
POTLESS_2 39:65ff3c4f9675 272 /*
potless 38:fe77b68eec37 273 HAL_PWR_DisableWakeUpPin(PWR_WAKEUP_PIN2); // pour PC_13
POTLESS_2 40:32d89e04ead1 274 // Clear wake up Flag
POTLESS_2 40:32d89e04ead1 275 __HAL_PWR_CLEAR_FLAG(PWR_FLAG_WUF2);
POTLESS_2 40:32d89e04ead1 276 // Enable wakeup pin WKUP2
potless 38:fe77b68eec37 277 HAL_PWR_EnableWakeUpPin(PWR_WAKEUP_PIN2_LOW); // low parce qu'on veut que ça redémarre avec le user button TODO à passer sur High pour que ça redémarrage avec l'arrivée du hus sur l'USB
POTLESS_2 39:65ff3c4f9675 278 */
POTLESS_2 40:32d89e04ead1 279
potless 38:fe77b68eec37 280 HAL_PWR_DisableWakeUpPin(PWR_WAKEUP_PIN1); // pour PA_0
POTLESS_2 40:32d89e04ead1 281 // Clear wake up Flag
POTLESS_2 40:32d89e04ead1 282 __HAL_PWR_CLEAR_FLAG(PWR_FLAG_WUF1);
POTLESS_2 40:32d89e04ead1 283 // Enable wakeup pin WKUP2
POTLESS_2 39:65ff3c4f9675 284 HAL_PWR_EnableWakeUpPin(PWR_WAKEUP_PIN1); // high est la valeur par défaut
POTLESS_2 40:32d89e04ead1 285
POTLESS_2 40:32d89e04ead1 286 // Set RTC back-up register RTC_BKP31R to indicate
POTLESS_2 40:32d89e04ead1 287 //later on that system has entered shutdown mode
potless 37:f9461c6592f2 288 WRITE_REG( RTC->BKP31R, 0x1 );
POTLESS_2 40:32d89e04ead1 289 //Enter shutdown mode
potless 37:f9461c6592f2 290 DEBUG("\n\r Attention c'est du brutal ! bouton bleu pour ressort.... ZZZZZZZ ZZZZZ !!!\n");
POTLESS_2 40:32d89e04ead1 291
potless 37:f9461c6592f2 292 HAL_PWREx_EnterSHUTDOWNMode();
POTLESS_2 18:bfd78c05b589 293 }
POTLESS_2 18:bfd78c05b589 294
POTLESS_2 31:231a96d1d1c8 295 //Fonction test de valeur d'entrée digitale
POTLESS_2 29:5b822d18bce6 296 int Power_Test(DigitalIn& pin)
POTLESS_2 20:5f79fb4565a7 297 {
POTLESS_2 29:5b822d18bce6 298 pin.mode(PullDown);
POTLESS_2 34:26f6e3dbefb9 299
POTLESS_2 34:26f6e3dbefb9 300 if(!pin) {
POTLESS_2 34:26f6e3dbefb9 301 Stop_Sequence();
POTLESS_2 34:26f6e3dbefb9 302 return 0;
POTLESS_2 34:26f6e3dbefb9 303 } else {
POTLESS_2 34:26f6e3dbefb9 304 return 1;
POTLESS_2 34:26f6e3dbefb9 305 }
POTLESS_2 20:5f79fb4565a7 306 }
POTLESS_2 20:5f79fb4565a7 307
POTLESS_2 31:231a96d1d1c8 308 //Fonction test de valeur d'entrée analogique
POTLESS_2 31:231a96d1d1c8 309 float Power_Test(AnalogIn& pin)
POTLESS_2 31:231a96d1d1c8 310 {
POTLESS_2 31:231a96d1d1c8 311 float Val = pin.read();
POTLESS_2 31:231a96d1d1c8 312 return Val;
POTLESS_2 31:231a96d1d1c8 313 }
POTLESS_2 31:231a96d1d1c8 314
POTLESS_2 18:bfd78c05b589 315 //Contrôle du status de l'appareil / des constantes
POTLESS_2 18:bfd78c05b589 316 bool Check()
POTLESS_2 18:bfd78c05b589 317 {
POTLESS_2 18:bfd78c05b589 318 if (ppO2 > 100)
POTLESS_2 19:cac3761a5d0b 319 return true;//Situation OK
POTLESS_2 18:bfd78c05b589 320 else
POTLESS_2 19:cac3761a5d0b 321 return false;//Situation dégradée
POTLESS_2 18:bfd78c05b589 322 }
POTLESS_2 18:bfd78c05b589 323
POTLESS_2 18:bfd78c05b589 324 //Calcul des OTU
POTLESS_2 18:bfd78c05b589 325 float Calcul_OTU()
POTLESS_2 18:bfd78c05b589 326 {
POTLESS_2 18:bfd78c05b589 327 /*
POTLESS_2 18:bfd78c05b589 328 La formule suivante permet de calculer la quantité d' OTU accumulée
POTLESS_2 18:bfd78c05b589 329 OTU = T * (2* PpO2 -1)0,83
POTLESS_2 18:bfd78c05b589 330 avec :
POTLESS_2 18:bfd78c05b589 331 T = temps de plongée en minutes
POTLESS_2 18:bfd78c05b589 332 PpO2 = pression partielle d’ oxygène en bars
POTLESS_2 18:bfd78c05b589 333 */
POTLESS_2 18:bfd78c05b589 334
POTLESS_2 19:cac3761a5d0b 335 if (ppO2 > 500) {
POTLESS_2 18:bfd78c05b589 336 float val = (2 * (float)ppO2/1000 - 1);//je divise par 1000 car la PP est en mb...
POTLESS_2 18:bfd78c05b589 337 OTU += Ref_Time * pow(val, COEF_OTU);
POTLESS_2 19:cac3761a5d0b 338 }
POTLESS_2 18:bfd78c05b589 339 }
POTLESS_2 10:aca745a66d51 340
POTLESS_2 17:bef8abc445f2 341 //Thread d'intérogation des capteurs, positions servo
POTLESS_2 34:26f6e3dbefb9 342 void SENSORS_thread()
POTLESS_2 6:ebed9093d661 343 {
POTLESS_2 7:ad15c386e960 344 while (true) {
POTLESS_2 36:1f5e2247b073 345 //DEEP_DEBUG(" SENSORS_thread\r\n");
POTLESS_2 7:ad15c386e960 346
POTLESS_2 7:ad15c386e960 347 //CO2 sur Cozir
POTLESS_2 7:ad15c386e960 348 co2 = sensors.requestCO2();
POTLESS_2 7:ad15c386e960 349 //P / T sur MS5837
POTLESS_2 7:ad15c386e960 350 pression = sensors.requestPress();
POTLESS_2 9:04bfdfc029cb 351 Temp1 = sensors.requestTemp();
POTLESS_2 7:ad15c386e960 352 //PPO2 sur ADS1015
POTLESS_2 33:f5d4bae05f16 353 if (FLAG_O2) ppO2 = sensors.requestPpO2();
POTLESS_2 7:ad15c386e960 354 //Cell O2 en mV
POTLESS_2 33:f5d4bae05f16 355 if (FLAG_O2) CellO2_1 = sensors.requestCellO2_1();
POTLESS_2 33:f5d4bae05f16 356 if (FLAG_O2) CellO2_2 = sensors.requestCellO2_2();
POTLESS_2 9:04bfdfc029cb 357
POTLESS_2 8:a750d531b381 358 //HTU21D
POTLESS_2 9:04bfdfc029cb 359 Temp2 = temphumid.sample_ctemp();
POTLESS_2 9:04bfdfc029cb 360 Humid = temphumid.sample_humid();
POTLESS_2 9:04bfdfc029cb 361
POTLESS_2 10:aca745a66d51 362 //Retour position des servos
POTLESS_2 17:bef8abc445f2 363 volet_poumon_Position = Servo_Poumon.Get_Position();
POTLESS_2 20:5f79fb4565a7 364 //volet_fuite_Position = Servo_Fuite.Get_Position();
POTLESS_2 34:26f6e3dbefb9 365
POTLESS_2 19:cac3761a5d0b 366 }
POTLESS_2 19:cac3761a5d0b 367 }
POTLESS_2 12:7f3aadd79f89 368
POTLESS_2 19:cac3761a5d0b 369 void GO_TO_thread()
POTLESS_2 19:cac3761a5d0b 370 {
POTLESS_2 19:cac3761a5d0b 371 while (true) {
POTLESS_2 36:1f5e2247b073 372 //DEEP_DEBUG(" GO_TO_Thread\r\n");
POTLESS_2 34:26f6e3dbefb9 373
POTLESS_2 19:cac3761a5d0b 374 //Servo_Poumon.Go_To_Prop(Consigne_poumon);
POTLESS_2 26:a2fe19341f92 375 //Servo_Poumon.Go_To_PID(Consigne_poumon, Volet_DeadBand);
POTLESS_2 34:26f6e3dbefb9 376 Servo_Poumon.Go_To(Consigne_poumon, Volets_Speed, Volet_DeadBand);
POTLESS_2 34:26f6e3dbefb9 377
POTLESS_2 19:cac3761a5d0b 378 //Servo_Fuite.Go_To_Prop(Consigne_fuite);
POTLESS_2 19:cac3761a5d0b 379 //Servo_Fuite.Go_To_PID(Consigne_fuite);
POTLESS_2 29:5b822d18bce6 380 //Servo_Fuite.Go_To(Consigne_fuite, Volets_Speed, Volet_DeadBand );
POTLESS_2 15:efd3b3bf3f37 381 }
potless 2:4a8bf1d53439 382 }
POTLESS_2 4:d84250f67dec 383
POTLESS_2 20:5f79fb4565a7 384 void SECU_thread()
POTLESS_2 20:5f79fb4565a7 385 {
POTLESS_2 34:26f6e3dbefb9 386 while (true) {
POTLESS_2 36:1f5e2247b073 387 //DEEP_DEBUG(" SECU_Thread\r\n");
POTLESS_2 34:26f6e3dbefb9 388
POTLESS_2 20:5f79fb4565a7 389 //Alim USB
POTLESS_2 33:f5d4bae05f16 390 //Vusb = Power_Test(V_USB);
POTLESS_2 33:f5d4bae05f16 391 //VPiles = Power_Test(V_PILES);
POTLESS_2 20:5f79fb4565a7 392 //Divers problèmes à implémenter
POTLESS_2 20:5f79fb4565a7 393 //if(!Check()) Mode_SECU();
POTLESS_2 20:5f79fb4565a7 394 }
POTLESS_2 20:5f79fb4565a7 395 }
POTLESS_2 20:5f79fb4565a7 396
POTLESS_2 11:b2feed92584a 397 //Callback de l'intérruption des envois de commandes depuis le terminal
POTLESS_2 6:ebed9093d661 398 void callbackParam()
POTLESS_2 34:26f6e3dbefb9 399 {
POTLESS_2 40:32d89e04ead1 400
POTLESS_2 40:32d89e04ead1 401
POTLESS_2 34:26f6e3dbefb9 402 while(serialMonit.readable()) {
POTLESS_2 40:32d89e04ead1 403 if ((indexParam == sizeParam) || newParamFlag == true) { //éviter la saturation du buffer
POTLESS_2 41:51ba69648f9d 404 NVIC_DisableIRQ(USART2_IRQn);
POTLESS_2 29:5b822d18bce6 405 char char_flush = serialMonit.getc();
POTLESS_2 41:51ba69648f9d 406 NVIC_EnableIRQ(USART2_IRQn);
POTLESS_2 40:32d89e04ead1 407 } else {
POTLESS_2 41:51ba69648f9d 408 NVIC_DisableIRQ(USART2_IRQn);
POTLESS_2 29:5b822d18bce6 409 param [indexParam ++] = serialMonit.getc();//chargement du buffer dans le message
POTLESS_2 40:32d89e04ead1 410 if ((indexParam == sizeParam) || (param[indexParam - 1] == '\n')) {//le message est complet ou nouvelle ligne ou autre si on veut...
POTLESS_2 40:32d89e04ead1 411 param[indexParam] = 0;
POTLESS_2 40:32d89e04ead1 412 newParamFlag = true;
POTLESS_2 40:32d89e04ead1 413 }
POTLESS_2 41:51ba69648f9d 414 NVIC_EnableIRQ(USART2_IRQn);
POTLESS_2 34:26f6e3dbefb9 415 }
POTLESS_2 34:26f6e3dbefb9 416 }
POTLESS_2 6:ebed9093d661 417 }
POTLESS_2 4:d84250f67dec 418
POTLESS_2 9:04bfdfc029cb 419 //Callback de l'intérruption des envois de commandes depuis Android
POTLESS_2 9:04bfdfc029cb 420 void callbackAndroid()
POTLESS_2 9:04bfdfc029cb 421 {
POTLESS_2 9:04bfdfc029cb 422 while(android.readable()) {
POTLESS_2 9:04bfdfc029cb 423 if (indexAndroid == sizeAndroid) //éviter la saturation du buffer
POTLESS_2 9:04bfdfc029cb 424 android.getc();
POTLESS_2 9:04bfdfc029cb 425 else
POTLESS_2 9:04bfdfc029cb 426 Android [indexAndroid++] = android.getc();//chargement du buffer dans le message
POTLESS_2 9:04bfdfc029cb 427 if ((indexAndroid == sizeAndroid) || (Android[indexAndroid -1] == '\n')) {//le message est complet ou nouvelle ligne ou autre si on veut...
POTLESS_2 9:04bfdfc029cb 428 Android[indexAndroid] = 0;
POTLESS_2 9:04bfdfc029cb 429 newAndroidFlag = true;
POTLESS_2 9:04bfdfc029cb 430 }
POTLESS_2 9:04bfdfc029cb 431 }
POTLESS_2 9:04bfdfc029cb 432 }
POTLESS_2 11:b2feed92584a 433
POTLESS_2 9:04bfdfc029cb 434 void Decoding_Message(char message [])
POTLESS_2 9:04bfdfc029cb 435 {
POTLESS_2 9:04bfdfc029cb 436
POTLESS_2 29:5b822d18bce6 437 char com[sizeParam] = "";
POTLESS_2 34:26f6e3dbefb9 438 char numb[] = "";
POTLESS_2 36:1f5e2247b073 439
POTLESS_2 34:26f6e3dbefb9 440 sscanf(message,"%s %s",&com , &numb);
POTLESS_2 36:1f5e2247b073 441
POTLESS_2 35:a209a192f431 442 DEEP_DEBUG("\r\n Commande = %s Valeur = %s \r\n\r\n", com, numb);
POTLESS_2 36:1f5e2247b073 443
POTLESS_2 30:7a16a66d76f3 444 if (0 == strcmp(com, "secu")) {
POTLESS_2 19:cac3761a5d0b 445 Mode_SECU();
POTLESS_2 34:26f6e3dbefb9 446 } else if (0 == strcmp(com, "ARNSRS_ID")) {
POTLESS_2 34:26f6e3dbefb9 447 UTILS::Store_A_Val(atoi(numb), "ARNSRS_ID");
POTLESS_2 40:32d89e04ead1 448 } else if (0 == strcmp(com, "monit")) {
POTLESS_2 40:32d89e04ead1 449 FLAG_AFF = false;
POTLESS_2 40:32d89e04ead1 450 FLAG_WINDEV = true;
POTLESS_2 40:32d89e04ead1 451 } else if (0 == strcmp(com, "debug")) {
POTLESS_2 40:32d89e04ead1 452 FLAG_AFF = true;
POTLESS_2 40:32d89e04ead1 453 FLAG_WINDEV = false;
POTLESS_2 34:26f6e3dbefb9 454 } else if (0 == strcmp(com, "Head_ID")) {
POTLESS_2 34:26f6e3dbefb9 455 //On l'enregistre dans l'eeprom
POTLESS_2 34:26f6e3dbefb9 456 UTILS::write_EEPROM(numb, HEAD_ID);
POTLESS_2 34:26f6e3dbefb9 457 } else if (0 == strcmp(com, "O2_1_ID")) {
POTLESS_2 34:26f6e3dbefb9 458 //On l'enregistre dans l'eeprom
POTLESS_2 34:26f6e3dbefb9 459 UTILS::write_EEPROM(numb, CELL_O2_1_ID);
POTLESS_2 34:26f6e3dbefb9 460 } else if (0 == strcmp(com, "O2_2_ID")) {
POTLESS_2 34:26f6e3dbefb9 461 //On l'enregistre dans l'eeprom
POTLESS_2 34:26f6e3dbefb9 462 UTILS::write_EEPROM(numb, CELL_O2_2_ID);
POTLESS_2 34:26f6e3dbefb9 463 } else if (0 == strcmp(com, "CO2_ID")) {
POTLESS_2 34:26f6e3dbefb9 464 //On l'enregistre dans l'eeprom
POTLESS_2 34:26f6e3dbefb9 465 UTILS::write_EEPROM(numb, CO2_ID);
POTLESS_2 34:26f6e3dbefb9 466 } else if (0 == strcmp(com, "calib_O2")) {
POTLESS_2 33:f5d4bae05f16 467 FLAG_O2 = false;
POTLESS_2 33:f5d4bae05f16 468 wait_ms(100);
POTLESS_2 41:51ba69648f9d 469 sensors.Calibrate_O2(atoi(numb));
POTLESS_2 33:f5d4bae05f16 470 wait_ms(100);
POTLESS_2 33:f5d4bae05f16 471 FLAG_O2 = true;
POTLESS_2 41:51ba69648f9d 472 } else if (0 == strcmp(com, "calib_CO2_A")) {
POTLESS_2 41:51ba69648f9d 473 sensors.Calibrate_CO2("G\r\n");
POTLESS_2 34:26f6e3dbefb9 474 } else if (0 == strcmp(com, "flash_i")) {
POTLESS_2 31:231a96d1d1c8 475 FLAG_REC = false;
POTLESS_2 31:231a96d1d1c8 476 UTILS::Flash_Infos();
POTLESS_2 34:26f6e3dbefb9 477 FLAG_REC = true;
POTLESS_2 36:1f5e2247b073 478 } else if (0 == strcmp(com, "flash_u")) {
POTLESS_2 36:1f5e2247b073 479 FLAG_REC = false;
POTLESS_2 36:1f5e2247b073 480 UTILS::UnMount_Flash();
POTLESS_2 36:1f5e2247b073 481 } else if (0 == strcmp(com, "flash_m")) {
POTLESS_2 40:32d89e04ead1 482 UTILS::Mount_Flash();
POTLESS_2 35:a209a192f431 483 } else if (0 == strcmp(com, "check_F")) {
POTLESS_2 30:7a16a66d76f3 484 FLAG_REC = false;
POTLESS_2 35:a209a192f431 485 serialMonit.printf(" ARNSRS_ID.txt = %d\r\n", (int)UTILS::Read_A_Val("ARNSRS_ID"));
POTLESS_2 35:a209a192f431 486 //serialMonit.printf(" Calibration_O2.txt = %f\r\n", UTILS::Read_A_Val("Calibration_O2"));
POTLESS_2 34:26f6e3dbefb9 487 serialMonit.printf(" Servo_Poumon.txt = %d\r\n", (int)UTILS::Read_A_Val("Servo_Poumon"));
POTLESS_2 34:26f6e3dbefb9 488 //serialMonit.printf("Servo_Fuite.txt = %d\r\n", (int)UTILS::Read_A_Val("Servo_Fuite");
POTLESS_2 30:7a16a66d76f3 489 FLAG_REC = true;
POTLESS_2 35:a209a192f431 490 } else if (0 == strcmp(com, "check_E")) {
POTLESS_2 35:a209a192f431 491 sensors.Sensor_head_check();
POTLESS_2 34:26f6e3dbefb9 492 } else if (0 == strcmp(com, "rec")) {
POTLESS_2 34:26f6e3dbefb9 493 if (FLAG_REC) {
POTLESS_2 34:26f6e3dbefb9 494 FLAG_REC = false;
POTLESS_2 34:26f6e3dbefb9 495 serialMonit.printf("Arrêt du Data Logging.");
POTLESS_2 34:26f6e3dbefb9 496 } else {
POTLESS_2 34:26f6e3dbefb9 497 FLAG_REC = true;
POTLESS_2 34:26f6e3dbefb9 498 serialMonit.printf("Démarrage Data Logging dans %s", Log_File_Name);
POTLESS_2 34:26f6e3dbefb9 499 }
POTLESS_2 34:26f6e3dbefb9 500 } else if (0 == strcmp(com, "help")) {
POTLESS_2 29:5b822d18bce6 501 FLAG_AFF = false;
POTLESS_2 34:26f6e3dbefb9 502 UTILS::Help();
POTLESS_2 34:26f6e3dbefb9 503 } else if (0 == strcmp(com, "start")) {
POTLESS_2 29:5b822d18bce6 504 FLAG_AFF = true;
POTLESS_2 34:26f6e3dbefb9 505 } else if (0 == strcmp(com, "stop")) {
POTLESS_2 29:5b822d18bce6 506 FLAG_AFF = false;
POTLESS_2 40:32d89e04ead1 507 //UTILS::Help();
POTLESS_2 36:1f5e2247b073 508 } else if (0 == strcmp(com, "flash_c")) {
POTLESS_2 29:5b822d18bce6 509 FLAG_REC = false;
POTLESS_2 29:5b822d18bce6 510 UTILS::Clean_Flash();
POTLESS_2 34:26f6e3dbefb9 511 } else if (0 == strcmp(com, "dir")) {
POTLESS_2 29:5b822d18bce6 512 FLAG_REC = false;
POTLESS_2 29:5b822d18bce6 513 UTILS::Dir_Flash();
POTLESS_2 29:5b822d18bce6 514 FLAG_REC = true;
POTLESS_2 34:26f6e3dbefb9 515 } else if (0 == strcmp(com, "get")) {
POTLESS_2 34:26f6e3dbefb9 516 FLAG_REC = false;
POTLESS_2 29:5b822d18bce6 517 wait_ms(100);
POTLESS_2 26:a2fe19341f92 518 char filename[20];
POTLESS_2 34:26f6e3dbefb9 519 sprintf(filename, "LOG_%d.txt", atoi(numb));
POTLESS_2 29:5b822d18bce6 520 UTILS::Read_Flash_File(filename);
POTLESS_2 29:5b822d18bce6 521 wait_ms(100);
POTLESS_2 29:5b822d18bce6 522 FLAG_REC = true;
POTLESS_2 34:26f6e3dbefb9 523 } else if (0 == strcmp(com, "del")) {
POTLESS_2 29:5b822d18bce6 524 FLAG_REC = false;
POTLESS_2 29:5b822d18bce6 525 char filename[20];
POTLESS_2 34:26f6e3dbefb9 526 sprintf(filename, "LOG_%d.txt", atoi(numb));
POTLESS_2 29:5b822d18bce6 527 UTILS::Delete_Flash_File(filename);
POTLESS_2 29:5b822d18bce6 528 UTILS::Dir_Flash();
POTLESS_2 31:231a96d1d1c8 529 FLAG_REC = true;
POTLESS_2 34:26f6e3dbefb9 530 } else if (0 == strcmp(com, "file_s")) {
POTLESS_2 31:231a96d1d1c8 531 FLAG_REC = false;
POTLESS_2 31:231a96d1d1c8 532 char filename[20];
POTLESS_2 34:26f6e3dbefb9 533 sprintf(filename, "LOG_%d.txt", atoi(numb));
POTLESS_2 31:231a96d1d1c8 534 UTILS::Get_File_Size(filename);
POTLESS_2 31:231a96d1d1c8 535 FLAG_REC = true;
POTLESS_2 29:5b822d18bce6 536 } else if (0 == strcmp(com, "calib_p")) {
POTLESS_2 20:5f79fb4565a7 537 Consigne_poumon = 0;
POTLESS_2 20:5f79fb4565a7 538 volet_poumon_Position = 0;
POTLESS_2 19:cac3761a5d0b 539 Servo_Poumon.reset();
POTLESS_2 29:5b822d18bce6 540 } else if (0 == strcmp(com, "calib_f")) {
POTLESS_2 29:5b822d18bce6 541 Consigne_fuite = 0;
POTLESS_2 29:5b822d18bce6 542 volet_fuite_Position = 0;
POTLESS_2 34:26f6e3dbefb9 543 //Servo_Fuite.reset();
POTLESS_2 29:5b822d18bce6 544 } else if (0 == strcmp(com, "sleep")) {
POTLESS_2 19:cac3761a5d0b 545 Stop_Sequence();
POTLESS_2 29:5b822d18bce6 546 } else if (0 == strcmp(com, "time")) {//Depuis terminal MAC taper : " date +%s "
POTLESS_2 34:26f6e3dbefb9 547 set_time(atoi(numb));
POTLESS_2 29:5b822d18bce6 548 } else if (0 == strcmp(com, "c_pou")) {
POTLESS_2 41:51ba69648f9d 549 Consigne_poumon += atof(numb);
POTLESS_2 33:f5d4bae05f16 550 DEBUG(" Servo Poumon = %f\r\n", Consigne_poumon);
POTLESS_2 29:5b822d18bce6 551 } else if (0 == strcmp(com, "c_fui")) {
POTLESS_2 41:51ba69648f9d 552 Consigne_fuite += atof(numb);
POTLESS_2 33:f5d4bae05f16 553 DEBUG(" Servo Fuite = %f\r\n", Consigne_fuite);
POTLESS_2 29:5b822d18bce6 554 } else if (0 == strcmp(com, "reset")) {
POTLESS_2 36:1f5e2247b073 555 UTILS::UnMount_Flash();
POTLESS_2 10:aca745a66d51 556 NVIC_SystemReset();
POTLESS_2 12:7f3aadd79f89 557 } else {
POTLESS_2 9:04bfdfc029cb 558 sensors.cozirSend(message);
POTLESS_2 9:04bfdfc029cb 559 }
POTLESS_2 34:26f6e3dbefb9 560
POTLESS_2 9:04bfdfc029cb 561 strcpy(param," ");
POTLESS_2 9:04bfdfc029cb 562 indexParam = 0;
POTLESS_2 9:04bfdfc029cb 563 newParamFlag = false;
POTLESS_2 9:04bfdfc029cb 564 }
POTLESS_2 9:04bfdfc029cb 565
POTLESS_2 9:04bfdfc029cb 566 void Decoding_Message_Android(char message [])
POTLESS_2 9:04bfdfc029cb 567 {
POTLESS_2 9:04bfdfc029cb 568 char *commande = 0;
POTLESS_2 14:b5e0e882205e 569 float valeur = 0;
POTLESS_2 9:04bfdfc029cb 570
POTLESS_2 14:b5e0e882205e 571 sscanf(message,"%s %f",&commande , &valeur);
POTLESS_2 9:04bfdfc029cb 572
POTLESS_2 9:04bfdfc029cb 573 if ((char)commande == 'T') {
POTLESS_2 9:04bfdfc029cb 574 set_time(valeur);
POTLESS_2 12:7f3aadd79f89 575 } else if ((char)commande == 'I') {
POTLESS_2 17:bef8abc445f2 576 Consigne_poumon = (float)valeur;
POTLESS_2 33:f5d4bae05f16 577 DEBUG(" Servo Poumon = %f\r\n", Consigne_poumon);
POTLESS_2 12:7f3aadd79f89 578 } else if ((char)commande == 'O') {
POTLESS_2 17:bef8abc445f2 579 Consigne_fuite = (float)valeur;
POTLESS_2 33:f5d4bae05f16 580 DEBUG(" Servo Fuite = %f\r\n", Consigne_fuite);
POTLESS_2 12:7f3aadd79f89 581 /////////////////////////////////////////
POTLESS_2 12:7f3aadd79f89 582 //Pour rajouter une commande
POTLESS_2 12:7f3aadd79f89 583 //} else if ((char)commande == 'X') {
POTLESS_2 12:7f3aadd79f89 584 // attribuer à une VARIABLE = valeur;
POTLESS_2 12:7f3aadd79f89 585 // ou une action, avec ou sans valeur
POTLESS_2 12:7f3aadd79f89 586 /////////////////////////////////////////
POTLESS_2 9:04bfdfc029cb 587 } else if ((char)commande == 'R') {
POTLESS_2 9:04bfdfc029cb 588 NVIC_SystemReset();
POTLESS_2 9:04bfdfc029cb 589 }
POTLESS_2 12:7f3aadd79f89 590 #ifdef PID_MODE
POTLESS_2 12:7f3aadd79f89 591 else if ((char)commande == 'p') {
POTLESS_2 12:7f3aadd79f89 592 Kc = (float)valeur;
POTLESS_2 16:917656586772 593 control_Servo.reset();
POTLESS_2 12:7f3aadd79f89 594 control_Servo.setTunings(Kc, Ti, Td);
POTLESS_2 33:f5d4bae05f16 595 DEBUG" UPDATE PID --> Kc = %f Ti = %f Td = %f\r\n\n", Kc, Ti, Td);
POTLESS_2 15:efd3b3bf3f37 596 } else if ((char)commande == 'i') {
POTLESS_2 12:7f3aadd79f89 597 Ti = (float)valeur;
POTLESS_2 16:917656586772 598 control_Servo.reset();
POTLESS_2 12:7f3aadd79f89 599 control_Servo.setTunings(Kc, Ti, Td);
POTLESS_2 33:f5d4bae05f16 600 DEBUG(" UPDATE PID --> Kc = %f Ti = %f Td = %f\r\n\n", Kc, Ti, Td);
POTLESS_2 15:efd3b3bf3f37 601 } else if ((char)commande == 'd') {
POTLESS_2 12:7f3aadd79f89 602 Td = (float)valeur;
POTLESS_2 16:917656586772 603 control_Servo.reset();
POTLESS_2 12:7f3aadd79f89 604 control_Servo.setTunings(Kc, Ti, Td);
POTLESS_2 33:f5d4bae05f16 605 DEBUG(" UPDATE PID --> Kc = %f Ti = %f Td = %f\r\n\n", Kc, Ti, Td);
POTLESS_2 15:efd3b3bf3f37 606 } else if ((char)commande == 'c') {
POTLESS_2 12:7f3aadd79f89 607 consigne = valeur;
POTLESS_2 15:efd3b3bf3f37 608 control_Servo.setSetPoint(consigne);
POTLESS_2 33:f5d4bae05f16 609 DEBUG(" UPDATE CONSIGNE PID --> Consigne = %d\r\n\n", consigne);
POTLESS_2 12:7f3aadd79f89 610 }
POTLESS_2 15:efd3b3bf3f37 611 #endif
POTLESS_2 18:bfd78c05b589 612
POTLESS_2 9:04bfdfc029cb 613 strcpy(Android," ");
POTLESS_2 9:04bfdfc029cb 614 indexAndroid = 0;
POTLESS_2 9:04bfdfc029cb 615 newAndroidFlag = false;
POTLESS_2 9:04bfdfc029cb 616 }
POTLESS_2 9:04bfdfc029cb 617
POTLESS_2 26:a2fe19341f92 618 void Create_File_Name_Date()
POTLESS_2 25:322ef9488e65 619 {
POTLESS_2 25:322ef9488e65 620 //Du nom du fichier Date / heure
POTLESS_2 25:322ef9488e65 621 seconds = time(NULL);
POTLESS_2 25:322ef9488e65 622 char Time[40];
POTLESS_2 25:322ef9488e65 623 strftime(Time, 40, "%a_%d_%m_%Y_%H%M", localtime(&seconds));
POTLESS_2 25:322ef9488e65 624 sprintf(Log_File_Name, "%s_LOG.txt", Time);
POTLESS_2 34:26f6e3dbefb9 625 DEBUG("Nouveau fichier LOG = %s \r\n", Log_File_Name);
POTLESS_2 34:26f6e3dbefb9 626 }
POTLESS_2 34:26f6e3dbefb9 627
POTLESS_2 26:a2fe19341f92 628 void Create_File_Name_Index()
POTLESS_2 26:a2fe19341f92 629 {
POTLESS_2 26:a2fe19341f92 630 //Du nom du fichier par Index
POTLESS_2 26:a2fe19341f92 631 sprintf(Log_File_Name, "LOG_%d.txt", UTILS::File_Index());
POTLESS_2 34:26f6e3dbefb9 632 DEBUG(" Nouveau fichier LOG = %s \r\n", Log_File_Name);
POTLESS_2 34:26f6e3dbefb9 633 }
POTLESS_2 34:26f6e3dbefb9 634
POTLESS_2 4:d84250f67dec 635 int main()
POTLESS_2 12:7f3aadd79f89 636 {
POTLESS_2 40:32d89e04ead1 637
POTLESS_2 40:32d89e04ead1 638 HAL_Init();
POTLESS_2 40:32d89e04ead1 639
POTLESS_2 39:65ff3c4f9675 640 //V_USB.mode(PullDown); // on force à zero tant que l'alim par les piles n'est pas en place
POTLESS_2 34:26f6e3dbefb9 641
POTLESS_2 34:26f6e3dbefb9 642 button.fall(&pressed);
POTLESS_2 39:65ff3c4f9675 643 //vpile_off_on.rise (&retour_alim);
POTLESS_2 40:32d89e04ead1 644
POTLESS_2 40:32d89e04ead1 645 __HAL_RCC_PWR_CLK_ENABLE();
potless 37:f9461c6592f2 646 HAL_PWR_EnableBkUpAccess();
POTLESS_2 40:32d89e04ead1 647
POTLESS_2 34:26f6e3dbefb9 648 int count = 0;
POTLESS_2 12:7f3aadd79f89 649
POTLESS_2 34:26f6e3dbefb9 650 while (1) {
POTLESS_2 12:7f3aadd79f89 651
POTLESS_2 35:a209a192f431 652 if (count == 0) serialMonit.printf("\r\n Appuyez sur le User Button pour commencer...\r\n\r\n");
POTLESS_2 34:26f6e3dbefb9 653
POTLESS_2 34:26f6e3dbefb9 654 count = 1;
POTLESS_2 26:a2fe19341f92 655
POTLESS_2 34:26f6e3dbefb9 656 if (GO == 1) {
POTLESS_2 34:26f6e3dbefb9 657
POTLESS_2 34:26f6e3dbefb9 658 wait(1);
POTLESS_2 34:26f6e3dbefb9 659
POTLESS_2 34:26f6e3dbefb9 660 serialMonit.attach(&callbackParam, Serial::RxIrq);
POTLESS_2 18:bfd78c05b589 661
POTLESS_2 34:26f6e3dbefb9 662 android.attach(&callbackAndroid, Serial::RxIrq);
POTLESS_2 18:bfd78c05b589 663
POTLESS_2 34:26f6e3dbefb9 664 //Ci-dessous commande pour formater une nouvelle carte
POTLESS_2 34:26f6e3dbefb9 665 //UTILS::Format_Flash();
POTLESS_2 18:bfd78c05b589 666
POTLESS_2 34:26f6e3dbefb9 667 //Montage Flash
POTLESS_2 34:26f6e3dbefb9 668 UTILS::Mount_Flash();
POTLESS_2 18:bfd78c05b589 669
POTLESS_2 34:26f6e3dbefb9 670 //Liste des fichiers sur la Flash
POTLESS_2 34:26f6e3dbefb9 671 UTILS::Dir_Flash();
POTLESS_2 18:bfd78c05b589 672
POTLESS_2 36:1f5e2247b073 673 //Vérification RTC, si on est le 01/01/70, c'est qu'il y a un problème
POTLESS_2 36:1f5e2247b073 674 seconds = time(NULL);
POTLESS_2 36:1f5e2247b073 675 char YEAR[10];
POTLESS_2 36:1f5e2247b073 676 strftime(YEAR, 10, "%D", localtime(&seconds));
POTLESS_2 36:1f5e2247b073 677 if (0 == strcmp(YEAR, "01/01/70")) serialMonit.printf(" Vous devez régler la RTC...\r\n");
POTLESS_2 40:32d89e04ead1 678
POTLESS_2 34:26f6e3dbefb9 679 if (UTILS::File_Exist("ARNSRS_ID") == false) {
POTLESS_2 34:26f6e3dbefb9 680 UTILS::Store_A_Val(000, "ARNSRS_ID");
POTLESS_2 36:1f5e2247b073 681 DEBUG("ARNSRS ID forcée à 000\r\n");
POTLESS_2 34:26f6e3dbefb9 682 }
POTLESS_2 6:ebed9093d661 683
POTLESS_2 36:1f5e2247b073 684 bool calib_O2 = true;
POTLESS_2 36:1f5e2247b073 685 bool calib_CO2 = true;
POTLESS_2 15:efd3b3bf3f37 686
POTLESS_2 34:26f6e3dbefb9 687 /*
POTLESS_2 34:26f6e3dbefb9 688 Par défaut les valeur en cas de calibration sur true sont les suivant
POTLESS_2 15:efd3b3bf3f37 689
POTLESS_2 34:26f6e3dbefb9 690 nbCalibO2 = 5
POTLESS_2 34:26f6e3dbefb9 691 Mode = SPOOLING
POTLESS_2 34:26f6e3dbefb9 692 Filtre = DIGI_FILTER32
POTLESS_2 34:26f6e3dbefb9 693 CalibrationCO2 = "CALIB_AIR"
POTLESS_2 18:bfd78c05b589 694
POTLESS_2 34:26f6e3dbefb9 695 Parfois la calibration du Cozir coince...faire reset et relancer...
POTLESS_2 19:cac3761a5d0b 696
POTLESS_2 34:26f6e3dbefb9 697 Pour calibrer avec ces paramètres :
POTLESS_2 9:04bfdfc029cb 698
POTLESS_2 34:26f6e3dbefb9 699 sensors.Sensors_INIT(true, true);
POTLESS_2 19:cac3761a5d0b 700
POTLESS_2 34:26f6e3dbefb9 701 Pour changer utiliser la syntaxe suivante :
POTLESS_2 20:5f79fb4565a7 702
POTLESS_2 34:26f6e3dbefb9 703 sensors.Sensors_INIT(true, true, true, 5, SPOOLING, DIGI_FILTER32, CALIB_AIR);
POTLESS_2 12:7f3aadd79f89 704
POTLESS_2 34:26f6e3dbefb9 705 */
POTLESS_2 34:26f6e3dbefb9 706
POTLESS_2 34:26f6e3dbefb9 707 sensors.Sensors_INIT(calib_O2, calib_CO2);
POTLESS_2 34:26f6e3dbefb9 708 wait(1);
POTLESS_2 34:26f6e3dbefb9 709
POTLESS_2 34:26f6e3dbefb9 710 //Création du nouveau fichier LOG par index / par date.
POTLESS_2 34:26f6e3dbefb9 711 Create_File_Name_Index();
POTLESS_2 34:26f6e3dbefb9 712 //Create_File_Name_Date()
POTLESS_2 36:1f5e2247b073 713
POTLESS_2 34:26f6e3dbefb9 714 //Création et écriture du header du fichier LOG
POTLESS_2 35:a209a192f431 715 sensors.Create_Header(Log_File_Name);
POTLESS_2 36:1f5e2247b073 716
POTLESS_2 35:a209a192f431 717 Servo_Poumon.Init("Servo_Poumon");
POTLESS_2 35:a209a192f431 718 //Servo_Fuite.Init("Servo_Fuite");
POTLESS_2 9:04bfdfc029cb 719
POTLESS_2 34:26f6e3dbefb9 720 DEBUG(" Demarrage des threads...\r\n\r\n");
POTLESS_2 34:26f6e3dbefb9 721
POTLESS_2 34:26f6e3dbefb9 722 /*
POTLESS_2 34:26f6e3dbefb9 723
POTLESS_2 34:26f6e3dbefb9 724 Pour mémoire, les réglage de priorité des thread
POTLESS_2 7:ad15c386e960 725
POTLESS_2 34:26f6e3dbefb9 726 osPriorityIdle = -3, ///< priority: idle (lowest)
POTLESS_2 34:26f6e3dbefb9 727 osPriorityLow = -2, ///< priority: low
POTLESS_2 34:26f6e3dbefb9 728 osPriorityBelowNormal = -1, ///< priority: below normal
POTLESS_2 34:26f6e3dbefb9 729 osPriorityNormal = 0, ///< priority: normal (default)
POTLESS_2 34:26f6e3dbefb9 730 osPriorityAboveNormal = +1, ///< priority: above normal
POTLESS_2 34:26f6e3dbefb9 731 osPriorityHigh = +2, ///< priority: high
POTLESS_2 34:26f6e3dbefb9 732 osPriorityRealtime = +3, ///< priority: realtime (highest)
POTLESS_2 34:26f6e3dbefb9 733 osPriorityError = 0x84 ///< system cannot determine priority or thread has illegal priority
POTLESS_2 34:26f6e3dbefb9 734 */
POTLESS_2 36:1f5e2247b073 735 wait(1);
POTLESS_2 36:1f5e2247b073 736
POTLESS_2 36:1f5e2247b073 737
POTLESS_2 34:26f6e3dbefb9 738 Thread thread_Volets(osPriorityNormal);
POTLESS_2 36:1f5e2247b073 739
POTLESS_2 34:26f6e3dbefb9 740 thread_Volets.start(callback(GO_TO_thread));
POTLESS_2 34:26f6e3dbefb9 741
POTLESS_2 34:26f6e3dbefb9 742 DEBUG(" Volets thread démarré\r\n\r\n");
POTLESS_2 15:efd3b3bf3f37 743
POTLESS_2 34:26f6e3dbefb9 744 wait(1);
POTLESS_2 36:1f5e2247b073 745
POTLESS_2 34:26f6e3dbefb9 746 Thread thread_Secu(osPriorityNormal);
POTLESS_2 34:26f6e3dbefb9 747
POTLESS_2 34:26f6e3dbefb9 748 thread_Secu.start(callback(SECU_thread));
POTLESS_2 34:26f6e3dbefb9 749
POTLESS_2 34:26f6e3dbefb9 750 DEBUG(" Secu thread démarré\r\n\r\n");
POTLESS_2 19:cac3761a5d0b 751
POTLESS_2 34:26f6e3dbefb9 752 wait(1);
POTLESS_2 34:26f6e3dbefb9 753
POTLESS_2 34:26f6e3dbefb9 754 Thread thread_Head(osPriorityNormal);
POTLESS_2 36:1f5e2247b073 755
POTLESS_2 34:26f6e3dbefb9 756 thread_Head.start(callback(SENSORS_thread));
POTLESS_2 34:26f6e3dbefb9 757
POTLESS_2 34:26f6e3dbefb9 758 DEBUG(" Info thread démarré\r\n\r\n");
POTLESS_2 34:26f6e3dbefb9 759
POTLESS_2 34:26f6e3dbefb9 760 wait(1);
POTLESS_2 15:efd3b3bf3f37 761
POTLESS_2 15:efd3b3bf3f37 762
POTLESS_2 15:efd3b3bf3f37 763 #ifdef PID_MODE
POTLESS_2 34:26f6e3dbefb9 764 //Init PID
POTLESS_2 34:26f6e3dbefb9 765 //Entrée PPO2 entre 100 et 1000 mb
POTLESS_2 34:26f6e3dbefb9 766 control_Servo.setInputLimits(Min_Input, Max_Input);
POTLESS_2 34:26f6e3dbefb9 767 //Sortie servo entre 0 et 100 %
POTLESS_2 34:26f6e3dbefb9 768 control_Servo.setOutputLimits(Min_Output, Max_Output);
POTLESS_2 34:26f6e3dbefb9 769 //Mode auto au démarrage
POTLESS_2 34:26f6e3dbefb9 770 control_Servo.setMode(AUTO_MODE);
POTLESS_2 34:26f6e3dbefb9 771 //Consigne à x mb
POTLESS_2 34:26f6e3dbefb9 772 control_Servo.setSetPoint(consigne);
POTLESS_2 12:7f3aadd79f89 773 #endif
POTLESS_2 15:efd3b3bf3f37 774
POTLESS_2 34:26f6e3dbefb9 775 DEBUG(" Threads démarrés.....\r\n\r\n Tapez help pour voir la liste des commandes disponibles.\r\n ");
POTLESS_2 34:26f6e3dbefb9 776
POTLESS_2 34:26f6e3dbefb9 777 while (true) {
POTLESS_2 34:26f6e3dbefb9 778
POTLESS_2 34:26f6e3dbefb9 779 //Démarrage du Timer mesurant le temps d'éxecution du code
POTLESS_2 34:26f6e3dbefb9 780 REAL_RATE.start();
POTLESS_2 34:26f6e3dbefb9 781
POTLESS_2 34:26f6e3dbefb9 782 if (newParamFlag) {
POTLESS_2 34:26f6e3dbefb9 783 DEBUG(" From PC = %s\r\n", param);
POTLESS_2 34:26f6e3dbefb9 784 Decoding_Message(param);
POTLESS_2 34:26f6e3dbefb9 785 }
POTLESS_2 34:26f6e3dbefb9 786
POTLESS_2 34:26f6e3dbefb9 787 if (newAndroidFlag) {
POTLESS_2 34:26f6e3dbefb9 788 DEBUG(" From Android = %s\r\n", Android);
POTLESS_2 34:26f6e3dbefb9 789 Decoding_Message_Android(Android);
POTLESS_2 34:26f6e3dbefb9 790 }
POTLESS_2 34:26f6e3dbefb9 791
POTLESS_2 34:26f6e3dbefb9 792 //Fabrication de la chaine Date / heure
POTLESS_2 34:26f6e3dbefb9 793 seconds = time(NULL);
POTLESS_2 34:26f6e3dbefb9 794 char Time_buf[32];
POTLESS_2 34:26f6e3dbefb9 795 strftime(Time_buf, 32, "%D %I-%M-%S ", localtime(&seconds));
POTLESS_2 12:7f3aadd79f89 796
POTLESS_2 16:917656586772 797 #ifdef PID_MODE
POTLESS_2 34:26f6e3dbefb9 798 //Fabrication de la chaine à enregistrer
POTLESS_2 34:26f6e3dbefb9 799 sprintf(to_store,"%s:%d:%d:%.2f:%.2f:%.2f:%d:%d:%d:%.2f:%.2f:%d:%.3f:%.3f:%.3f:%d",
POTLESS_2 34:26f6e3dbefb9 800 Time_buf,
POTLESS_2 34:26f6e3dbefb9 801 co2,
POTLESS_2 34:26f6e3dbefb9 802 ppO2,
POTLESS_2 34:26f6e3dbefb9 803 pression,
POTLESS_2 34:26f6e3dbefb9 804 Temp1,
POTLESS_2 34:26f6e3dbefb9 805 Temp2,
POTLESS_2 34:26f6e3dbefb9 806 Humid,
POTLESS_2 34:26f6e3dbefb9 807 CellO2_1,
POTLESS_2 34:26f6e3dbefb9 808 CellO2_2,
POTLESS_2 34:26f6e3dbefb9 809 volet_poumon_Position,
POTLESS_2 34:26f6e3dbefb9 810 volet_fuite_Position,
POTLESS_2 34:26f6e3dbefb9 811 MODE_FLAG,
POTLESS_2 34:26f6e3dbefb9 812 Kc,
POTLESS_2 34:26f6e3dbefb9 813 Ti,
POTLESS_2 34:26f6e3dbefb9 814 Td,
POTLESS_2 34:26f6e3dbefb9 815 (int)consigne
POTLESS_2 34:26f6e3dbefb9 816 );
POTLESS_2 34:26f6e3dbefb9 817 #endif
POTLESS_2 34:26f6e3dbefb9 818 #ifndef PID_MODE
POTLESS_2 34:26f6e3dbefb9 819 //Fabrication de la chaine à enregistrer sans les variables du PID
POTLESS_2 34:26f6e3dbefb9 820 sprintf(to_store,"%s:%d:%d:%.2f:%.2f:%.2f:%d:%d:%d:%.2f:%.2f:%d:%.3f:%.3f:%.3f:%d",
POTLESS_2 34:26f6e3dbefb9 821 Time_buf,
POTLESS_2 34:26f6e3dbefb9 822 co2,
POTLESS_2 34:26f6e3dbefb9 823 ppO2,
POTLESS_2 34:26f6e3dbefb9 824 pression,
POTLESS_2 34:26f6e3dbefb9 825 Temp1,
POTLESS_2 34:26f6e3dbefb9 826 Temp2,
POTLESS_2 34:26f6e3dbefb9 827 Humid,
POTLESS_2 34:26f6e3dbefb9 828 CellO2_1,
POTLESS_2 34:26f6e3dbefb9 829 CellO2_2,
POTLESS_2 34:26f6e3dbefb9 830 volet_poumon_Position,
POTLESS_2 34:26f6e3dbefb9 831 volet_fuite_Position,
POTLESS_2 34:26f6e3dbefb9 832 MODE_FLAG,
POTLESS_2 34:26f6e3dbefb9 833 0.0,
POTLESS_2 34:26f6e3dbefb9 834 0.0,
POTLESS_2 34:26f6e3dbefb9 835 0.0,
POTLESS_2 34:26f6e3dbefb9 836 0
POTLESS_2 34:26f6e3dbefb9 837 );
POTLESS_2 18:bfd78c05b589 838 #endif
POTLESS_2 34:26f6e3dbefb9 839 char to_slave[50];
POTLESS_2 34:26f6e3dbefb9 840 //Fabrication de la chaine pour l'IHM
POTLESS_2 40:32d89e04ead1 841 sprintf(to_slave,"<%d:%d:%d:%.2f:%.2f:%.2f:%d:%d:%d:%.2f:%.2f>",
POTLESS_2 34:26f6e3dbefb9 842 co2,
POTLESS_2 34:26f6e3dbefb9 843 ppO2,
POTLESS_2 34:26f6e3dbefb9 844 (int)OTU,
POTLESS_2 34:26f6e3dbefb9 845 pression,
POTLESS_2 34:26f6e3dbefb9 846 Temp1,
POTLESS_2 34:26f6e3dbefb9 847 Temp2,
POTLESS_2 34:26f6e3dbefb9 848 Humid,
POTLESS_2 34:26f6e3dbefb9 849 CellO2_1,
POTLESS_2 34:26f6e3dbefb9 850 CellO2_2,
POTLESS_2 34:26f6e3dbefb9 851 volet_poumon_Position,
POTLESS_2 34:26f6e3dbefb9 852 volet_fuite_Position);
POTLESS_2 34:26f6e3dbefb9 853
POTLESS_2 34:26f6e3dbefb9 854 //Pour Android on ajoute < et > pour décoder l'arrivée du message
POTLESS_2 34:26f6e3dbefb9 855 if (NEED_ANDROID_OUTPUT == 1) {
POTLESS_2 34:26f6e3dbefb9 856 //sprintf(to_android,"<%s>",to_store);
POTLESS_2 40:32d89e04ead1 857 //ANDROID(to_slave);
POTLESS_2 40:32d89e04ead1 858 }
POTLESS_2 40:32d89e04ead1 859
POTLESS_2 40:32d89e04ead1 860 //Pour windev la même chose que pour l'écran
POTLESS_2 40:32d89e04ead1 861 if (FLAG_WINDEV) {
POTLESS_2 41:51ba69648f9d 862 NVIC_DisableIRQ(USART2_IRQn);
POTLESS_2 40:32d89e04ead1 863 serialMonit.printf(to_slave);
POTLESS_2 41:51ba69648f9d 864 NVIC_EnableIRQ(USART2_IRQn);
POTLESS_2 34:26f6e3dbefb9 865 }
POTLESS_2 34:26f6e3dbefb9 866
POTLESS_2 34:26f6e3dbefb9 867 //Calcul des OTU
POTLESS_2 34:26f6e3dbefb9 868 Calcul_OTU();
POTLESS_2 34:26f6e3dbefb9 869
POTLESS_2 34:26f6e3dbefb9 870 //Vers le moniteur série
POTLESS_2 34:26f6e3dbefb9 871 if (FLAG_AFF) Affichage();
POTLESS_2 34:26f6e3dbefb9 872
POTLESS_2 34:26f6e3dbefb9 873 //Enregistrement de la chaine
POTLESS_2 34:26f6e3dbefb9 874 if (FLAG_REC) UTILS::Write_Flash_File(to_store, Log_File_Name);
POTLESS_2 34:26f6e3dbefb9 875
POTLESS_2 18:bfd78c05b589 876
POTLESS_2 34:26f6e3dbefb9 877 #ifdef PID_MODE
POTLESS_2 34:26f6e3dbefb9 878 //Update du PID
POTLESS_2 34:26f6e3dbefb9 879 control_Servo.setProcessValue(ppO2);
POTLESS_2 34:26f6e3dbefb9 880 //Nouvelle sortie servo fuite si on est pas en mode SECU
POTLESS_2 34:26f6e3dbefb9 881 if(!EN_MODE_SECU) Consigne_fuite = control_Servo.compute();
POTLESS_2 34:26f6e3dbefb9 882 #endif
POTLESS_2 34:26f6e3dbefb9 883
POTLESS_2 34:26f6e3dbefb9 884 //Arrêt du Timer mesurant le temps d'éxecution du code
POTLESS_2 34:26f6e3dbefb9 885 REAL_RATE.stop();
POTLESS_2 34:26f6e3dbefb9 886 //Définition de la nouvelle valeur du temps d'échantillonage du PID.
POTLESS_2 34:26f6e3dbefb9 887 RATE = REAL_RATE.read();
POTLESS_2 34:26f6e3dbefb9 888 //Reset du Timer
POTLESS_2 34:26f6e3dbefb9 889 REAL_RATE.reset();
POTLESS_2 34:26f6e3dbefb9 890
POTLESS_2 34:26f6e3dbefb9 891 //Pour ralentir le code à Ref_Time seconde fixe quelque soit les intéruptions du loop....
POTLESS_2 34:26f6e3dbefb9 892 if (Ref_Time > RATE) {
POTLESS_2 34:26f6e3dbefb9 893 RATE_TRUE = (Ref_Time - RATE) * 1000;
POTLESS_2 34:26f6e3dbefb9 894 } else {
POTLESS_2 34:26f6e3dbefb9 895 RATE_TRUE = 0;
POTLESS_2 34:26f6e3dbefb9 896 #ifdef PID_MODE
POTLESS_2 34:26f6e3dbefb9 897 control_Servo.setInterval(RATE);
POTLESS_2 34:26f6e3dbefb9 898 #endif
POTLESS_2 40:32d89e04ead1 899 DEEP_DEBUG("Pour ralentir le code, Ref_Time doit être supérieur à %f seconde(s)\r\n\n", RATE);
POTLESS_2 34:26f6e3dbefb9 900 }
POTLESS_2 34:26f6e3dbefb9 901
POTLESS_2 34:26f6e3dbefb9 902 wait_ms(RATE_TRUE);
POTLESS_2 34:26f6e3dbefb9 903 }
POTLESS_2 34:26f6e3dbefb9 904 }
POTLESS_2 34:26f6e3dbefb9 905 }
POTLESS_2 4:d84250f67dec 906 }