Mercurial > public > ostc4
annotate Discovery/Src/buehlmann.c @ 208:9fc06e1e0f66 ImprovmentSPI
Update SPI error display and handling
For easier identification of a communication problem the RX state of Main and RTE is displayed in the debug view.
Also error reactions are now handles based on this state. E.g. RTE resets its DMA incase Main reports a data shift which can not be resolved by Main itself
In addition the timeout for error detection has been decreased to have a faster reaction
| author | ideenmodellierer |
|---|---|
| date | Sun, 24 Mar 2019 22:57:28 +0100 |
| parents | b7689d9e888a |
| children | ceecabfddb57 |
| rev | line source |
|---|---|
|
51
8f8ea3a32e82
Resolved warnings pointing to possible invalid memory access
Ideenmodellierer
parents:
38
diff
changeset
|
1 /* getrennte Gase f�r die verschiedenen Modi |
|
8f8ea3a32e82
Resolved warnings pointing to possible invalid memory access
Ideenmodellierer
parents:
38
diff
changeset
|
2 um Gaswechsel Eintr�ge zu vereinfachen |
| 38 | 3 das heisst: |
| 4 oc == bailout in cc mode | |
| 5 */ | |
| 6 | |
| 7 /* Konvention: | |
| 8 float extExample_variable_can_be_used_with_extern; | |
| 9 */ | |
| 10 | |
| 11 #include <string.h> | |
| 12 //#include "arm_math.h" | |
| 13 #include <math.h> | |
| 14 #include <stdbool.h> | |
| 15 #include "buehlmann.h" | |
| 16 #include "decom.h" | |
| 17 | |
| 18 | |
| 19 extern const float helium_time_constant[16]; | |
| 20 extern const float nitrogen_time_constant[16]; | |
| 21 | |
| 22 extern const float buehlmann_N2_a[]; | |
| 23 extern const float buehlmann_N2_b[]; | |
| 24 extern const float buehlmann_He_a[]; | |
| 25 extern const float buehlmann_He_b[]; | |
| 26 | |
| 27 | |
| 28 /* | |
| 29 typedef struct | |
| 30 { | |
| 31 float *pointer_array_tissue_nitrogen_bar; | |
| 32 float *pointer_array_tissue_helium_bar; | |
| 33 char gf_value; | |
| 34 | |
| 35 float output_ceiling_ambient_bar_or_input; | |
| 36 _Bool output_ceiling_tolerated_if_ceiling_used_as_input; | |
| 37 } tissue_test_tolerance_struct; | |
| 38 */ | |
| 39 typedef struct | |
| 40 { | |
| 41 float depth; | |
| 42 int id; | |
| 43 } SStop; | |
| 44 | |
| 45 #define DECO_STOPS_MAX_TTS_CALCULATON_IN_SECONDS 59940 // 999 minuten; before: 18000 // 5(h) * 60(min) * 60 sec = 18000 sec | |
| 46 #define DECO_STOPS_MAX_TTS_FOR_EVERY_SECOND_CALC_IN_SECONDS 7200 | |
| 47 #define NINETY_NINE_MINUTES_IN_SECONDS 59940 | |
| 48 | |
| 49 # define PRESSURE_TEN_METER 1.0f | |
| 50 # define PRESSURE_THREE_METER 0.333334f | |
| 51 # define PRESSURE_150_CM 0.15f | |
| 52 # define PRESSURE_HALF_METER 0.05f | |
| 53 /* | |
| 54 # define PRESSURE_150_CM_MBAR 150 | |
| 55 # define PRESSURE_TWO_M_MBAR 200 | |
| 56 # define PRESSURE_FIVE_M_MBAR 500 | |
| 57 # define PRESSURE_TEN_M_MBAR 1000 | |
| 58 # define PRESSURE_120_METER 12.0 | |
| 59 */ | |
| 60 /* | |
| 61 _____________________________________________________________ | |
| 62 */ | |
| 63 | |
| 64 | |
| 65 void buehlmann_backup_and_restore(_Bool backup_restore_otherwise); | |
| 66 float tissue_tolerance(void); | |
| 67 void ambient_bar_to_deco_stop_depth_bar(float ceiling); | |
| 68 int ascend_with_all_gaschanges(float pressure_decrease); | |
| 69 float next_stop_depth_input_is_actual_stop_id(int actual_id); | |
| 70 float get_gf_at_pressure(float pressure); | |
| 71 void buehlmann_calc_ndl(void); | |
| 72 _Bool dive1_check_deco(void); | |
| 73 uint8_t buehlmann_tissue_test_tolerance(float depth_in_bar_absolute); | |
| 74 | |
| 75 /* | |
| 76 _____________________________________________________________ | |
| 77 */ | |
| 78 | |
| 79 SDecoinfo gDecotable; | |
| 80 float gSurface_pressure_bar; | |
| 81 float gPressure; | |
| 82 int gGas_id; | |
| 83 float gTTS; | |
| 84 float gTissue_nitrogen_bar[16]; | |
| 85 float gTissue_helium_bar[16]; | |
|
130
b7689d9e888a
Minor changes to improved code quality and to eliminate warnings
Ideenmodellierer
parents:
51
diff
changeset
|
86 float gGF_value; |
| 38 | 87 float gCNS; |
| 88 //float gMax_ceiling_bar = 0; | |
| 89 int gNDL; | |
| 90 | |
| 91 | |
| 92 //SLifeData *pLifeData; | |
| 93 SDiveSettings *pBuDiveSettings; | |
| 94 SDecoinfo* pDecolistBuehlmann; | |
| 95 //signed char gGaschange_decreasing_depth_gas_id[BUEHLMANN_STRUCT_MAX_GASES]; | |
| 96 float gGF_low_depth_bar; | |
| 97 SStop gStop; | |
| 98 | |
| 99 void buehlmann_init(void) | |
| 100 { | |
| 101 //gMax_ceiling_bar = 0; | |
| 102 } | |
| 103 | |
| 104 void buehlmann_backup_and_restore(_Bool backup_restore_otherwise) | |
| 105 { | |
| 106 static float pressure; | |
| 107 static float gas_id; | |
| 108 static float tts; | |
| 109 static float tissue_nitrogen_bar[16]; | |
| 110 static float tissue_helium_bar[16]; | |
| 111 static float gf_value; | |
| 112 static int ndl; | |
| 113 static float cns; | |
| 114 | |
| 115 if(backup_restore_otherwise) | |
| 116 { | |
| 117 pressure = gPressure; | |
| 118 gas_id = gGas_id; | |
| 119 tts = gTTS; | |
| 120 gf_value = gGF_value; | |
| 121 ndl = gNDL; | |
| 122 cns = gCNS; | |
| 123 memcpy(tissue_nitrogen_bar, gTissue_nitrogen_bar, (4*16)); | |
| 124 memcpy(tissue_helium_bar, gTissue_helium_bar, (4*16)); | |
| 125 } | |
| 126 else | |
| 127 { | |
| 128 gPressure = pressure; | |
| 129 gGas_id = gas_id; | |
| 130 gTTS = tts; | |
| 131 gGF_value = gf_value; | |
| 132 gNDL = ndl; | |
| 133 gCNS = cns; | |
| 134 memcpy(gTissue_nitrogen_bar, tissue_nitrogen_bar, (4*16)); | |
| 135 memcpy(gTissue_helium_bar, tissue_helium_bar, (4*16)); | |
| 136 } | |
| 137 | |
| 138 } | |
| 139 /*void buehlmann__test__saturate_tissues(SBuehlmann *pInput, int seconds) | |
| 140 { | |
| 141 pBuehlmann = pInput; | |
| 142 pInput->dive_time_seconds += seconds; | |
| 143 // internal copying | |
| 144 gSurface_pressure_bar = pBuehlmann->pressure_surface_bar; | |
| 145 | |
| 146 gPressure = pBuehlmann->pressure_ambient_bar; | |
| 147 gGas_id = pBuehlmann->actual_gas_id; | |
| 148 memcpy(gTissue_nitrogen_bar, pBuehlmann->tissue_nitrogen_bar, (4*16)); | |
| 149 memcpy(gTissue_helium_bar, pBuehlmann->tissue_helium_bar, (4*16)); | |
| 150 | |
| 151 tissues_exposure_at_gPressure_seconds(seconds); | |
| 152 | |
| 153 memcpy(pBuehlmann->tissue_nitrogen_bar, gTissue_nitrogen_bar, (4*16)); | |
| 154 memcpy(pBuehlmann->tissue_helium_bar, gTissue_helium_bar, (4*16)); | |
| 155 }*/ | |
| 156 | |
| 157 float buehlmann_get_gCNS(void) | |
| 158 { | |
| 159 return gCNS; | |
| 160 } | |
| 161 | |
| 162 void buehlmann_calc_deco(SLifeData* pLifeData, SDiveSettings * pDiveSettings, SDecoinfo * pDecoInfo) | |
| 163 { | |
| 164 float ceiling; | |
| 165 int ascend_time; | |
| 166 int tts_seconds; | |
| 167 float pressure_delta; | |
| 168 float next_depth; | |
| 169 _Bool deco_reached = false; | |
| 170 // tissue_test_tolerance_struct tolerance_data; | |
| 171 unsigned short *stoplist; | |
| 172 int i; | |
| 173 | |
| 174 // decom_CreateGasChangeList(pDiveSettings, pLifeData); | |
| 175 | |
| 176 gCNS = 0; | |
| 177 pDecoInfo->output_time_to_surface_seconds = 0; | |
| 178 pDecoInfo->output_ndl_seconds = 0; | |
| 179 for(int i=0;i<DECOINFO_STRUCT_MAX_STOPS;i++) | |
| 180 { | |
| 181 pDecoInfo->output_stop_length_seconds[i] = 0; | |
| 182 } | |
| 183 /* make input available global*/ | |
| 184 pBuDiveSettings = pDiveSettings; | |
| 185 | |
| 186 pDecolistBuehlmann = pDecoInfo; | |
| 187 /* internal copying */ | |
| 188 gSurface_pressure_bar = pLifeData->pressure_surface_bar; | |
| 189 | |
| 190 gPressure = pLifeData->pressure_ambient_bar; | |
| 191 gGas_id = 0; | |
| 192 memcpy(gTissue_nitrogen_bar, pLifeData->tissue_nitrogen_bar, (4*16)); | |
| 193 memcpy(gTissue_helium_bar, pLifeData->tissue_helium_bar, (4*16)); | |
| 194 gGF_value = ((float)pBuDiveSettings->gf_low) / 100.0f; | |
| 195 | |
| 196 // | |
| 197 memcpy(&gDecotable, pDecolistBuehlmann, sizeof(SDecoinfo)); | |
| 198 stoplist = gDecotable.output_stop_length_seconds; | |
| 199 | |
| 200 | |
| 201 if(pLifeData->dive_time_seconds < 60) | |
| 202 return; | |
| 203 /* coupling */ | |
| 204 | |
| 205 /* functions */ | |
| 206 | |
| 207 // clean stop list | |
| 208 for(i = 0; i < DECOINFO_STRUCT_MAX_STOPS; i++) | |
| 209 stoplist[i] = 0; | |
| 210 gTTS = 0; | |
| 211 gNDL = 0; | |
| 212 | |
| 213 if(pDiveSettings->internal__pressure_first_stop_ambient_bar_as_upper_limit_for_gf_low_otherwise_zero >= (gPressure - PRESSURE_150_CM)) | |
| 214 { | |
| 215 deco_reached = true; | |
| 216 } | |
| 217 | |
| 218 | |
| 219 //ascend_with_all_gaschanges(gPressure - gSurface_pressure_bar); | |
| 220 gGF_value = ((float)pBuDiveSettings->gf_high) / 100.0f; | |
| 221 //iling = tissue_tolerance(); | |
| 222 // includes backup for gGF_value | |
| 223 // NDL | |
| 224 buehlmann_backup_and_restore(true); // includes backup for gGF_value | |
| 225 if(!dive1_check_deco() ) | |
| 226 { | |
| 227 buehlmann_backup_and_restore(false); | |
| 228 // no deco | |
| 229 pDecolistBuehlmann->output_time_to_surface_seconds = 0; | |
| 230 for(i = 0; i < DECOINFO_STRUCT_MAX_STOPS; i++) | |
| 231 pDecolistBuehlmann->output_stop_length_seconds[i] = 0; | |
| 232 // calc NDL | |
| 233 buehlmann_calc_ndl(); | |
| 234 pDecolistBuehlmann->output_ndl_seconds = gNDL; | |
| 235 return; | |
| 236 } | |
| 237 buehlmann_backup_and_restore(false); | |
| 238 pDecolistBuehlmann->output_ndl_seconds = 0; | |
| 239 | |
| 240 gGF_value = get_gf_at_pressure(gPressure); | |
| 241 //current ceiling at actual position | |
| 242 ceiling = tissue_tolerance(); | |
| 243 //if(ceiling < pDiveSettings->internal__pressure_first_stop_ambient_bar_as_upper_limit_for_gf_low_otherwise_zero) | |
| 244 //ambient_bar_to_deco_stop_depth_bar(pDiveSettings->internal__pressure_first_stop_ambient_bar_as_upper_limit_for_gf_low_otherwise_zero); | |
| 245 //else | |
| 246 ambient_bar_to_deco_stop_depth_bar(ceiling); | |
| 247 | |
| 248 // set the base for all upcoming parameters | |
| 249 ceiling = gStop.depth + gSurface_pressure_bar; | |
| 250 tts_seconds = 0; | |
| 251 | |
| 252 // modify parameters if there is ascend or parameter fine adjustment | |
| 253 if(ceiling < (gPressure - PRESSURE_150_CM)) // more than 1.5 meter below ceiling | |
| 254 { | |
| 255 // ascend within 10 mtr to GF_low // speed 12 mtr/min -> 50 sec / 10 mtr; 15 sec / 3 mtr. | |
| 256 if(ceiling < (gPressure - PRESSURE_TEN_METER) ) | |
| 257 { do { | |
| 258 ascend_time = ascend_with_all_gaschanges(PRESSURE_TEN_METER); | |
| 259 tts_seconds += ascend_time; | |
| 260 ceiling = tissue_tolerance(); | |
| 261 if(tts_seconds > DECO_STOPS_MAX_TTS_CALCULATON_IN_SECONDS) | |
| 262 { | |
| 263 /* pInput == pBuehlmann */ | |
| 264 pDecolistBuehlmann->output_time_to_surface_seconds = NINETY_NINE_MINUTES_IN_SECONDS; | |
| 265 return;// NINETY_NINE_MINUTES_IN_SECONDS; | |
| 266 } | |
| 267 } while ((ascend_time > 0 ) && ((gPressure - PRESSURE_TEN_METER ) > gSurface_pressure_bar) && (ceiling < (gPressure - PRESSURE_TEN_METER))); | |
| 268 } | |
| 269 do { | |
| 270 buehlmann_backup_and_restore(true); | |
| 271 ascend_time = ascend_with_all_gaschanges(PRESSURE_THREE_METER); | |
| 272 tts_seconds += ascend_time; | |
| 273 ceiling = tissue_tolerance(); | |
| 274 if(tts_seconds > DECO_STOPS_MAX_TTS_CALCULATON_IN_SECONDS) | |
| 275 { | |
| 276 /* pInput == pBuehlmann */ | |
| 277 pDecolistBuehlmann->output_time_to_surface_seconds = NINETY_NINE_MINUTES_IN_SECONDS; | |
| 278 return;// NINETY_NINE_MINUTES_IN_SECONDS; | |
| 279 } | |
| 280 ambient_bar_to_deco_stop_depth_bar(ceiling); | |
| 281 } while ((ascend_time > 0 ) && ((gStop.depth + gSurface_pressure_bar) < gPressure)); | |
| 282 | |
| 283 if(gStop.depth + gSurface_pressure_bar > gPressure) | |
| 284 { | |
| 285 gPressure += PRESSURE_THREE_METER; | |
| 286 buehlmann_backup_and_restore(false); | |
| 287 tts_seconds -= ascend_time; | |
| 288 } | |
| 289 // calculate first stop based on tissue saturation within 10 meters of stop | |
| 290 //ambient_bar_to_deco_stop_depth_bar(ceiling); | |
| 291 } | |
| 292 else | |
| 293 { | |
| 294 // initial values, upper code might not be executed (is within 150 cm) | |
| 295 } | |
| 296 | |
| 297 | |
| 298 | |
| 299 | |
| 300 if(ceiling > gSurface_pressure_bar) | |
| 301 { | |
| 302 | |
| 303 ceiling = gStop.depth + gSurface_pressure_bar; | |
| 304 // ascend the last meters to first stop (especially consider any gas changes around) | |
| 305 pressure_delta = gPressure - ceiling; | |
| 306 ascend_time = (int)ceil(pressure_delta * 50.0f); | |
| 307 tts_seconds += ascend_with_all_gaschanges(pressure_delta); | |
| 308 } | |
| 309 // NDL check | |
| 310 if(ceiling <= gSurface_pressure_bar) | |
| 311 { | |
| 312 /* pInput == pBuehlmann same pointer*/ | |
| 313 // NDL with GF_low | |
| 314 pDecolistBuehlmann->output_time_to_surface_seconds = 0; | |
| 315 return; | |
| 316 } | |
| 317 if(ceiling >pDiveSettings->internal__pressure_first_stop_ambient_bar_as_upper_limit_for_gf_low_otherwise_zero) | |
| 318 pDiveSettings->internal__pressure_first_stop_ambient_bar_as_upper_limit_for_gf_low_otherwise_zero = ceiling; | |
| 319 | |
| 320 // calc gf loop | |
| 321 if(deco_reached) | |
| 322 gGF_low_depth_bar = pDiveSettings->internal__pressure_first_stop_ambient_bar_as_upper_limit_for_gf_low_otherwise_zero - gSurface_pressure_bar; | |
| 323 else | |
| 324 gGF_low_depth_bar = ceiling - gSurface_pressure_bar; | |
| 325 | |
| 326 while(gStop.depth > 0) | |
| 327 { | |
| 328 do | |
| 329 { | |
| 330 next_depth = next_stop_depth_input_is_actual_stop_id(gStop.id); | |
| 331 gGF_value = get_gf_at_pressure(next_depth + gSurface_pressure_bar); | |
| 332 buehlmann_backup_and_restore(true); | |
| 333 ascend_time = ascend_with_all_gaschanges(gStop.depth - next_depth); | |
| 334 ceiling = tissue_tolerance(); | |
| 335 /* pre check actual limit */ | |
| 336 if(gDecotable.output_stop_length_seconds[gStop.id] >= 999*60) | |
| 337 { | |
| 338 tts_seconds -= 999*60 - gDecotable.output_stop_length_seconds[gStop.id]; | |
| 339 gDecotable.output_stop_length_seconds[gStop.id] = 999*60; | |
| 340 } | |
| 341 else | |
| 342 /* more deco on the actual depth */ | |
| 343 if(ceiling > next_depth + gSurface_pressure_bar) | |
| 344 { | |
| 345 next_depth = -1; | |
| 346 buehlmann_backup_and_restore(false); | |
| 347 decom_tissues_exposure2(10, &pBuDiveSettings->decogaslist[gGas_id], gPressure,gTissue_nitrogen_bar,gTissue_helium_bar); // some seconds at least at each stop | |
| 348 decom_oxygen_calculate_cns_exposure(10, &pBuDiveSettings->decogaslist[gGas_id], gPressure, &gCNS); | |
| 349 gDecotable.output_stop_length_seconds[gStop.id] += 10; | |
| 350 tts_seconds += 10; | |
| 351 } | |
| 352 } while(next_depth == -1); | |
| 353 tts_seconds += ascend_time; | |
| 354 gStop.depth = next_depth; | |
| 355 for(i = gGas_id + 1; i < BUEHLMANN_STRUCT_MAX_GASES; i++) | |
| 356 { | |
| 357 if(pBuDiveSettings->decogaslist[i].change_during_ascent_depth_meter_otherwise_zero == 0) | |
| 358 break; | |
| 359 float pressureChange = ((float)pBuDiveSettings->decogaslist[i].change_during_ascent_depth_meter_otherwise_zero) / 10; | |
| 360 if(gStop.depth <= pressureChange + 0.00001f) | |
| 361 { | |
| 362 gGas_id = i; | |
| 363 } | |
| 364 else | |
| 365 { | |
| 366 break; | |
| 367 } | |
| 368 } | |
| 369 gStop.id--; | |
| 370 } | |
| 371 | |
| 372 gDecotable.output_time_to_surface_seconds = tts_seconds; | |
| 373 memcpy(pDecolistBuehlmann, &gDecotable, sizeof(SDecoinfo)); | |
| 374 } | |
| 375 | |
| 376 | |
| 377 float tissue_tolerance(void) | |
| 378 { | |
| 379 float tissue_inertgas_saturation; | |
| 380 float inertgas_a; | |
| 381 float inertgas_b; | |
| 382 float ceiling; | |
| 383 float global_ceiling; | |
| 384 int ci; | |
| 385 | |
| 386 global_ceiling = -1; | |
| 387 | |
| 388 for (ci = 0; ci < 16; ci++) | |
| 389 { | |
| 390 if(gTissue_helium_bar[ci] == 0) | |
| 391 { | |
| 392 tissue_inertgas_saturation = gTissue_nitrogen_bar[ci]; | |
| 393 // | |
| 394 inertgas_a = buehlmann_N2_a[ci]; | |
| 395 inertgas_b = buehlmann_N2_b[ci]; | |
| 396 } | |
| 397 else | |
| 398 { | |
| 399 tissue_inertgas_saturation = gTissue_nitrogen_bar[ci] + gTissue_helium_bar[ci]; | |
| 400 // | |
| 401 inertgas_a = ( ( buehlmann_N2_a[ci] * gTissue_nitrogen_bar[ci]) + ( buehlmann_He_a[ci] * gTissue_helium_bar[ci]) ) / tissue_inertgas_saturation; | |
| 402 inertgas_b = ( ( buehlmann_N2_b[ci] * gTissue_nitrogen_bar[ci]) + ( buehlmann_He_b[ci] * gTissue_helium_bar[ci]) ) / tissue_inertgas_saturation; | |
| 403 } | |
| 404 // | |
| 405 ceiling = (inertgas_b * ( tissue_inertgas_saturation - gGF_value * inertgas_a ) ) / (gGF_value - (inertgas_b * gGF_value) + inertgas_b); | |
| 406 if(ceiling > global_ceiling) | |
| 407 global_ceiling = ceiling; | |
| 408 } | |
| 409 return global_ceiling; | |
| 410 } | |
| 411 | |
| 412 // hw 161121 for relative gradient | |
| 413 float tissue_tolerance_without_gf_correction(float *tissue_inertgas_saturation_output) | |
| 414 { | |
| 415 float tissue_inertgas_saturation; | |
| 416 float inertgas_a; | |
| 417 float inertgas_b; | |
| 418 float ceiling; | |
| 419 float global_ceiling; | |
| 420 int ci; | |
| 421 | |
| 422 global_ceiling = -1; | |
| 423 | |
| 424 for (ci = 0; ci < 16; ci++) | |
| 425 { | |
| 426 if(gTissue_helium_bar[ci] == 0) | |
| 427 { | |
| 428 tissue_inertgas_saturation = gTissue_nitrogen_bar[ci]; | |
| 429 // | |
| 430 inertgas_a = buehlmann_N2_a[ci]; | |
| 431 inertgas_b = buehlmann_N2_b[ci]; | |
| 432 } | |
| 433 else | |
| 434 { | |
| 435 tissue_inertgas_saturation = gTissue_nitrogen_bar[ci] + gTissue_helium_bar[ci]; | |
| 436 // | |
| 437 inertgas_a = ( ( buehlmann_N2_a[ci] * gTissue_nitrogen_bar[ci]) + ( buehlmann_He_a[ci] * gTissue_helium_bar[ci]) ) / tissue_inertgas_saturation; | |
| 438 inertgas_b = ( ( buehlmann_N2_b[ci] * gTissue_nitrogen_bar[ci]) + ( buehlmann_He_b[ci] * gTissue_helium_bar[ci]) ) / tissue_inertgas_saturation; | |
| 439 } | |
| 440 // | |
| 441 ceiling = inertgas_b * ( tissue_inertgas_saturation - inertgas_a ); | |
| 442 if(ceiling > global_ceiling) | |
| 443 { | |
| 444 global_ceiling = ceiling; | |
| 445 if(tissue_inertgas_saturation_output) | |
| 446 { | |
| 447 *tissue_inertgas_saturation_output = tissue_inertgas_saturation; | |
| 448 } | |
| 449 } | |
| 450 } | |
| 451 return global_ceiling; | |
| 452 } | |
| 453 | |
| 454 | |
| 455 uint8_t buehlmann_tissue_test_tolerance(float depth_in_bar_absolute) | |
| 456 { | |
| 457 float tissue_inertgas_saturation; | |
| 458 float inertgas_a; | |
| 459 float inertgas_b; | |
| 460 float inertgas_tolerance; | |
| 461 float gf_minus_1; | |
| 462 | |
| 463 gf_minus_1 = gGF_value - 1.0f; | |
| 464 | |
| 465 for (int ci = 0; ci < 16; ci++) | |
| 466 { | |
| 467 if(gTissue_helium_bar[ci] == 0) | |
| 468 { | |
| 469 tissue_inertgas_saturation = gTissue_nitrogen_bar[ci]; | |
| 470 // | |
| 471 inertgas_a = buehlmann_N2_a[ci]; | |
| 472 inertgas_b = buehlmann_N2_b[ci]; | |
| 473 } | |
| 474 else | |
| 475 { | |
| 476 tissue_inertgas_saturation = gTissue_nitrogen_bar[ci] + gTissue_helium_bar[ci]; | |
| 477 // | |
| 478 inertgas_a = ( ( buehlmann_N2_a[ci] * gTissue_nitrogen_bar[ci]) + ( buehlmann_He_a[ci] * gTissue_helium_bar[ci]) ) / tissue_inertgas_saturation; | |
| 479 inertgas_b = ( ( buehlmann_N2_b[ci] * gTissue_nitrogen_bar[ci]) + ( buehlmann_He_b[ci] * gTissue_helium_bar[ci]) ) / tissue_inertgas_saturation; | |
| 480 } | |
| 481 // | |
| 482 inertgas_tolerance = ( (gGF_value / inertgas_b - gf_minus_1) * depth_in_bar_absolute ) + ( gGF_value * inertgas_a ); | |
| 483 // | |
| 484 if(inertgas_tolerance < tissue_inertgas_saturation) | |
| 485 return 0; | |
| 486 } | |
| 487 return 1; | |
| 488 } | |
| 489 | |
| 490 | |
| 491 void ambient_bar_to_deco_stop_depth_bar(float ceiling) | |
| 492 { | |
| 493 int i; | |
| 494 | |
| 495 ceiling -= gSurface_pressure_bar; | |
| 496 | |
| 497 if(ceiling <= 0) | |
| 498 { | |
| 499 gStop.depth = pBuDiveSettings->last_stop_depth_bar; | |
| 500 gStop.id = 0; | |
| 501 return; | |
| 502 } | |
| 503 | |
| 504 | |
| 505 //for(int i = 1; i < 10; i++) | |
| 506 | |
| 507 if((ceiling - pBuDiveSettings->last_stop_depth_bar) <= 0) | |
| 508 { | |
| 509 gStop.depth = pBuDiveSettings->last_stop_depth_bar; | |
| 510 gStop.id = 0; | |
| 511 return; | |
| 512 } | |
| 513 | |
| 514 gStop.depth = pBuDiveSettings->input_second_to_last_stop_depth_bar; | |
| 515 gStop.id = 1; | |
| 516 ceiling -= pBuDiveSettings->input_second_to_last_stop_depth_bar; | |
| 517 | |
| 518 if(ceiling <= 0) | |
| 519 return; | |
| 520 | |
| 521 for(i = 1; i < (DECOINFO_STRUCT_MAX_STOPS - 2); i++) | |
| 522 { | |
| 523 ceiling -= pBuDiveSettings->input_next_stop_increment_depth_bar; | |
| 524 if(ceiling <= 0) | |
| 525 break; | |
| 526 } | |
| 527 gStop.depth += i * pBuDiveSettings->input_next_stop_increment_depth_bar; | |
| 528 gStop.id += i; | |
| 529 return; | |
| 530 } | |
| 531 | |
| 532 float next_stop_depth_input_is_actual_stop_id(int actual_id) | |
| 533 { | |
| 534 if(actual_id == 0) | |
| 535 return 0; | |
| 536 | |
| 537 if(actual_id == 1) | |
| 538 return pBuDiveSettings->last_stop_depth_bar; | |
| 539 | |
| 540 actual_id -= 2; | |
| 541 return pBuDiveSettings->input_second_to_last_stop_depth_bar + (actual_id * pBuDiveSettings->input_next_stop_increment_depth_bar); | |
| 542 } | |
| 543 | |
| 544 int ascend_with_all_gaschanges(float pressure_decrease) | |
| 545 { | |
| 546 float pressureTop, pressureTop_tmp, pressureBottom, pressureChange, ascendrate_in_seconds_for_one_bar, pressure_difference; | |
|
51
8f8ea3a32e82
Resolved warnings pointing to possible invalid memory access
Ideenmodellierer
parents:
38
diff
changeset
|
547 int time_for_ascend = 0; |
| 38 | 548 int seconds; |
| 549 int i; | |
| 550 | |
| 551 ascendrate_in_seconds_for_one_bar = 60 * 10 / pBuDiveSettings->ascentRate_meterperminute; | |
| 552 | |
| 553 if(fabsf(gPressure - gSurface_pressure_bar) < PRESSURE_HALF_METER) | |
| 554 { | |
| 555 gPressure = gSurface_pressure_bar; | |
| 556 return 0; | |
| 557 } | |
| 558 | |
| 559 pressureTop = gPressure - pressure_decrease; | |
| 560 if( gSurface_pressure_bar > pressureTop) | |
| 561 pressureTop = gSurface_pressure_bar; | |
| 562 pressureBottom = gPressure; | |
| 563 seconds = 0; | |
| 564 do{ | |
| 565 pressureTop_tmp = pressureTop; | |
| 566 for(i = gGas_id + 1; i < BUEHLMANN_STRUCT_MAX_GASES; i++) | |
| 567 { | |
| 568 if(pBuDiveSettings->decogaslist[i].change_during_ascent_depth_meter_otherwise_zero == 0) | |
| 569 break; | |
| 570 pressureChange = gSurface_pressure_bar + ((float)pBuDiveSettings->decogaslist[i].change_during_ascent_depth_meter_otherwise_zero) / 10; | |
| 571 if(pressureBottom <= pressureChange) | |
| 572 { | |
| 573 gGas_id = i; | |
| 574 } | |
| 575 else | |
| 576 { | |
| 577 break; | |
| 578 } | |
| 579 | |
| 580 } | |
| 581 for(i = gGas_id + 1; i < BUEHLMANN_STRUCT_MAX_GASES; i++) | |
| 582 { | |
| 583 if(pBuDiveSettings->decogaslist[i].change_during_ascent_depth_meter_otherwise_zero == 0) | |
| 584 break; | |
| 585 pressureChange = gSurface_pressure_bar + ((float)pBuDiveSettings->decogaslist[i].change_during_ascent_depth_meter_otherwise_zero)/ 10; | |
| 586 if((pressureChange < pressureBottom) && (pressureChange > pressureTop)) | |
| 587 { | |
| 588 pressureTop_tmp = pressureChange; | |
| 589 } | |
| 590 } | |
| 591 pressure_difference = pressureBottom - pressureTop_tmp; | |
| 592 if(pressure_difference > 0.0001f) | |
| 593 { | |
| 594 time_for_ascend = (int)ceilf(pressure_difference * ascendrate_in_seconds_for_one_bar); | |
| 595 decom_tissues_exposure_stage_schreiner(time_for_ascend, &pBuDiveSettings->decogaslist[gGas_id], | |
| 596 pressureBottom, pressureTop_tmp, gTissue_nitrogen_bar, gTissue_helium_bar); | |
| 597 decom_oxygen_calculate_cns_stage_SchreinerStyle(time_for_ascend,&pBuDiveSettings->decogaslist[gGas_id], | |
| 598 pressureBottom, pressureTop_tmp, &gCNS); | |
| 599 } | |
| 600 pressureBottom = pressureTop_tmp; | |
| 601 seconds += time_for_ascend; | |
| 602 }while(pressureTop_tmp > pressureTop); | |
| 603 gPressure = pressureTop; | |
| 604 return seconds; | |
| 605 } | |
| 606 | |
| 607 | |
| 608 float get_gf_at_pressure(float pressure) | |
| 609 { | |
| 610 float gfSteigung = 0.0f; | |
| 611 | |
| 612 if(gGF_low_depth_bar < 0) | |
| 613 gGF_low_depth_bar = PRESSURE_THREE_METER; // just to prevent erratic behaviour if variable is not set | |
| 614 | |
| 615 gfSteigung = ((float)(pBuDiveSettings->gf_high - pBuDiveSettings->gf_low))/ gGF_low_depth_bar; | |
| 616 | |
| 617 | |
| 618 if((pressure - gSurface_pressure_bar) <= PRESSURE_HALF_METER) | |
| 619 return ((float)pBuDiveSettings->gf_high) / 100.0f; | |
| 620 | |
| 621 if(pressure >= gSurface_pressure_bar + gGF_low_depth_bar) | |
| 622 return ((float)pBuDiveSettings->gf_low) / 100.0f; | |
| 623 | |
| 624 return (pBuDiveSettings->gf_high - gfSteigung * (pressure - gSurface_pressure_bar) )/ 100.0f; | |
| 625 } | |
| 626 | |
| 627 | |
| 628 void buehlmann_calc_ndl(void) | |
| 629 { | |
| 630 float local_tissue_nitrogen_bar[16]; | |
| 631 float local_tissue_helium_bar[16]; | |
| 632 int i; | |
| 633 | |
| 634 gNDL = 0; | |
| 635 //Check ndl always use gHigh | |
| 636 gGF_value = ((float)pBuDiveSettings->gf_high) / 100.0f; | |
| 637 //10 minutes steps | |
| 638 while(gNDL < (300 * 60)) | |
| 639 { | |
| 640 memcpy(local_tissue_nitrogen_bar, gTissue_nitrogen_bar, (4*16)); | |
| 641 memcpy(local_tissue_helium_bar, gTissue_helium_bar, (4*16)); | |
| 642 // | |
| 643 gNDL += 600; | |
| 644 decom_tissues_exposure2(600, &pBuDiveSettings->decogaslist[gGas_id], gPressure,gTissue_nitrogen_bar,gTissue_helium_bar); | |
| 645 decom_oxygen_calculate_cns_exposure(600,&pBuDiveSettings->decogaslist[gGas_id],gPressure,&gCNS); | |
| 646 //tissues_exposure_at_gPressure_seconds(600); | |
| 647 buehlmann_backup_and_restore(true); | |
| 648 if(dive1_check_deco() == true) | |
| 649 { | |
| 650 buehlmann_backup_and_restore(false); | |
| 651 break; | |
| 652 } | |
| 653 buehlmann_backup_and_restore(false); | |
| 654 } | |
| 655 | |
| 656 if(gNDL < (300 * 60)) | |
| 657 gNDL -= 600; | |
| 658 | |
| 659 if(gNDL > (150 * 60)) | |
| 660 return; | |
| 661 | |
| 662 // refine | |
| 663 memcpy(gTissue_nitrogen_bar, local_tissue_nitrogen_bar, (4*16)); | |
| 664 memcpy(gTissue_helium_bar, local_tissue_helium_bar, (4*16)); | |
| 665 | |
| 666 //One minutes step | |
| 667 for(i = 0; i < 20; i++) | |
| 668 { | |
| 669 gNDL += 60; | |
| 670 //tissues_exposure_at_gPressure_seconds(60); | |
| 671 decom_tissues_exposure2(60, &pBuDiveSettings->decogaslist[gGas_id], gPressure,gTissue_nitrogen_bar,gTissue_helium_bar); | |
| 672 decom_oxygen_calculate_cns_exposure(60,&pBuDiveSettings->decogaslist[gGas_id],gPressure,&gCNS); | |
| 673 buehlmann_backup_and_restore(true); | |
| 674 if(dive1_check_deco() == true) | |
| 675 break; | |
| 676 buehlmann_backup_and_restore(false); | |
| 677 } | |
| 678 //gNDL -= 60; | |
| 679 return; | |
| 680 } | |
| 681 | |
| 682 | |
| 683 // =============================================================================== | |
| 684 // dive1_check_deco | |
| 685 /// @brief for NDL calculations | |
| 686 /// 160614 using ceilingOther and not ceiling | |
| 687 // =============================================================================== | |
| 688 _Bool dive1_check_deco(void) | |
| 689 { | |
| 690 // gGF_value is set in call routine; | |
| 691 // internes Backup! | |
| 692 | |
| 693 // calc like in deco | |
| 694 float ceiling; | |
| 695 float ceilingOther; // new hw 160614 | |
| 696 | |
| 697 ceiling = tissue_tolerance(); | |
| 698 ambient_bar_to_deco_stop_depth_bar(ceiling); // this will set gStop.depth :-) (and gStop.id) | |
| 699 | |
| 700 // set the base for all upcoming parameters | |
| 701 ceilingOther = gStop.depth + gSurface_pressure_bar; | |
| 702 | |
| 703 // modify parameters if there is ascend or parameter fine adjustment | |
| 704 if(ceilingOther < (gPressure - PRESSURE_150_CM)) // more than 1.5 meter below ceiling | |
| 705 { | |
| 706 // ascend within 10 mtr to GF_low // speed 12 mtr/min -> 50 sec / 10 mtr; 15 sec / 3 mtr. | |
| 707 while(((gPressure - PRESSURE_TEN_METER ) > gSurface_pressure_bar) && (ceiling < (gPressure - PRESSURE_TEN_METER))) | |
| 708 { | |
| 709 ascend_with_all_gaschanges(PRESSURE_TEN_METER); | |
| 710 ceiling = tissue_tolerance(); | |
| 711 } | |
| 712 while(((gPressure - PRESSURE_THREE_METER )> gSurface_pressure_bar) && (ceiling < gPressure)) | |
| 713 { | |
| 714 ascend_with_all_gaschanges(PRESSURE_THREE_METER); | |
| 715 ceiling = tissue_tolerance(); | |
| 716 } | |
| 717 } | |
| 718 if(ceiling <= gSurface_pressure_bar) | |
| 719 return false; | |
| 720 else | |
| 721 return true; | |
| 722 } | |
| 723 | |
| 724 | |
| 725 void buehlmann_ceiling_calculator(SLifeData* pLifeData, SDiveSettings * pDiveSettings, SDecoinfo * pDecoInfo) | |
| 726 { | |
| 727 float gf_low; | |
| 728 float gf_high; | |
| 729 float gf_delta; | |
| 730 int dv_gf_low_stop_meter; | |
| 731 _Bool test_result; | |
| 732 float next_gf_value; | |
| 733 float next_pressure_absolute; | |
| 734 int depth_in_meter; | |
| 735 | |
| 736 gf_low = pDiveSettings->gf_low; | |
| 737 gf_high = pDiveSettings->gf_high; | |
| 738 | |
| 739 // | |
| 740 dv_gf_low_stop_meter = (int)((pDiveSettings->internal__pressure_first_stop_ambient_bar_as_upper_limit_for_gf_low_otherwise_zero - pLifeData->pressure_surface_bar) * 10); | |
| 741 // | |
| 742 if(dv_gf_low_stop_meter < 1) | |
| 743 { | |
| 744 next_gf_value = gf_high; // fix hw 161024 | |
| 745 gf_delta = 0; | |
| 746 } | |
| 747 else | |
| 748 { | |
| 749 next_gf_value = gf_high; | |
| 750 gf_delta = gf_high - gf_low; | |
| 751 gf_delta /= dv_gf_low_stop_meter; // gf_delta is delta for each meter now!! | |
| 752 } | |
| 753 // | |
| 754 depth_in_meter = 0; | |
| 755 next_pressure_absolute = pLifeData->pressure_surface_bar; | |
| 756 | |
| 757 memcpy(gTissue_nitrogen_bar, pLifeData->tissue_nitrogen_bar, (4*16)); | |
| 758 memcpy(gTissue_helium_bar, pLifeData->tissue_helium_bar, (4*16)); | |
| 759 gGF_value = next_gf_value / 100.0f; | |
| 760 // | |
| 761 test_result = buehlmann_tissue_test_tolerance(next_pressure_absolute); | |
| 762 // | |
| 763 while(!test_result && depth_in_meter < 200) | |
| 764 { | |
| 765 depth_in_meter += 1; | |
| 766 next_gf_value = fmaxf(gf_low, next_gf_value - gf_delta); | |
| 767 gGF_value = next_gf_value / 100.0f; | |
| 768 next_pressure_absolute += 0.1f; // 1 meter down | |
| 769 test_result = buehlmann_tissue_test_tolerance(next_pressure_absolute); | |
| 770 } | |
| 771 // | |
| 772 if(test_result) | |
| 773 { | |
| 774 // old direct paste | |
| 775 pDecoInfo->output_ceiling_meter = depth_in_meter; | |
| 776 // new sub-meter hw 160331 | |
| 777 if(depth_in_meter >= 1) | |
| 778 { | |
| 779 for(int i = 0; i < 10; i++) | |
| 780 { | |
| 781 next_gf_value += gf_delta/10.0f; | |
| 782 gGF_value = next_gf_value / 100.0f; | |
| 783 next_pressure_absolute -= 0.01f; // 0.1 meter up | |
| 784 if(!buehlmann_tissue_test_tolerance(next_pressure_absolute)) | |
| 785 { | |
| 786 pDecoInfo->output_ceiling_meter -= ((float)i)/10.0f; | |
| 787 break; | |
| 788 } | |
| 789 } | |
| 790 } | |
| 791 } | |
| 792 else | |
| 793 { | |
| 794 pDecoInfo->output_ceiling_meter = 999; | |
| 795 } | |
| 796 } | |
| 797 | |
| 798 | |
| 799 void buehlmann_relative_gradient_calculator(SLifeData* pLifeData, SDiveSettings * pDiveSettings, SDecoinfo * pDecoInfo) | |
| 800 { | |
| 801 float gf_low; | |
| 802 float gf_high; | |
| 803 float gf_delta; | |
| 804 int dv_gf_low_stop_meter; | |
| 805 | |
| 806 float rgf; // relative gradient factor by hwOS p2_deco.c | |
| 807 float temp_tissue; | |
| 808 float limit; | |
| 809 float pres_respiration; | |
| 810 float gf; | |
| 811 | |
| 812 gf_low = pDiveSettings->gf_low; | |
| 813 gf_high = pDiveSettings->gf_high; | |
| 814 | |
| 815 dv_gf_low_stop_meter = (int)((pDiveSettings->internal__pressure_first_stop_ambient_bar_as_upper_limit_for_gf_low_otherwise_zero - pLifeData->pressure_surface_bar) * 10); | |
| 816 | |
| 817 if(dv_gf_low_stop_meter < 1) | |
| 818 { | |
| 819 gf_delta = 0; | |
| 820 } | |
| 821 else | |
| 822 { | |
| 823 gf_delta = gf_high - gf_low; | |
| 824 gf_delta /= dv_gf_low_stop_meter; // gf_delta is delta for each meter now!! | |
| 825 } | |
| 826 | |
| 827 | |
| 828 limit = tissue_tolerance_without_gf_correction(&temp_tissue); | |
| 829 pres_respiration = pLifeData->pressure_ambient_bar; | |
| 830 | |
| 831 if( temp_tissue <= pres_respiration ) | |
| 832 { | |
| 833 gf = 0.0; | |
| 834 } | |
| 835 else | |
| 836 { | |
| 837 gf = (temp_tissue - pres_respiration) | |
| 838 / (temp_tissue - limit) | |
| 839 * 100.0f; | |
| 840 } | |
| 841 | |
| 842 if(dv_gf_low_stop_meter < 1) | |
| 843 { | |
| 844 rgf = gf_high; | |
| 845 } | |
| 846 else | |
| 847 { | |
| 848 float temp1 = dv_gf_low_stop_meter; | |
| 849 float temp2 = pLifeData->depth_meter; | |
| 850 | |
| 851 if (temp2 <= 0) | |
| 852 rgf = gf_high; | |
| 853 else if (temp2 >= temp1) | |
| 854 rgf = gf_low; | |
| 855 else | |
| 856 rgf = gf_low + (temp1 - temp2)*gf_delta; | |
| 857 } | |
| 858 | |
| 859 rgf = gf / rgf; | |
| 860 | |
| 861 // avoid discussions about values > 100 below next deco stop | |
| 862 if((rgf > 1.0f) && (pLifeData->depth_meter >= pDecoInfo->output_ceiling_meter)) | |
| 863 rgf = 1.0f; | |
| 864 | |
| 865 pDecoInfo->output_relative_gradient = rgf; | |
| 866 } |