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