Mercurial > public > hwos_code
annotate src/divemode.asm @ 605:5ce603c29750
gas color coding fixed
| author | heinrichsweikamp |
|---|---|
| date | Sun, 25 Nov 2018 13:21:52 +0100 |
| parents | ca4556fb60b9 |
| children | 8b250afb8bdd |
| rev | line source |
|---|---|
| 0 | 1 ;============================================================================= |
| 2 ; | |
| 604 | 3 ; File divemode.asm REFACTORED VERSION V2.99e |
| 0 | 4 ; |
| 5 ; Divemode | |
| 6 ; | |
| 7 ; Copyright (c) 2011, JD Gascuel, HeinrichsWeikamp, all right reserved. | |
| 8 ;============================================================================= | |
| 9 ; HISTORY | |
| 10 ; 2011-08-15 : [mH] moving from OSTC code | |
| 11 | |
| 604 | 12 #include "hwos.inc" ; mandatory header |
| 13 #include "shared_definitions.h" ; mailbox from/to p2_deco.c | |
| 582 | 14 #include "tft_outputs.inc" |
| 15 #include "strings.inc" | |
| 16 #include "tft.inc" | |
| 17 #include "eeprom_rs232.inc" | |
| 18 #include "isr.inc" | |
| 19 #include "math.inc" | |
| 20 #include "wait.inc" | |
| 21 #include "customview.inc" | |
| 22 #include "start.inc" | |
| 23 #include "adc_lightsensor.inc" | |
| 24 #include "ghostwriter.inc" | |
| 25 #include "i2c.inc" | |
| 26 #include "calibrate.inc" | |
| 27 #include "convert.inc" | |
| 28 | |
| 604 | 29 IFDEF _rx_functions |
| 30 #include "rx_ops.inc" | |
| 31 ENDIF | |
| 32 | |
| 0 | 33 |
| 582 | 34 extern TFT_dive_compass_heading |
| 35 extern do_line_menu | |
| 36 extern do_main_divemenu | |
| 37 extern option_save_all | |
| 38 extern init_recording_params | |
| 39 | |
| 40 | |
| 41 ;---- Private local variables ------------------------------------------------- | |
| 42 | |
| 43 CBLOCK local1 ; max size is 16 Byte !!! | |
| 44 apnoe_timeout_counter ; timeout counter for apnoe mode | |
| 45 sensor_setpoint ; sensor ppo2 in 0.01bar for deco routine | |
| 604 | 46 check_gas_num ; used in search for best gas/dil: current gas/dil number (1-5) |
| 47 check_gas_depth ; used in search for best gas/dil: current gas/dil change depth | |
| 48 check_gas_type ; used in search for best gas/dil: current gas/dil type | |
| 49 check_gas_O2_ratio ; used in search for best gas/dil: current gas/dil O2 ratio | |
| 50 best_gas_num ; used in search for best gas/dil: best gas/dil number (1-5) CAUTION: there is also a variable named best_gas_number ! | |
| 51 best_gas_depth ; used in search for best gas/dil: best gas/dil change depth | |
| 52 ppO2_min ; used in search for best gas/dil: minimum ppO2 required | |
| 53 ppO2_max ; used in search for best gas/dil: maximum ppO2 allowed | |
| 54 ENDC ; used: 10 byte, remaining: 6 byte | |
| 55 | |
| 56 CBLOCK local2 ; max size is 16 Byte !!! | |
| 57 average_depth_hold:4 ; used to calculate the resettable average depth | |
| 58 average_depth_hold_total:4 ; used to calculate the absolute average depth | |
| 59 ENDC ; used: 8 byte, remaining: 8 byte | |
| 60 | |
| 61 dmode CODE | |
| 582 | 62 |
| 63 ;============================================================================= | |
| 0 | 64 |
| 65 global diveloop | |
| 66 diveloop: | |
| 604 | 67 banksel common |
| 582 | 68 call speed_normal |
| 604 | 69 call diveloop_boot ; boot tasks for all modes |
| 70 | |
| 71 ; startup tasks for all modes | |
| 72 call TFT_boot ; initialize TFT (includes clear screen) | |
| 73 bsf FLAG_TFT_divemode_mask ; request display of dive mode mask | |
| 74 | |
| 75 movff customview_divemode,menupos3; reload last custom view | |
| 76 bsf redraw_custview_mask ; request redraw of last custom view | |
| 0 | 77 |
| 582 | 78 btfsc FLAG_apnoe_mode |
| 604 | 79 bsf realdive ; set realdive flag in apnoe mode |
| 80 | |
| 81 btfsc FLAG_apnoe_mode ; done for apnoe or gauge mode | |
| 582 | 82 bra diveloop_loop_start |
| 604 | 83 btfsc FLAG_gauge_mode ; done for apnoe or gauge mode |
| 582 | 84 bra diveloop_loop_start |
| 0 | 85 |
| 604 | 86 ; Deco modes |
| 87 bsf FLAG_TFT_active_gas_divemode; request display of gas and setpoint | |
| 88 bsf FLAG_TFT_display_ndl_mask ; request display of "NDL" | |
| 0 | 89 |
| 90 ; +@5 init | |
| 582 | 91 clrf WREG ; WAIT marker: display "---" |
| 92 movff WREG,char_I_sim_advance_time | |
| 93 movff WREG,int_O_alternate_ascenttime+0 | |
| 560 | 94 bsf WREG,int_not_yet_computed |
| 95 bsf WREG,int_invalid_flag | |
| 582 | 96 movff WREG,int_O_alternate_ascenttime+1 |
| 560 | 97 |
| 98 diveloop_loop_start: | |
| 604 | 99 btfsc FLAG_TFT_divemode_mask |
| 100 call TFT_divemode_mask | |
| 582 | 101 btfsc FLAG_TFT_display_ndl_mask |
| 102 call TFT_display_ndl_mask | |
| 560 | 103 |
| 604 | 104 diveloop_loop: ; the dive loop starts here |
| 582 | 105 btfss quarter_second_update |
| 106 bra diveloop_loop1 | |
| 107 | |
| 108 ; tasks any 1/4 second, any mode | |
| 109 bcf quarter_second_update ; clear flag | |
| 0 | 110 |
| 604 | 111 btfsc alternative_divelayout ; in alternative layout? |
| 112 bra diveloop_loop1 ; YES - no compass in alternative layout mode | |
| 113 movlw index_compass_dm ; NO - index of compass view | |
| 114 cpfseq menupos3 ; - in compass view? | |
| 115 bra diveloop_loop1 ; NO - done | |
| 116 call TFT_dive_compass_heading ; YES - update compass heading value | |
| 117 bsf FLAG_TFT_temp_divemode ; - redraw temperature (is slightly affected from compass heading arrow) | |
| 560 | 118 |
| 582 | 119 diveloop_loop1: |
| 604 | 120 btfss onesecupdate ; next second begun? |
| 121 bra diveloop_loop3 ; NO | |
| 582 | 122 |
| 0 | 123 ; tasks any new second... |
| 582 | 124 bcf onesecupdate ; one seconds update, clear flag here in case it's set again in ISR before all tasks are done. |
| 178 | 125 |
| 604 | 126 ; ###-- USE FOR DEBUG ONLY - RESETS RX CIRCUITRY --### |
| 127 ; bsf LEDg | |
| 128 ; ###----------------------------------------------### | |
| 129 | |
| 130 ; compute current depth in meters | |
| 131 SAFE_2BYTE_COPY rel_pressure,xA | |
| 132 movlw .100 | |
| 133 movwf xB+0 | |
| 134 clrf xB+1 | |
| 135 call div16x16 ; xC = xA / xB, xC+0 now holds depth in full meters | |
| 136 movff xC+0,curr_depth ; store result in curr_depth | |
| 137 | |
| 138 ; compute ambient pressure / 10, will be needed later | |
| 139 SAFE_2BYTE_COPY amb_pressure,xA | |
| 140 movlw .10 | |
| 141 movwf xB+0 | |
| 142 clrf xB+1 | |
| 143 call div16x16 ; xC = xA / xB = p_amb / 10 | |
| 144 movff xC+0,amb_press_10+0 ; store result for later use | |
| 145 movff xC+1,amb_press_10+1 ; ... | |
| 0 | 146 |
| 560 | 147 ; display depth based on full seconds interval (nicer blinking) |
| 582 | 148 btfss alternative_divelayout |
| 149 rcall TFT_output4_normal | |
| 150 btfsc alternative_divelayout | |
| 151 rcall TFT_output4_alternative | |
| 152 | |
| 604 | 153 btfsc FLAG_apnoe_mode ; in Apnoe mode? |
| 154 bra diveloop_loop1_nonedeco ; YES - do Apnoe mode every second tasks | |
| 582 | 155 |
| 560 | 156 ; tasks any new second - only for deco modes |
| 604 | 157 diveloop_loop1_deco: |
| 158 bsf FLAG_TFT_divemins ; display (new) dive time! | |
| 159 btfsc show_safety_stop ; show the safety stop? | |
| 160 bsf FLAG_TFT_show_safety_stop ; YES - show/delete if done | |
| 0 | 161 |
| 560 | 162 btfss alternative_divelayout |
| 163 rcall TFT_output1_normal | |
| 164 btfsc alternative_divelayout | |
| 165 rcall TFT_output1_alternative | |
| 0 | 166 |
| 604 | 167 call divemode_check_for_warnings ; check for warnings |
| 168 | |
| 169 IFDEF _rx_functions | |
| 170 btfss FLAG_tr_enabled ; TR functions enabled? | |
| 171 bra diveloop_loop1_deco1 ; NO - skip pressure readings part | |
| 172 call get_pressure_readings ; YES - get pressure readings | |
| 173 call configure_sac_calculation ; - set up SAC calculation | |
| 174 diveloop_loop1_deco1: | |
| 175 ENDIF | |
| 582 | 176 |
| 605 | 177 call calc_deco_divemode ; calculate decompression and set resulting display flags |
| 560 | 178 |
| 179 btfss alternative_divelayout | |
| 180 rcall TFT_output2_normal | |
| 181 btfsc alternative_divelayout | |
| 182 rcall TFT_output2_alternative | |
| 604 | 183 bra diveloop_loop2 ; continue with common tasks |
| 560 | 184 |
| 185 ; tasks any new second - only for apnoe mode | |
| 582 | 186 diveloop_loop1_nonedeco: |
| 604 | 187 rcall divemode_apnoe_tasks ; 1 sec. apnoe tasks |
| 188 call customview_second ; do every-second tasks for the custom view area | |
| 189 ;bra diveloop_loop2 ; common tasks | |
| 560 | 190 |
| 191 ; continue tasks any new second, any mode | |
| 582 | 192 diveloop_loop2: |
| 604 | 193 btfsc redraw_custview_mask ; shall we redraw the custom view mask? |
| 194 call customview_mask ; YES - redraw custom view mask | |
| 195 | |
| 196 rcall timeout_divemode ; ** menu timeout? ** - this routine sets the required flags | |
| 582 | 197 rcall set_dive_modes ; tests if depth > threshold |
| 604 | 198 rcall set_min_temp ; store min. temp if required (future hardware will need this to be checked 1/second...) |
| 0 | 199 |
| 560 | 200 btfsc oneminupdate ; one minute tasks |
| 604 | 201 rcall update_divemode60 ; update clock, etc. |
| 202 | |
| 203 btfss FLAG_oc_mode ; are we in OC mode? | |
| 204 bsf FLAG_TFT_active_gas_divemode; NO - have the gas and setpoint redrawn on every second to update setpoint display, animate the blinking, etc. | |
| 0 | 205 |
| 560 | 206 btfss alternative_divelayout |
| 207 rcall TFT_output3_normal | |
| 208 btfsc alternative_divelayout | |
| 209 rcall TFT_output3_alternative | |
| 210 | |
| 604 | 211 ; ###-- USE FOR DEBUG ONLY - RESETS RX CIRCUITRY --### |
| 212 ; bcf LEDg | |
| 213 ; ###----------------------------------------------### | |
| 0 | 214 |
| 560 | 215 ; tasks any round, any mode |
| 0 | 216 diveloop_loop3: |
| 604 | 217 call test_switches_divemode ; check switches in dive mode |
| 582 | 218 |
| 219 global diveloop_loop4 | |
| 604 | 220 diveloop_loop4: ; menu-exit returns here... |
| 221 btfsc toggle_customview ; next view? | |
| 222 call customview_toggle ; YES - show next custom view (and delete this flag) | |
| 223 | |
| 224 btfsc divemode_gaschange ; gas switch flag set? | |
| 582 | 225 call gas_switched_common ; YES |
| 0 | 226 |
| 604 | 227 btfsc toggle_gf ; toggle GF/aGF? |
| 582 | 228 rcall divemodemode_togglegf ; YES |
| 0 | 229 |
| 604 | 230 IFDEF _cave_mode |
| 231 btfsc toggle_turn_dive ; toggle dive turned? | |
| 232 rcall divemodemode_toggleturn ; YES | |
| 233 ENDIF | |
| 234 | |
| 235 btfsc FLAG_set_marker ; shall set a marker? | |
| 582 | 236 call set_logbook_marker ; YES |
| 237 | |
| 604 | 238 btfsc store_sample ; shall store new sample? |
| 239 call store_dive_data ; YES - store profile data | |
| 240 | |
| 241 btfss divemode ; dive finished? | |
| 242 goto ghostwriter_end_dive ; YES - dive finished! | |
| 83 | 243 |
| 582 | 244 btfsc pressure_refresh ; new pressure available? |
| 604 | 245 rcall set_max_depth ; YES - update max. depth if required |
| 582 | 246 btfsc pressure_refresh ; new pressure available? |
| 604 | 247 bsf FLAG_TFT_depth ; YES - update depth |
| 582 | 248 bcf pressure_refresh ; clear flag |
| 560 | 249 |
| 604 | 250 btfsc temp_changed ; temperature changed? |
| 251 bsf FLAG_TFT_temp_divemode ; YES - display temperature | |
| 252 | |
| 253 IFDEF _screendump | |
| 254 btfsc enable_screen_dumps ; screen dump function enabled? | |
| 255 call TFT_dump_screen_check ; YES - check if requested and do it | |
| 256 ENDIF | |
| 257 | |
| 258 bra diveloop_loop ; loop the dive mode | |
| 582 | 259 |
| 560 | 260 ;-------------------------------------------------------------------------------------------------------- |
| 582 | 261 |
| 604 | 262 TFT_output1_normal: ; beginning of any new second - only for deco modes |
| 582 | 263 btfsc FLAG_TFT_divemode_mask |
| 264 call TFT_divemode_mask | |
| 560 | 265 btfsc FLAG_TFT_divemins |
| 604 | 266 call TFT_divemins ; display (new) dive time! |
| 267 call customview_second ; do every-second tasks for the custom view area (in sync with the dive time) mH | |
| 560 | 268 btfsc FLAG_TFT_show_safety_stop |
| 604 | 269 call TFT_show_safety_stop ; show safety stop |
| 560 | 270 btfsc FLAG_TFT_clear_safety_stop |
| 604 | 271 call TFT_clear_safety_stop ; clear safety stop |
| 560 | 272 return |
| 582 | 273 |
| 604 | 274 TFT_output1_alternative: ; beginning of any new second - only for deco modes |
| 275 btfsc FLAG_TFT_divemode_mask_alt | |
| 276 call TFT_divemode_mask_alternative ; alternative mask | |
| 560 | 277 btfsc FLAG_TFT_divemins |
| 604 | 278 call TFT_divemins_alternative ; display (new) divetime! |
| 279 call customview_alternative_second ; do every-second tasks for the custom view area (in sync with the dive time) mH | |
| 588 | 280 btfsc FLAG_TFT_big_deco_alt |
| 604 | 281 call TFT_big_deco_alt ; big deco, also manages alternative safety stop thus moved to first wave of outputs [rl] |
| 560 | 282 return |
| 582 | 283 |
| 604 | 284 TFT_output2_normal: ; any new second - only for deco modes |
| 582 | 285 btfsc FLAG_TFT_display_ndl_mask |
| 286 call TFT_display_ndl_mask | |
| 287 btfsc FLAG_TFT_display_ndl | |
| 288 call TFT_display_ndl | |
| 560 | 289 btfsc FLAG_TFT_display_deko_mask |
| 290 call TFT_display_deko_mask | |
| 291 btfsc FLAG_TFT_display_deko | |
| 292 call TFT_display_deko | |
| 293 btfsc FLAG_TFT_display_tts | |
| 294 call TFT_display_tts | |
| 295 return | |
| 0 | 296 |
| 604 | 297 TFT_output2_alternative: ; any new second - only for deco modes |
| 560 | 298 return |
| 582 | 299 |
| 604 | 300 TFT_output3_normal: ; tasks any new second, any mode, after deco calculations |
| 560 | 301 btfsc FLAG_TFT_max_depth |
| 604 | 302 call TFT_max_depth ; use normal max. depth |
| 560 | 303 btfsc FLAG_TFT_divemode_warning |
| 304 call TFT_divemode_warning | |
| 305 btfsc FLAG_TFT_divemode_warning_clear | |
| 306 call TFT_divemode_warning_clear | |
| 307 btfsc FLAG_TFT_dive_warning_text_clear | |
| 604 | 308 call TFT_clear_warning_text ; clear complete warnings area |
| 582 | 309 btfsc FLAG_TFT_dive_warning_text_clr2 |
| 604 | 310 call TFT_clear_warning_text_2nd_row ; clear 2nd row of warnings |
| 560 | 311 return |
| 582 | 312 |
| 604 | 313 TFT_output3_alternative: ; tasks any new second |
| 314 btfsc FLAG_TFT_max_depth | |
| 315 call TFT_max_depth_alternative ; big max. depth | |
| 560 | 316 btfsc FLAG_TFT_dive_warning_text_clear |
| 604 | 317 call TFT_clear_warning_text ; clear complete warnings area (in alt mode only 2nd row...) |
| 560 | 318 return |
| 319 | |
| 604 | 320 TFT_output4_normal: ; tasks any round, any mode, before deco calculations (stable timebase) |
| 560 | 321 btfsc FLAG_TFT_depth |
| 604 | 322 call TFT_depth ; display depth |
| 323 btfsc FLAG_TFT_active_gas_divemode | |
| 324 call TFT_active_gas_divemode ; display gas/setpoint | |
| 582 | 325 btfsc FLAG_TFT_temp_divemode |
| 604 | 326 call TFT_temp_divemode ; update temperature |
| 560 | 327 return |
| 582 | 328 |
| 604 | 329 TFT_output4_alternative: ; tasks any round, any mode |
| 582 | 330 btfsc FLAG_TFT_depth |
| 604 | 331 call TFT_depth ; display new depth |
| 560 | 332 return |
| 582 | 333 |
| 334 | |
| 0 | 335 ;-------------------------------------------------------------------------------------------------------- |
| 336 | |
| 604 | 337 divemode_apnoe_tasks: ; 1 sec. apnoe tasks |
| 338 call TFT_display_apnoe_descent ; show descent timer | |
| 560 | 339 call TFT_max_depth ; use normal max. depth |
| 0 | 340 |
| 604 | 341 btfsc divemode2 ; time running? |
| 342 bra divemode_apnoe_tasks2 ; YES - new descent, reset data if flag is set | |
| 0 | 343 |
| 344 rcall apnoe_calc_maxdepth | |
| 345 call TFT_display_apnoe_surface | |
| 604 | 346 call TFT_display_apnoe_last_max ; show last max. depth |
| 0 | 347 incf apnoe_surface_secs,F |
| 348 movlw d'60' | |
| 349 cpfseq apnoe_surface_secs | |
| 350 bra divemode_apnoe_tasks1 | |
| 351 clrf apnoe_surface_secs | |
| 352 incf apnoe_surface_mins,F | |
| 353 | |
| 582 | 354 divemode_apnoe_tasks1: |
| 604 | 355 bcf FLAG_active_descent ; clear flag |
| 356 btfsc divemode2 ; time running? | |
| 357 return ; YES - return | |
| 358 bsf FLAG_active_descent ; set flag | |
| 0 | 359 return |
| 360 | |
| 361 divemode_apnoe_tasks2: | |
| 604 | 362 btfss FLAG_active_descent ; are we descending? |
| 363 return ; NO - we are at the surface | |
| 364 rcall apnoe_calc_maxdepth ; YES | |
| 365 call TFT_apnoe_clear_surface ; clear surface timer | |
| 366 clrf apnoe_timeout_counter ; delete timeout | |
| 0 | 367 clrf apnoe_surface_secs |
| 368 clrf apnoe_surface_mins | |
| 369 clrf apnoe_secs | |
| 604 | 370 clrf apnoe_mins ; reset descent time |
| 0 | 371 movlw .0 |
| 372 movff WREG,max_pressure+0 | |
| 604 | 373 movff WREG,max_pressure+1 ; reset max. depth |
| 374 bcf FLAG_active_descent ; clear flag | |
| 0 | 375 return |
| 376 | |
| 377 global apnoe_calc_maxdepth | |
| 378 apnoe_calc_maxdepth: | |
| 379 movff apnoe_max_pressure+0,sub_a+0 | |
| 380 movff apnoe_max_pressure+1,sub_a+1 | |
| 381 movff max_pressure+0,sub_b+0 | |
| 382 movff max_pressure+1,sub_b+1 | |
| 560 | 383 call subU16 ; sub_c = sub_a - sub_b |
| 604 | 384 ; apnoe_max_pressure < max_pressure -> neg_flag=1 |
| 385 ; max_pressure <= apnoe_max_pressure -> neg_flag=0 | |
| 582 | 386 btfss neg_flag |
| 0 | 387 return |
| 560 | 388 ;apnoe_max_pressure<max_pressure |
| 0 | 389 movff max_pressure+0,apnoe_max_pressure+0 |
| 390 movff max_pressure+1,apnoe_max_pressure+1 | |
| 391 return | |
| 392 | |
| 560 | 393 ; -------------------------------------------------------------------------------------- |
| 0 | 394 |
| 605 | 395 calc_deco_divemode: |
| 604 | 396 btfss FLAG_gauge_mode ; in gauge mode? |
| 397 rcall calc_deko_engine ; NO - do deco calculations | |
| 398 | |
| 399 ; Increment the time accumulators used for calculating the average depths. | |
| 400 ; This done here and not in the ISR to guarantee synchronism between time | |
| 401 ; and depth accumulator incrementing. | |
| 402 infsnz average_divesecs+0,F | |
| 403 incf average_divesecs+1,F | |
| 404 infsnz average_divesecs_total+0,F | |
| 405 incf average_divesecs_total+1,F | |
| 406 | |
| 407 btg onesectoggle ; toggle the one-second toggle bit | |
| 408 btfss onesectoggle ; toggle bit set? | |
| 409 bra calc_deko_divemode2 ; NO | |
| 410 ;bra calc_deko_divemode1 ; YES | |
| 411 | |
| 412 calc_deko_divemode1: ; every-2-seconds tasks, 1st phase | |
| 413 ; call TFT_debug_output ; optional debug output | |
| 414 btfsc FLAG_gauge_mode ; in gauge mode? | |
| 415 return ; YES - done | |
| 416 goto check_gas_best ; NO - checks if a better gas should be selected (by user) and return | |
| 417 | |
| 418 calc_deko_divemode2: ; every-2-seconds tasks, 2nd phase | |
| 560 | 419 call calc_average_depth ; calculate average depth |
| 420 call calc_velocity ; calculate vertical velocity and display if > threshold (every two seconds) | |
| 604 | 421 goto set_reset_safety_stop ; set/reset flags for safety stop and return |
| 422 | |
| 423 | |
| 424 calc_deko_engine: | |
| 425 btfsc FLAG_ccr_mode ; in CCR mode? | |
| 426 call check_dive_autosp ; YES - check for Auto-SP | |
| 427 | |
| 428 btfsc FLAG_ccr_mode ; in CCR mode? | |
| 429 rcall calc_deko_divemode_sensor ; YES - do sensor data acquisition if applicable by OSTC model | |
| 430 | |
| 431 btfsc FLAG_pscr_mode ; in pSCR mode? | |
| 432 rcall calc_deko_divemode_sensor ; YES - do sensor data acquisition if applicable by OSTC model | |
| 0 | 433 |
| 195 | 434 |
| 560 | 435 ; check deco engine state and switch between normal and alternative plan calculations |
| 436 ; | |
| 437 ; Remark: Any reconfigurations done here do only affect the ascent & deco calculation settings, | |
| 604 | 438 ; not the settings for the calculations done on the real tissues. The later ones are only |
| 439 ; altered in case of a gas change, or in case of a real bailout or switchback to setpoint | |
| 440 ; or sensor, respectively. | |
| 441 ; In case of a gas change or real bailout/switchback, the settings for the deco calculations | |
| 442 ; are also changed to match the settings for the real tissues. This is done on signal through | |
| 443 ; 'divemode_gaschange' and will also leave the deco engine status in state as if having done | |
| 444 ; the alternative plan last. | |
| 445 | |
| 446 ; get working copies of char_O_main_status and char_O_deco_status | |
| 447 movff char_O_main_status,hi ; get char_O_main_status into hi | |
| 448 movff char_O_deco_status,lo ; get char_O_deco_status into lo | |
| 449 | |
| 450 ; check state of deco calculations | |
| 451 btfsc hi,DECO_COMPLETED_NORM ; finished calculations for normal plan? | |
| 452 bra calc_deko_engine_alt ; YES - do an alternative plan next (or a normal one with more features enabled) | |
| 453 btfsc hi,DECO_COMPLETED_ALT ; finished calculations for alternative plan? | |
| 454 bra calc_deko_engine_norm ; YES - do a normal plan next | |
| 455 bra calc_deko_engine_cont ; NO to both - continue calculations / do first invocation in INIT mode | |
| 456 | |
| 457 calc_deko_engine_norm: | |
| 458 ; Last cycle did an alternative plan, or the deco engine has been restarted because of a gas change etc. | |
| 459 ; --> Reconfigure to normal plan for next computation cycle. | |
| 460 bcf lo,DECO_PLAN_FLAG ; clear flag for alternative plan to do a normal plan next | |
| 461 bcf lo,DECO_ASCENT_FLAG ; clear flag for delayed ascent calculation | |
| 462 bcf lo,DECO_VOLUME_FLAG ; clear flag for gas needs calculation | |
| 463 bcf lo,DECO_BAILOUT_FLAG ; clear flag for bailout mode | |
| 464 IFDEF _cave_mode | |
| 465 bcf hi,DECO_CAVE_MODE ; clear flag for cave mode | |
| 466 ENDIF | |
| 467 | |
| 468 btfsc FLAG_ccr_mode ; in CCR mode? | |
| 469 bra calc_deko_engine_norm_loop ; YES - reload diluents and reconfigure CCR mode if not in bailout | |
| 470 btfsc FLAG_pscr_mode ; in pSCR mode? | |
| 471 bra calc_deko_engine_norm_loop ; YES - reload diluents and reconfigure pSCR mode if not in bailout | |
| 472 ;bra calc_deko_engine_norm_OC ; neither in CCR nor pSCR mode, so reload OC gases and reconfigure OC mode | |
| 473 ; (first cycle omits gas needs calculation for faster first deco results) | |
| 474 calc_deko_engine_norm_OC: | |
| 475 movff active_gas,WREG ; get current OC gas | |
| 476 call deco_setup_oc_gases_pre ; set up deco calculations in OC mode with OC gases | |
| 477 bra calc_deko_engine_start ; start deco engine | |
| 478 | |
| 479 calc_deko_engine_norm_loop: ; switch to loop calculation if not in a real bailout situation | |
| 480 btfsc FLAG_bailout_mode ; check if a real bailout situation is present | |
| 481 bra calc_deko_engine_norm_OC ; YES - revert to OC mode | |
| 482 ; NO - switch to loop calculation: | |
| 483 movff active_dil,WREG ; - get current diluent | |
| 484 call deco_setup_cc_diluents_pre ; - set up deco calculations in CCR/pSCR mode with diluents | |
| 485 bra calc_deko_engine_start ; - start deco engine | |
| 486 | |
| 487 calc_deko_engine_alt: | |
| 488 ; A normal plan was computed in the last cycle. For the next calculation cycle the mode may be switched | |
| 489 ; to alternative plan, or stay in normal plan but with certain features enabled... | |
| 490 bcf lo,DECO_ASCENT_FLAG ; clear flag for delayed ascent calculation | |
| 491 bcf lo,DECO_VOLUME_FLAG ; clear flag for gas needs calculation | |
| 492 bcf lo,DECO_BAILOUT_FLAG ; clear flag for bailout mode | |
| 493 IFDEF _cave_mode | |
| 494 bcf hi,DECO_CAVE_MODE ; clear flag for cave mode | |
| 495 ENDIF | |
| 496 | |
| 497 btfsc FLAG_bailout_mode ; check if a real bailout situation is present | |
| 498 bra calc_deko_engine_alt_1 ; YES - stay in normal plan mode and preclude delayed ascent calculation | |
| 499 TSTOSS char_I_extra_time ; NO - check if a delayed ascent is enabled | |
| 500 bra calc_deko_engine_alt_1 ; NO - stay in normal plan mode and preclude delayed ascent calculation | |
| 501 bsf lo,DECO_PLAN_FLAG ; YES - set flag for alternative plan | |
| 502 bsf lo,DECO_ASCENT_FLAG ; - set flag for delayed ascent | |
| 503 | |
| 504 calc_deko_engine_alt_1: | |
| 505 TSTOSS opt_calc_asc_gasvolume ; check if gas volume calculation is enabled | |
| 506 bra calc_deko_engine_start ; NO - no volume calculation, no simulated bailout plan in this case | |
| 507 bsf lo,DECO_VOLUME_FLAG ; YES - set gas needs calculation flag | |
| 508 | |
| 509 btfsc FLAG_bailout_mode ; check if a real bailout situation is present | |
| 510 bra calc_deko_engine_start ; YES - normal plan already does bailout (OC) calculation "for real" | |
| 511 | |
| 512 IFDEF _cave_mode | |
| 513 bsf hi,DECO_CAVE_MODE ; activate cave mode by default | |
| 514 btfss FLAG_cave_mode ; cave mode switched on? | |
| 515 bcf hi,DECO_CAVE_MODE ; NO - deactivate p2deco cave mode again | |
| 516 btfsc FLAG_dive_turned ; dive turned? | |
| 517 bcf hi,DECO_CAVE_MODE ; YES - deactivate p2deco cave mode again | |
| 518 btfsc FLAG_cave_mode_shutdown ; cave mode function shut down? | |
| 519 bcf hi,DECO_CAVE_MODE ; YES - deactivate p2deco cave mode again | |
| 520 ENDIF | |
| 521 | |
| 522 btfss lo,DECO_MODE_LOOP_FLAG ; NO - has a loop mode calculation been done during the normal plan? | |
| 523 bra calc_deko_engine_start ; NO - when not in loop mode, no simulated bailout to be done | |
| 524 decf best_gas_number,W ; YES - get best gas number -1 into WREG. If not available, WREG will be 255 now. If not computed yet, WREG will be 254 now. | |
| 525 btfsc WREG,7 ; - WREG < 128 (a bailout gas is available)? | |
| 526 bra calc_deko_engine_alt_2 ; NO - no simulated bailout possible because no bailout gas available to switch to | |
| 527 bsf lo,DECO_PLAN_FLAG ; YES - set flag for alternative plan | |
| 528 bsf lo,DECO_BAILOUT_FLAG ; - set bailout mode flag (enables gas changes before 1st stop) | |
| 529 movf best_gas_number,W ; - put number of best gas into WREG | |
| 530 call deco_setup_oc_gases_pre ; - set up deco calculations in OC mode with OC gases | |
| 531 bra calc_deko_engine_start ; - start in alternative plan mode | |
| 532 | |
| 533 calc_deko_engine_alt_2: | |
| 560 | 534 bcf lo,DECO_PLAN_FLAG ; clear flag for alternative plan |
| 535 bcf lo,DECO_ASCENT_FLAG ; clear flag for delayed ascent calculation | |
| 536 bcf lo,DECO_VOLUME_FLAG ; clear flag for gas needs calculation | |
| 604 | 537 IFDEF _cave_mode |
| 538 bcf hi,DECO_CAVE_MODE ; clear flag for cave mode | |
| 539 ENDIF | |
| 540 call inval_alternative_plan_data ; invalidate all alternative (bailout) plan data because they are not applicable any more | |
| 541 | |
| 542 calc_deko_engine_start: | |
| 543 IFDEF _cave_mode | |
| 544 movff hi,char_O_main_status ; write-back char_O_main_status to deco engine interface | |
| 545 ENDIF | |
| 560 | 546 movff lo,char_O_deco_status ; write-back char_O_deco_status to deco engine interface |
| 0 | 547 |
| 604 | 548 calc_deko_engine_cont: |
| 549 SAFE_2BYTE_COPY amb_pressure,int_I_pres_respiration ; transfer ambient pressure to deco engine | |
| 550 clrf TMR5L ; restart timer used to preempt stops calculation | |
| 551 clrf TMR5H ; | |
| 552 call deco_calc_hauptroutine ; invoke the deco engine (p2_deco.c) | |
| 582 | 553 banksel common |
| 0 | 554 |
| 605 | 555 ; the displayed gas may need a different color-coding |
| 556 bsf FLAG_TFT_active_gas_divemode; redraw gas/setpoint/diluent | |
| 557 | |
| 604 | 558 ; check if display shall be updated due to deco engine restart |
| 559 btfsc FLAG_TFT_display_ndl_or_deko; shall update immediately? | |
| 560 bra calc_deko_engine_update ; YES | |
| 561 | |
| 562 ; check if new calculation results for normal plan mode are available | |
| 563 movff char_O_main_status,WREG ; get deco status of deco engine | |
| 564 btfss WREG,DECO_COMPLETED_NORM ; new calculation results for normal plan available? | |
| 565 return ; NO - done | |
| 605 | 566 |
| 604 | 567 calc_deko_engine_update: |
| 568 bcf FLAG_TFT_display_ndl_or_deko; YES - reset flag for immediate update | |
| 569 movff char_O_deco_info,WREG ; - get deco info vector | |
| 570 btfsc WREG,deco_ceiling ; - ceiling depth > 0 ? | |
| 571 bra calc_deko_engine_update_deco; YES - in deco | |
| 572 ;bra calc_deko_engine_update_NDL ; NO - within NDL | |
| 573 | |
| 574 calc_deko_engine_update_NDL: ; within NDL | |
| 575 btfsc decostop_active ; been in deco mode before? | |
| 576 bsf FLAG_TFT_display_ndl_mask ; YES - clear deco data, display NDL time | |
| 582 | 577 bsf FLAG_TFT_display_ndl ; display NDL time |
| 604 | 578 bcf decostop_active ; clear flag for been in deco mode before |
| 560 | 579 return |
| 0 | 580 |
| 604 | 581 calc_deko_engine_update_deco: ; in deco |
| 582 btfss decostop_active ; already been in deco mode before? | |
| 582 | 583 bsf FLAG_TFT_display_deko_mask ; NO - clear NDL time, display deco data |
| 584 bsf FLAG_TFT_display_deko ; display deco data | |
| 585 bsf FLAG_TFT_display_tts ; display TTS | |
| 604 | 586 bsf decostop_active ; set flag for being in deco mode |
| 560 | 587 return |
| 588 | |
| 589 ; -------------------------------------------------------------------------------------- | |
| 0 | 590 |
| 560 | 591 global calc_deko_divemode_sensor |
| 592 calc_deko_divemode_sensor: | |
| 593 ; sensor acquisition code | |
| 582 | 594 btfss s8_digital ; check if we have a digital interface to the sensors |
| 595 bra calc_deko_divemode_sensor_analog ; NO - check if we have an analog interface | |
| 596 btfss new_s8_data_available ; YES - check if a new data frame was received | |
| 604 | 597 bra calc_deko_divemode_sensor_common ; NO - use old values |
| 582 | 598 call compute_mvolts_for_all_sensors ; YES - compute mV values from digital data |
| 599 bra calc_deko_divemode_sensor_common | |
| 604 | 600 calc_deko_divemode_sensor_analog: |
| 601 btfss analog_o2_input ; do we have an analog input? | |
| 602 bra calc_deko_divemode_sensor_opt ; NO - check if we have an optical interface | |
| 603 call get_analog_inputs ; YES - get the analog voltages and continue with the common part | |
| 604 bra calc_deko_divemode_sensor_common | |
| 583 | 605 calc_deko_divemode_sensor_opt: |
| 604 | 606 btfss optical_input ; do we have an optical input? |
| 607 return ; NO - return (we have no sensors at all: not analog, not S8 and not optical) | |
| 608 btfss sensor1_active ; YES - o2_ppo2_sensor1, o2_ppo2_sensor2 and o2_ppo2_sensor3 are already filled in ISR | |
| 609 bcf use_O2_sensor1 ; check HUD status data and eventually clear use_O2_sensorX | |
| 610 btfss sensor2_active | |
| 611 bcf use_O2_sensor2 | |
| 583 | 612 btfss sensor3_active |
| 604 | 613 bcf use_O2_sensor3 |
| 614 bra calc_deko_divemode_sensor_A ; continue with calculating sensor average | |
| 560 | 615 |
| 616 calc_deko_divemode_sensor_common: | |
| 604 | 617 ; Check each sensor if it is calibrated and if its mV value is within min_mv and max_mv limits. |
| 618 ; If ok: compute o2_ppo2_sensorX = o2_mv_sensorX * opt_x_sX / 1000 | |
| 582 | 619 ; If not ok: reset o2_ppo2_sensorX, reset use_O2_sensorX and show the customview 1 in case the sensor was ok before |
| 0 | 620 |
| 604 | 621 ; check sensor 1 |
| 582 | 622 btfss sensor1_calibrated_ok ; check if sensor is usable at all |
| 623 bra check_sensor_1_fail ; NO - handle it as failed | |
| 604 | 624 ; check min threshold |
| 625 movff o2_mv_sensor1+0,sub_a+0 ; load sensor mV value | |
| 626 movff o2_mv_sensor1+1,sub_a+1 | |
| 627 rcall check_min_threshold | |
| 582 | 628 btfsc neg_flag ; check if result is negative, i.e. sensor_mv < min_mv |
| 629 bra check_sensor_1_fail ; YES - declare sensor as failed | |
| 604 | 630 ; check max_threshold |
| 631 rcall check_max_threshold | |
| 582 | 632 btfss neg_flag ; check if result is negative, i.e. sensor_mv < max_mv |
| 633 bra check_sensor_1_fail ; NO - declare sensor as failed | |
| 604 | 634 ; check HUD data, if available |
| 582 | 635 btfss hud_connection_ok ; check if there is a HUD connected |
| 636 bra check_sensor_1_ok ; NO - all checks done then and positive | |
| 604 | 637 btfss sensor1_active ; YES - HUD status ok? |
| 638 bra check_sensor_1_fail ; NO - HUD reports a fail | |
| 560 | 639 check_sensor_1_ok: |
| 604 | 640 ; o2_ppo2_sensor1 = o2_mv_sensor1:2 * opt_x_s1:2 / 1000 |
| 560 | 641 movff o2_mv_sensor1+0,xA+0 |
| 642 movff o2_mv_sensor1+1,xA+1 | |
| 643 movff opt_x_s1+0,xB+0 | |
| 644 movff opt_x_s1+1,xB+1 | |
| 645 rcall compute_ppo2_helper | |
| 604 | 646 movff xC+0,o2_ppo2_sensor1 ; result in 0.01 bar |
| 582 | 647 bra check_sensor_2 ; continue with next sensor |
| 560 | 648 check_sensor_1_fail: |
| 649 clrf WREG | |
| 582 | 650 movff WREG,o2_ppo2_sensor1 ; set ppO2 reading to zero |
| 651 btfss use_O2_sensor1 ; check if sensor was in use before | |
| 652 bra check_sensor_1_fail_1 ; NO - no new news then | |
| 653 call check_sensor_custview_helper; YES - show customview 1 (sensor values) on further conditions met | |
| 560 | 654 check_sensor_1_fail_1: |
| 582 | 655 bcf use_O2_sensor1 ; revoke sensor from usage |
| 604 | 656 |
| 657 check_sensor_2: ; check min_mv of sensor 2 | |
| 582 | 658 btfss sensor2_calibrated_ok ; check if sensor is usable at all |
| 659 bra check_sensor_2_fail ; NO - handle it as failed | |
| 604 | 660 ; check min threshold |
| 661 movff o2_mv_sensor2+0,sub_a+0 ; load sensor mV value | |
| 662 movff o2_mv_sensor2+1,sub_a+1 | |
| 663 rcall check_min_threshold | |
| 582 | 664 btfsc neg_flag ; check if result is negative, i.e. sensor_mv < min_mv |
| 665 bra check_sensor_2_fail ; YES - declare sensor as failed | |
| 604 | 666 ; check max_threshold |
| 667 rcall check_max_threshold | |
| 582 | 668 btfss neg_flag ; check if result is nagative, i.e. sensor_mv < max_mv |
| 669 bra check_sensor_2_fail ; NO - declare sensor as failed | |
| 604 | 670 ; check HUD data, if available |
| 582 | 671 btfss hud_connection_ok ; check if there is a HUD connected |
| 672 bra check_sensor_2_ok ; NO - all checks done then and positive | |
| 604 | 673 btfss sensor2_active ; YES - HUD status ok? |
| 674 bra check_sensor_2_fail ; NO - HUD reports a fail | |
| 560 | 675 check_sensor_2_ok: |
| 604 | 676 ; o2_ppo2_sensor2 = o2_mv_sensor2:2 * opt_x_s2:2 / 1000 |
| 560 | 677 movff o2_mv_sensor2+0,xA+0 |
| 678 movff o2_mv_sensor2+1,xA+1 | |
| 679 movff opt_x_s2+0,xB+0 | |
| 680 movff opt_x_s2+1,xB+1 | |
| 681 rcall compute_ppo2_helper | |
| 604 | 682 movff xC+0,o2_ppo2_sensor2 ; result in 0.01 bar |
| 582 | 683 bra check_sensor_3 ; continue with next sensor |
| 560 | 684 check_sensor_2_fail: |
| 685 clrf WREG | |
| 582 | 686 movff WREG,o2_ppo2_sensor2 ; set ppO2 reading to zero |
| 687 btfss use_O2_sensor2 ; check if sensor was in use before | |
| 688 bra check_sensor_2_fail_1 ; NO - no new news then | |
| 689 call check_sensor_custview_helper; YES - show customview 1 (sensor values) on further conditions met | |
| 560 | 690 check_sensor_2_fail_1: |
| 582 | 691 bcf use_O2_sensor2 ; revoke sensor from usage |
| 604 | 692 |
| 693 check_sensor_3: ; check min_mv of sensor 2 | |
| 582 | 694 btfss sensor3_calibrated_ok ; check if sensor is usable at all |
| 695 bra check_sensor_3_fail ; NO - handle it as failed | |
| 604 | 696 ; check min threshold |
| 697 movff o2_mv_sensor3+0,sub_a+0 ; load sensor mV value | |
| 698 movff o2_mv_sensor3+1,sub_a+1 | |
| 699 rcall check_min_threshold | |
| 582 | 700 btfsc neg_flag ; check if result is negative, i.e. sensor_mv < min_mv |
| 701 bra check_sensor_3_fail ; YES - declare sensor as failed | |
| 604 | 702 ; check max threshold |
| 703 rcall check_max_threshold | |
| 582 | 704 btfss neg_flag ; check if result is negative, i.e. sensor_mv < max_mv |
| 705 bra check_sensor_3_fail ; NO - declare sensor as failed | |
| 604 | 706 ; check HUD data, if available |
| 582 | 707 btfss hud_connection_ok ; check if there is a HUD connected |
| 708 bra check_sensor_3_ok ; NO - all checks done then and positive | |
| 604 | 709 btfss sensor3_active ; YES - HUD status ok? |
| 710 bra check_sensor_3_fail ; NO - HUD reports a fail | |
| 560 | 711 check_sensor_3_ok: |
| 604 | 712 ; o2_ppo2_sensor3 = o2_mv_sensor3:2 * opt_x_s1:2 / 1000 |
| 560 | 713 movff o2_mv_sensor3+0,xA+0 |
| 714 movff o2_mv_sensor3+1,xA+1 | |
| 715 movff opt_x_s3+0,xB+0 | |
| 716 movff opt_x_s3+1,xB+1 | |
| 717 rcall compute_ppo2_helper | |
| 604 | 718 movff xC+0,o2_ppo2_sensor3 ; result in 0.01 bar |
| 719 bra calc_deko_divemode_sensor_A ; continue with calculating sensor average | |
| 560 | 720 check_sensor_3_fail: |
| 721 clrf WREG | |
| 582 | 722 movff WREG,o2_ppo2_sensor3 ; set ppO2 reading to zero |
| 723 btfss use_O2_sensor3 ; check if sensor was in use before | |
| 724 bra check_sensor_3_fail_1 ; NO - no new news then | |
| 604 | 725 call check_sensor_custview_helper; YES - show custom view 1 (sensor values) on further conditions met |
| 560 | 726 check_sensor_3_fail_1: |
| 582 | 727 bcf use_O2_sensor3 ; revoke sensor from usage |
| 604 | 728 |
| 729 calc_deko_divemode_sensor_A: ; calculate sensor average | |
| 730 ; exit here if not in dive mode | |
| 560 | 731 btfss divemode |
| 732 return | |
| 733 | |
| 604 | 734 ; compute sensor_setpoint = average of all o2_ppo2_sensorX of those sensors that have use_O2_sensorX == true |
| 582 | 735 ; sum up sensor values (in xA:2) and active sensors in (xB:2) |
| 736 clrf xB+0 | |
| 737 clrf xB+1 | |
| 738 clrf xA+0 | |
| 739 clrf xA+1 | |
| 604 | 740 divemode_setup_sensor_1_value: |
| 741 btfss use_O2_sensor1 ; sensor1 active? | |
| 742 bra divemode_setup_sensor_2_value ; NO | |
| 582 | 743 movf o2_ppo2_sensor1,W |
| 604 | 744 addwf xA+0,F |
| 582 | 745 movlw .0 |
| 604 | 746 addwfc xA+1,F ; add into xA:2 |
| 747 incf xB+0,F ; add a sensor | |
| 748 divemode_setup_sensor_2_value: | |
| 749 btfss use_O2_sensor2 ; sensor2 active? | |
| 750 bra divemode_setup_sensor_3_value ; NO | |
| 582 | 751 movf o2_ppo2_sensor2,W |
| 604 | 752 addwf xA+0,F |
| 582 | 753 movlw .0 |
| 604 | 754 addwfc xA+1,F ; add into xA:2 |
| 755 incf xB+0,F ; add a sensor | |
| 756 divemode_setup_sensor_3_value: | |
| 757 btfss use_O2_sensor3 ; sensor3 active? | |
| 758 bra divemode_setup_sensor_mean ; NO | |
| 582 | 759 movf o2_ppo2_sensor3,W |
| 604 | 760 addwf xA+0,F |
| 582 | 761 movlw .0 |
| 604 | 762 addwfc xA+1,F ; add into xA:2 |
| 763 incf xB+0,F ; add a sensor | |
| 764 | |
| 765 ; divide sum of sensor values by number of active sensors found | |
| 766 divemode_setup_sensor_mean: | |
| 767 clrf xC+0 ; set zero as default result | |
| 768 tstfsz xB+0 ; pending div/0 ? | |
| 769 call div16x16 ; NO - execute xC = xA / xB = summed ppO2 / number of sensors | |
| 770 movff xC+0,sensor_setpoint ; copy result (or its default) | |
| 771 | |
| 772 ; set default value for pSCR mode: 0 => let p2_deco.c compute the ppO2 based on current dil gas and depth | |
| 560 | 773 ; will be overwritten later in case we are in sensor mode and have at least one usable sensor |
| 604 | 774 clrf WREG ; preload a zero |
| 775 btfsc FLAG_pscr_mode ; check if we are in pSCR mode | |
| 776 movff WREG,char_I_const_ppO2 ; YES - write 0 to char_I_const_ppo2, | |
| 777 ; it will be overwritten if we have a usable sensor reading | |
| 778 btfsc FLAG_bailout_mode ; check if we are in bailout | |
| 779 bra calc_deko_divemode_sensor_V ; YES - no sensor data transfer to char_I_const_ppO2 in this case | |
| 780 movff opt_ccr_mode,WREG ; NO - get mode (0: Fixed SP, 1: Sensor, 2: Auto SP) | |
| 781 sublw .1 ; - in sensor mode? | |
| 782 bnz calc_deko_divemode_sensor_V ; NO - not in sensor mode - no transfer of sensor data to char_I_const_ppO2 | |
| 783 tstfsz xB+0 ; YES - check if we have found at least one usable sensor | |
| 784 bra divemode_setup_sensor_mean1 ; YES - we have at least one usable sensor | |
| 785 bsf setpoint_fallback ; NO - we have NO usable sensors -> initiate fallback | |
| 786 btfss FLAG_ccr_mode ; - check if we are in CCR mode | |
| 787 bra calc_deko_divemode_sensor_V ; NO - continue with voting logic flags | |
| 788 movff char_I_setpoint_cbar+0,char_I_const_ppO2; YES - select fixed setpoint no. 1 for fallback | |
| 789 bra calc_deko_divemode_sensor_V ; - continue with voting logic flags | |
| 790 ; we have at least one usable sensor with a ppO2 value > 0 | |
| 791 divemode_setup_sensor_mean1: | |
| 792 bcf setpoint_fallback ; clear fallback condition | |
| 560 | 793 movff sensor_setpoint,char_I_const_ppO2 ; transfer average sensor value to p2_deco.c code |
| 604 | 794 ; vote sensors |
| 795 calc_deko_divemode_sensor_V: | |
| 582 | 796 bsf voting_logic_sensor1 |
| 797 movff o2_ppo2_sensor1,lo | |
| 798 rcall check_sensor_voting_helper | |
| 604 | 799 tstfsz WREG ; sensor within range (WREG = 0)? |
| 800 bcf voting_logic_sensor1 ; NO - vote out this sensor | |
| 560 | 801 |
| 582 | 802 bsf voting_logic_sensor2 |
| 803 movff o2_ppo2_sensor2,lo | |
| 804 rcall check_sensor_voting_helper | |
| 604 | 805 tstfsz WREG ; sensor within range (WREG = 0)? |
| 806 bcf voting_logic_sensor2 ; NO - vote out this sensor | |
| 560 | 807 |
| 582 | 808 bsf voting_logic_sensor3 |
| 809 movff o2_ppo2_sensor3,lo | |
| 810 rcall check_sensor_voting_helper | |
| 604 | 811 tstfsz WREG ; sensor within range (WREG = 0)? |
| 812 bcf voting_logic_sensor3 ; NO - vote out this sensor | |
| 582 | 813 |
| 560 | 814 ; check if a warning shall be issued on sensor disagreement |
| 582 | 815 btfsc FLAG_ccr_mode ; check if we are in CCR mode |
| 604 | 816 bra check_warn_sensor_0 ; YES - continue with further checks |
| 582 | 817 btfsc FLAG_pscr_mode ; check if we are in pSCR mode |
| 604 | 818 bra check_warn_sensor_0 ; YES - continue with further checks |
| 819 bra check_warn_sensor_done ; not in CCR and not in pSCR, so no warning | |
| 820 check_warn_sensor_0: ; we are in CCR or pSCR mode | |
| 821 btfsc FLAG_bailout_mode ; check if we are in bailout | |
| 822 bra check_warn_sensor_done ; YES - no warning in this case | |
| 823 movff opt_ccr_mode,WREG ; get mode (0: Fixed SP, 1: Sensor, 2: Auto SP) | |
| 824 sublw .1 ; in sensor mode? | |
| 825 bnz check_warn_sensor_done ; NO - not in sensor mode - no warning in this case | |
| 826 ; check sensor 1 | |
| 827 check_warn_sensor_1: | |
| 582 | 828 btfss sensor1_calibrated_ok ; check if sensor has a valid calibration |
| 829 bra check_warn_sensor_2 ; NO - sensor can not cause a warning then | |
| 830 btfss use_O2_sensor1 ; YES - check if sensor is in use | |
| 604 | 831 bra check_warn_sensor_2 ; NO - sensor can not cause a warning then |
| 832 btfsc voting_logic_sensor1 ; YES - check if sensor value is within agreement range | |
| 833 bra check_warn_sensor_2 ; YES - continue with next sensor | |
| 834 bcf sensors_agree ; NO - issue a warning | |
| 560 | 835 return |
| 604 | 836 ; check sensor 2 |
| 837 check_warn_sensor_2: | |
| 582 | 838 btfss sensor2_calibrated_ok ; check if sensor has a valid calibration |
| 839 bra check_warn_sensor_3 ; NO - sensor can not cause a warning then | |
| 840 btfss use_O2_sensor2 ; YES - check if sensor is in use | |
| 604 | 841 bra check_warn_sensor_3 ; NO - sensor can not cause a warning then |
| 842 btfsc voting_logic_sensor2 ; YES - check if sensor value is within agreement range | |
| 843 bra check_warn_sensor_3 ; YES - continue with next sensor | |
| 844 bcf sensors_agree ; NO - issue a warning | |
| 560 | 845 return |
| 604 | 846 ; check sensor 3 |
| 847 check_warn_sensor_3: | |
| 582 | 848 btfss sensor3_calibrated_ok ; check if sensor has a valid calibration |
| 849 bra check_warn_sensor_agree ; NO - sensor can not cause a warning then | |
| 850 btfss use_O2_sensor3 ; YES - check if sensor is in use | |
| 604 | 851 bra check_warn_sensor_agree ; NO - sensor can not cause a warning then |
| 852 btfsc voting_logic_sensor3 ; YES - check if sensor value is within agreement range | |
| 853 bra check_warn_sensor_agree ; YES - continue with next sensor | |
| 854 bcf sensors_agree ; NO - issue a warning | |
| 560 | 855 return |
| 604 | 856 ; no need for a warning |
| 857 check_warn_sensor_done: | |
| 560 | 858 check_warn_sensor_agree: |
| 859 bsf sensors_agree | |
| 860 return | |
| 861 | |
| 604 | 862 |
| 863 check_min_threshold: | |
| 864 movlw LOW min_mv ; load minimum mV value | |
| 865 movwf sub_b+0 | |
| 866 movlw HIGH min_mv | |
| 867 movwf sub_b+1 | |
| 868 goto sub16 ; sub_c = sensor_mv - min_mv (and return) | |
| 869 | |
| 870 check_max_threshold: | |
| 871 movlw LOW max_mv | |
| 872 movwf sub_b+0 | |
| 873 movlw HIGH max_mv | |
| 874 movwf sub_b+1 | |
| 875 goto sub16 ; sub_c = sensor_mv - max_mv (and return) | |
| 876 | |
| 560 | 877 compute_ppo2_helper: |
| 582 | 878 call mult16x16 ; xA:2*xB:2=xC:4 |
| 879 movlw LOW .1000 | |
| 560 | 880 movwf xB+0 |
| 582 | 881 movlw HIGH .1000 |
| 560 | 882 movwf xB+1 |
| 582 | 883 call div32x16 ; xC:4 / xB:2 = xC+3:xC+2 with xC+1:xC+0 as remainder |
| 560 | 884 movlw d'1' |
| 582 | 885 addwf xC+0,W ; we are just interested in the carry flag |
| 560 | 886 movlw d'0' |
| 582 | 887 addwfc xC+1,W ; we are still just interested in the carry flag |
| 888 tstfsz WREG ; ppO2 is higher than 2.55bar? | |
| 604 | 889 setf xC+0 ; YES |
| 582 | 890 return |
| 0 | 891 |
| 560 | 892 check_sensor_custview_helper: |
| 604 | 893 btfss divemode ; check if we are in dive mode |
| 582 | 894 return ; NO - not in dive mode, return |
| 604 | 895 movff opt_ccr_mode,WREG ; YES - =0: Fixed SP, =1: Sensor, =2: Auto SP |
| 896 decfsz WREG,W ; - opt_ccr_mode = 1 (sensors)? | |
| 897 return ; NO - not using the sensors in the moment | |
| 898 btfsc alternative_divelayout ; YES - in alternative layout? | |
| 899 call switch_layout_to_normal ; YES - switch to normal layout | |
| 900 movlw index_ppo2_sensors-1 ; custom view number one below ppO2 sensors | |
| 901 movwf menupos3 ; set custom view number | |
| 902 bsf toggle_customview ; initiate toggle to desired custom view -> ppO2 sensors | |
| 560 | 903 return |
| 904 | |
| 905 check_sensor_voting_helper: | |
| 582 | 906 movf lo,W |
| 907 cpfsgt sensor_setpoint | |
| 604 | 908 bra check_sensor_voting_helper2 ; lo < sensor_setpoint |
| 582 | 909 ; lo > sensor_setpoint |
| 910 movf lo,W | |
| 911 subwf sensor_setpoint,W | |
| 912 movwf lo | |
| 604 | 913 check_sensor_voting_helper1: |
| 914 movlw sensor_voting_logic_threshold ; threshold in 0.01 bar | |
| 582 | 915 cpfsgt lo |
| 604 | 916 retlw .0 ; within range |
| 917 retlw .1 ; out of range | |
| 918 check_sensor_voting_helper2: | |
| 919 ; lo < sensor_setpoint | |
| 582 | 920 movf sensor_setpoint,W |
| 921 subwf lo,F | |
| 604 | 922 bra check_sensor_voting_helper1 |
| 582 | 923 |
| 560 | 924 ;----------------------------------------------------------------------------- |
| 925 | |
| 604 | 926 divemodemode_togglegf: ; toggle aGF/GF |
| 927 bcf toggle_gf ; clear command flag | |
| 928 btg use_agf ; toggle status flag for GF | |
| 929 | |
| 930 btfsc use_agf ; aGF activated? | |
| 582 | 931 bra divemodemode_togglegf_1 ; YES - branch to using aGF |
| 932 movff opt_GF_low,char_I_GF_Low_percentage ; NO - use normal GF factors | |
| 604 | 933 movff opt_GF_high,char_I_GF_High_percentage ; - |
| 934 bra divemodemode_togglegf_2 ; - continue with common part | |
| 935 divemodemode_togglegf_1: | |
| 936 movff opt_aGF_low,char_I_GF_Low_percentage ; YES - use alternative GF factors | |
| 937 movff opt_aGF_high,char_I_GF_High_percentage ; - | |
| 582 | 938 divemodemode_togglegf_2: |
| 604 | 939 call TFT_gf_factors_mask ; update custom view mask to show which one is in use |
| 940 ; the custom view itself has been called from divemenu_tree before | |
| 582 | 941 goto restart_deco_engine ; ...and return |
| 560 | 942 |
| 943 | |
| 604 | 944 IFDEF _cave_mode |
| 945 divemodemode_toggleturn: | |
| 946 bcf toggle_turn_dive ; clear command flag | |
| 947 btg FLAG_dive_turned ; toggle dive turned state | |
| 948 btfsc FLAG_cave_mode_shutdown ; cave mode function shut down? | |
| 949 bsf FLAG_dive_turned ; YES - allow only activating turned state | |
| 950 goto set_logbook_marker ; set a logbook marker (and return) | |
| 951 ENDIF | |
| 952 | |
| 953 calc_velocity: ; called every two seconds | |
| 582 | 954 btfsc display_velocity |
| 604 | 955 bra calc_velocity1 ; always update if already displayed |
| 582 | 956 btfss divemode2 |
| 604 | 957 return ; display velocity only if deeper then 1m (Not at the surface after the dive) |
|
399
db25f2028074
CHANGE: New segmented speed graph in divemode
heinrichsweikamp
parents:
398
diff
changeset
|
958 calc_velocity1: |
| 582 | 959 SAFE_2BYTE_COPY amb_pressure, sub_a |
| 0 | 960 movff last_pressure_velocity+0,sub_b+0 |
| 961 movff last_pressure_velocity+1,sub_b+1 | |
| 604 | 962 movff sub_a+0,last_pressure_velocity+0 ; store old value for velocity |
| 0 | 963 movff sub_a+1,last_pressure_velocity+1 |
| 964 | |
| 604 | 965 call subU16 ; sub_c = amb_pressure - last_pressure |
| 0 | 966 |
| 582 | 967 bcf neg_flag_velocity |
| 968 btfsc neg_flag | |
| 969 bsf neg_flag_velocity | |
|
318
6d8c82fe5a01
VSIbar #3d: more filter, neg_flag_velocity close to calculation, debug color for descend bar
janos_kovacs <kovjanos@gmail.com>
parents:
315
diff
changeset
|
970 |
| 0 | 971 movff sub_c+0,xA+0 |
| 972 movff sub_c+1,xA+1 | |
| 582 | 973 movlw d'39' ; 77 when called every second.... |
| 0 | 974 movwf xB+0 |
| 975 clrf xB+1 | |
| 582 | 976 call mult16x16 ; differential pressure in mbar*77... |
| 0 | 977 movff xC+0,divA+0 |
| 978 movff xC+1,divA+1 | |
| 979 movlw d'7' | |
| 604 | 980 call div16 ; divA = divA / 2^WREG, divide by 2^7 equals velocity in m/min |
| 0 | 981 |
| 982 movlw d'99' | |
| 604 | 983 cpfsgt divA+0 ; velocity > 99 m/min ? |
| 984 bra calc_velocity3 ; NO | |
| 985 movwf divA+0 ; YES - set divA = 99 | |
| 0 | 986 |
| 987 calc_velocity3: | |
| 582 | 988 ; Copy old speeds |
| 989 movff old_velocity+2,old_velocity+3 | |
| 990 movff old_velocity+1,old_velocity+2 | |
| 991 movff old_velocity+0,old_velocity+1 | |
| 992 movff divA+0,old_velocity+0 | |
| 993 | |
| 994 ; movff old_velocity+3,WREG | |
| 995 ; addwf divA+0,F ; add old speed | |
| 996 ; bcf STATUS,C | |
| 997 ; rrcf divA+0,F ; /2 | |
| 998 ; movff old_velocity+2,WREG | |
| 999 ; addwf divA+0,F ; add old speed | |
| 1000 ; bcf STATUS,C | |
| 1001 ; rrcf divA+0,F ; /2 | |
| 1002 ; movff old_velocity+1,WREG | |
| 1003 ; addwf divA+0,F ; add old speed | |
| 1004 ; bcf STATUS,C | |
| 1005 ; rrcf divA+0,F ; /2 | |
| 1006 ; movff old_velocity+0,WREG | |
| 1007 ; addwf divA+0,F ; add old speed | |
| 1008 ; bcf STATUS,C | |
| 1009 ; rrcf divA+0,F ; /2 | |
| 604 | 1010 goto TFT_display_velocity ; with divA+0 = m/min..., and return... |
| 0 | 1011 |
| 1012 | |
| 1013 ;============================================================================= | |
| 1014 | |
| 604 | 1015 set_reset_safety_stop: ; set flags for safety stop and/or reset safety stop |
| 1016 TSTOSS opt_enable_safetystop ; safety stop enabled? (=1: show safety stop) | |
| 1017 bra delete_safety_stop ; NO - don't show safety stop | |
| 1018 | |
| 1019 btfsc decostop_active ; is a deco stop displayed? | |
| 1020 bra delete_safety_stop ; YES - don't show safety stop | |
| 1021 | |
| 1022 ; Below "opt_safety_stop_reset"? if yes, set flag and reset count-down timer | |
| 582 | 1023 SAFE_2BYTE_COPY rel_pressure, lo |
| 1024 call adjust_depth_with_salinity ; computes salinity setting into lo:hi [mbar] | |
|
104
223579e905c3
Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents:
102
diff
changeset
|
1025 movff lo,sub_a+0 |
|
223579e905c3
Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents:
102
diff
changeset
|
1026 movff hi,sub_a+1 |
| 582 | 1027 movff opt_safety_stop_reset,WREG ; [cbar] |
| 1028 mullw .10 ; mbar in PRODL:H | |
| 1029 movff PRODL,sub_b+0 | |
| 1030 movff PRODH,sub_b+1 | |
| 1031 call subU16 ; sub_c = sub_a - sub_b | |
|
104
223579e905c3
Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents:
102
diff
changeset
|
1032 btfss neg_flag |
| 604 | 1033 bra reset_safety_stop ; below 10m, reset safety stop |
| 1034 | |
| 1035 ; Above "opt_safety_stop_end"? if yes ,clear flag | |
| 582 | 1036 movff opt_safety_stop_end,WREG ; [cbar] |
| 1037 mullw .10 ; mbar in PRODL:H | |
| 604 | 1038 movff PRODL,sub_b+0 ; sub_a is still loaded with adjusted rel_pressure |
| 582 | 1039 movff PRODH,sub_b+1 |
| 1040 call subU16 ; sub_c = sub_a - sub_b | |
|
104
223579e905c3
Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents:
102
diff
changeset
|
1041 btfsc neg_flag |
| 604 | 1042 bra delete_safety_stop ; above 3m, remove safety stop |
| 1043 | |
| 1044 ; Above "opt_safety_stop_start"? if yes, activate safety stop | |
| 582 | 1045 movff opt_safety_stop_start,WREG ; [cbar] |
| 1046 mullw .10 ; mbar in PRODL:H | |
| 604 | 1047 movff PRODL,sub_b+0 ; sub_a is still loaded with adjusted rel_pressure |
| 582 | 1048 movff PRODH,sub_b+1 |
| 1049 call subU16 ; sub_c = sub_a - sub_b | |
|
104
223579e905c3
Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents:
102
diff
changeset
|
1050 btfsc neg_flag |
| 604 | 1051 bra acivate_safety_stop ; above 5m, activate safety stop |
| 1052 bra reset_safety_stop2 ; pause safety stop | |
|
104
223579e905c3
Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents:
102
diff
changeset
|
1053 |
|
223579e905c3
Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents:
102
diff
changeset
|
1054 acivate_safety_stop: |
| 604 | 1055 tstfsz safety_stop_countdown ; countdown at zero? |
| 1056 bsf show_safety_stop ; NO - set flag | |
|
104
223579e905c3
Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents:
102
diff
changeset
|
1057 return |
|
223579e905c3
Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents:
102
diff
changeset
|
1058 |
|
223579e905c3
Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents:
102
diff
changeset
|
1059 delete_safety_stop: |
| 582 | 1060 clrf safety_stop_countdown ; reset timer |
| 604 | 1061 bra reset_safety_stop2 ; remove safety stop from display |
|
104
223579e905c3
Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents:
102
diff
changeset
|
1062 |
|
223579e905c3
Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents:
102
diff
changeset
|
1063 reset_safety_stop: |
| 582 | 1064 movff opt_safety_stop_length,safety_stop_countdown ; reset timer |
|
104
223579e905c3
Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents:
102
diff
changeset
|
1065 reset_safety_stop2: |
| 604 | 1066 bcf show_safety_stop ; clear flag |
| 1067 btfss safety_stop_active ; safety stop shown? | |
| 1068 return ; NO - don't delete it | |
| 1069 bcf safety_stop_active ; clear flag | |
| 582 | 1070 bsf FLAG_TFT_clear_safety_stop ; Clear safety stop |
| 1071 return | |
| 428 | 1072 |
|
104
223579e905c3
Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents:
102
diff
changeset
|
1073 |
|
223579e905c3
Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents:
102
diff
changeset
|
1074 ;============================================================================= |
|
223579e905c3
Show a Safety Stop if enabled (Menu "Deco Parameters")
heinrichsweikamp
parents:
102
diff
changeset
|
1075 |
| 0 | 1076 timeout_menuview: |
| 604 | 1077 decfsz timeout_counter2,F ; timeout for menu view? |
| 1078 return ; NO - done | |
| 582 | 1079 ; Timeout, clear e.g. "Menu?" |
| 604 | 1080 goto menuview_toggle_reset ; ...and return |
| 0 | 1081 |
| 1082 timeout_divemode_menu: | |
| 582 | 1083 decfsz timeout_counter2,F ; timeout for divemode menu |
| 1084 return | |
| 0 | 1085 |
| 582 | 1086 global timeout_divemode_menu2 |
| 604 | 1087 timeout_divemode_menu2: ; called from divemenu_tree.asm |
| 1088 bcf divemode_menu ; timeout, clear flag | |
| 1089 call TFT_clear_divemode_menu ; clear menu | |
| 1090 bsf FLAG_TFT_active_gas_divemode; redraw gas/setpoint/diluent | |
| 1091 bcf blinking_better_gas ; clear flag to have temperature updated once | |
| 1092 bcf blinking_better_dil ; clear flag to have temperature updated once | |
| 1093 bsf FLAG_TFT_temp_divemode ; display temperature | |
| 1094 call TFT_draw_gassep_line ; gas separator grid in spec mode only | |
| 1095 | |
| 1096 btfss decostop_active ; in deco mode ? | |
| 1097 bra timeout_divemode_menu_ndl ; NO - show NDL again | |
| 1098 ; Show deco data | |
| 582 | 1099 bsf FLAG_TFT_display_deko_mask |
| 1100 bsf FLAG_TFT_display_deko | |
| 1101 bsf FLAG_TFT_display_tts | |
| 1102 return | |
| 1103 | |
| 1104 timeout_divemode_menu_ndl: | |
| 1105 ; Show NDL | |
| 1106 bsf FLAG_TFT_display_ndl_mask | |
| 1107 bsf FLAG_TFT_display_ndl | |
| 1108 return | |
| 0 | 1109 |
| 1110 timeout_divemode: | |
| 604 | 1111 btfsc divemode_menu ; divemode menu active? |
| 1112 rcall timeout_divemode_menu ; YES - check the timeout for it... | |
| 1113 | |
| 1114 btfsc menuview ; is a menu view shown? | |
| 1115 rcall timeout_menuview ; YES - check the timeout for it... | |
| 1116 | |
| 1117 btfss realdive ; dive longer than one minute? | |
| 1118 return ; NO - done | |
| 1119 | |
| 1120 btfsc FLAG_apnoe_mode ; in apnoe mode? | |
| 1121 bra timeout_divemode2 ; YES - use apnoe_timeout [min] for timeout | |
| 1122 | |
| 1123 IFNDEF __DEBUG | |
| 1124 btfsc simulatormode_active ; in simulator mode? | |
| 1125 bra timeout_divemode3 ; YES - use simulator timeout | |
| 1126 ENDIF | |
| 1127 | |
| 1128 bcf divemode ; terminate divemode my default | |
| 1129 infsnz timeout_counter1+0,F ; increment timeout counter | |
| 582 | 1130 incf timeout_counter1+1,F ; timeout is 16 bit counter |
| 0 | 1131 |
| 604 | 1132 movff opt_diveTimeout,WREG ; get timeout in minutes |
| 1133 mullw .60 ; convert into seconds | |
|
444
d93d75ae01bf
Adjustable timeout for Divemode (Config 0x48)
heinrichsweikamp
parents:
437
diff
changeset
|
1134 movff PRODL,sub_a+0 |
| 604 | 1135 movff PRODH,sub_a+1 |
| 0 | 1136 |
| 582 | 1137 movff timeout_counter1+0,sub_b+0 |
| 1138 movff timeout_counter1+1,sub_b+1 | |
| 1139 call subU16 ; sub_c = sub_a - sub_b | |
| 604 | 1140 btfss neg_flag ; result negative, i.e. timeout? |
| 1141 bsf divemode ; NO - set divemode flag again | |
| 0 | 1142 return |
| 1143 | |
| 1144 timeout_divemode2: | |
| 582 | 1145 incf timeout_counter1+0,F ; seconds... |
| 0 | 1146 movlw d'60' |
| 582 | 1147 cpfseq timeout_counter1+0 ; timeout_counter1+0 = 60 ? |
| 1148 return ; No | |
| 1149 ; one minute timeout done | |
| 1150 clrf timeout_counter1+0 | |
| 0 | 1151 bcf divemode |
| 1152 incf apnoe_timeout_counter,F | |
| 1153 movlw apnoe_timeout ; apnoe timeout [min] | |
| 1154 cpfseq apnoe_timeout_counter | |
| 1155 bsf divemode | |
| 1156 return | |
| 1157 | |
| 1158 timeout_divemode3: | |
| 1159 bcf divemode | |
| 582 | 1160 incf timeout_counter1+0,F |
| 1161 movlw simulator_timeout ; simulator timeout | |
| 1162 cpfsgt timeout_counter1+0 | |
| 0 | 1163 bsf divemode |
| 1164 return | |
| 1165 | |
| 582 | 1166 update_divemode60: ; update any minute |
| 0 | 1167 call get_battery_voltage ; gets battery voltage |
| 604 | 1168 rcall set_powersafe ; check if battery low |
| 1169 ;call customview_minute ; do every-minute tasks for the custom view area | |
| 582 | 1170 bcf oneminupdate |
| 604 | 1171 IFDEF _cave_mode |
| 1172 movlw .1 ; prepare to add backtrack data for 1 minute | |
| 1173 btfsc FLAG_cave_mode ; cave mode enabled? | |
| 1174 rcall update_backtrack ; YES - make it so | |
| 1175 ENDIF | |
| 582 | 1176 btfss simulatormode_active ; in simulator mode? |
| 604 | 1177 return ; NO - done |
| 1178 movlw .20 ; YES - quite dive mode simulation after 21 * 256 sec = 89 min : 36 sec | |
| 1179 cpfsgt total_divetime_seconds+1 ; timeout? | |
| 1180 return ; NO - done | |
| 1181 IFDEF __DEBUG | |
| 1182 return ; YES - but no timeout in debug mode | |
| 1183 ENDIF | |
| 1184 bra divemode_option1 ; YES - set depth to 0 m and "return" | |
| 1185 | |
| 1186 IFDEF _cave_mode | |
| 1187 update_backtrack: | |
| 1188 btfsc FLAG_dive_turned ; dive turned? | |
| 1189 return ; YES - done | |
| 1190 movwf lo ; store minutes to add in lo | |
| 1191 lfsr FSR1,char_I_backtrack_depth ; load FSR1 with base address of backtrack storage | |
| 1192 movff char_I_backtrack_time,FSR1L ; adjust FSR1 to last index | |
| 1193 update_backtrack_loop: | |
| 1194 btfsc FLAG_cave_mode_shutdown ; backtrack storage full? | |
| 1195 return ; YES - done | |
| 1196 movff curr_depth,PREINC1 ; NO - increment index and write current depth to backtrack storage | |
| 1197 incfsz FSR1L,W ; - did a wrap-around of the index occur (backtrack storage full)? | |
| 1198 bra update_backtrack_loop_1 ; NO - continue loop | |
| 1199 bsf FLAG_cave_mode_shutdown ; YES - flag backtrack storage as being full | |
| 1200 return | |
| 1201 update_backtrack_loop_1: | |
| 1202 decfsz lo,F ; decrement loop counter, did it became zero? | |
| 1203 bra update_backtrack_loop ; NO - loop | |
| 1204 movff FSR1L,char_I_backtrack_time ; YES - read-back index | |
| 1205 return ; - done | |
| 1206 ENDIF | |
| 0 | 1207 |
| 1208 set_max_depth: | |
| 1209 movff max_pressure+0,sub_a+0 | |
| 1210 movff max_pressure+1,sub_a+1 | |
| 582 | 1211 SAFE_2BYTE_COPY rel_pressure, sub_b |
| 1212 call subU16 ; sub_c = sub_a - sub_b | |
| 604 | 1213 ; max_pressure < rel_pressure -> neg_flag=1 |
| 1214 ; rel_pressure <= max_pressure -> neg_flag=0 | |
| 582 | 1215 btfss neg_flag |
| 0 | 1216 return |
| 604 | 1217 ; max_pressure < rel_pressure |
| 0 | 1218 movff sub_b+0,max_pressure+0 |
| 1219 movff sub_b+1,max_pressure+1 | |
| 604 | 1220 bsf FLAG_TFT_max_depth ; set flag |
| 560 | 1221 return |
| 0 | 1222 |
| 1223 set_min_temp: | |
| 1224 movff minimum_temperature+0,sub_a+0 | |
| 1225 movff minimum_temperature+1,sub_a+1 | |
| 582 | 1226 SAFE_2BYTE_COPY temperature,sub_b |
| 1227 call sub16 ; sub_c = sub_a - sub_b | |
| 604 | 1228 ; minimum_temperature < T -> neg_flag=1 |
| 1229 ; T <= minimum_temperature -> neg_flag=0 | |
| 582 | 1230 btfsc neg_flag |
| 0 | 1231 return |
| 582 | 1232 ; minimum_temperature >= T |
| 0 | 1233 movff sub_b+0,minimum_temperature+0 |
| 1234 movff sub_b+1,minimum_temperature+1 | |
| 1235 return | |
| 1236 | |
| 1237 global set_dive_modes | |
| 1238 set_dive_modes: | |
| 604 | 1239 btfsc high_altitude_mode ; in high altitude (fly) mode? |
| 1240 bra set_dive_modes3 ; YES | |
| 0 | 1241 |
| 1242 set_dive_modes0: | |
| 582 | 1243 movlw LOW start_dive_threshold |
| 560 | 1244 movwf sub_a+0 ; dive_treshold is in cm |
| 582 | 1245 movlw HIGH start_dive_threshold |
| 560 | 1246 movwf sub_a+1 ; dive_treshold is in cm |
| 0 | 1247 |
| 1248 set_dive_modes1: | |
| 582 | 1249 SAFE_2BYTE_COPY rel_pressure, sub_b |
| 560 | 1250 call subU16 ; sub_c = sub_a - sub_b |
| 0 | 1251 |
| 582 | 1252 btfss neg_flag |
| 1253 bra set_dive_modes2 ; too shallow (rel_pressure < dive_threshold) | |
| 0 | 1254 |
| 604 | 1255 btfsc realdive ; dive longer than one minute? |
| 1256 clrf timeout_counter1+0 ; YES - reset timeout counter | |
| 1257 | |
| 1258 bsf divemode ; (re-)set divemode flag | |
| 560 | 1259 bsf divemode2 ; displayed divetime is running |
| 0 | 1260 return |
| 1261 | |
| 1262 set_dive_modes2: | |
| 604 | 1263 bcf divemode2 ; stop time |
| 560 | 1264 btfss realdive ; dive longer then one minute? |
| 604 | 1265 bcf divemode ; NO - this was no real dive |
| 1266 return ; YES - return | |
| 1267 | |
| 1268 set_dive_modes3: ; high-altitude mode | |
| 560 | 1269 btfsc realdive ; dive longer then one minute? |
| 604 | 1270 bra set_dive_modes0 ; YES - this is a real dive -> Use start_dive_threshold or ascend |
| 0 | 1271 |
| 582 | 1272 movlw LOW high_altitude_dive_threshold |
| 1273 movwf sub_a+0 | |
| 1274 movlw HIGH high_altitude_dive_threshold | |
| 0 | 1275 movwf sub_a+1 |
| 1276 bra set_dive_modes1 | |
| 1277 | |
| 1278 set_powersafe: | |
| 582 | 1279 movlw color_code_battery_low+1; [%] |
| 1280 cpfslt batt_percent | |
| 0 | 1281 return |
| 1282 | |
| 604 | 1283 movlw d'7' ; type of alarm (battery Low) |
| 1284 movwf AlarmType ; copy to alarm register | |
| 582 | 1285 bsf event_occured ; set event flag |
| 1286 movlw .0 | |
| 604 | 1287 movff WREG,opt_brightness ; set brightness to ECO |
| 560 | 1288 return ; return |
| 0 | 1289 |
| 604 | 1290 |
| 1291 reset_average: | |
| 1292 bcf reset_average_depth ; clear reset-average flag | |
| 1293 clrf average_depth_hold+0 ; clear the depth accumulator | |
| 1294 clrf average_depth_hold+1 ; ... | |
| 1295 clrf average_depth_hold+2 ; ... | |
| 1296 clrf average_depth_hold+3 ; ... | |
| 1297 clrf average_divesecs+0 ; clear the time accumulator | |
| 1298 clrf average_divesecs+1 ; ... | |
| 1299 SAFE_2BYTE_COPY rel_pressure,avg_rel_pressure ; prime result with current rel.pressure/depth | |
| 1300 return | |
| 1301 | |
| 1302 | |
| 0 | 1303 calc_average_depth: |
| 604 | 1304 ; 1. compute rel_pressure x 2, because this routine is called every 2nd second only |
| 1305 SAFE_2BYTE_COPY rel_pressure,xB ; copy current rel pressure to xB | |
| 582 | 1306 bcf STATUS,C |
| 604 | 1307 rlcf xB+0,F ; multiply rel pressure x 2 (via shift left) |
| 1308 rlcf xB+1,F ; ... | |
| 1309 | |
| 1310 ; 2a add (rel_pressure x 2) to the resettable depth accumulator | |
| 1311 movf xB+0,W | |
| 0 | 1312 addwf average_depth_hold+0,F |
| 604 | 1313 movf xB+1,W |
| 0 | 1314 addwfc average_depth_hold+1,F |
| 604 | 1315 movlw .0 |
| 0 | 1316 addwfc average_depth_hold+2,F |
| 604 | 1317 addwfc average_depth_hold+3,F ; will work up to 9999 mbar * 60 * 60 * 24 = 863913600 mbar (24h @ 90 m depth) |
| 1318 | |
| 1319 ; 2b add (rel_pressure x 2) to the total depth accumulator | |
| 1320 movf xB+0,W | |
| 0 | 1321 addwf average_depth_hold_total+0,F |
| 604 | 1322 movf xB+1,W |
| 0 | 1323 addwfc average_depth_hold_total+1,F |
| 604 | 1324 movlw .0 |
| 0 | 1325 addwfc average_depth_hold_total+2,F |
| 604 | 1326 addwfc average_depth_hold_total+3,F ; will work up to 9999 mbar * 60 * 60 * 24 = 863913600 mbar (24h @ 90 m depth) |
| 1327 | |
| 1328 ; 3a compute avg_rel_pressure on base of average_divesecs:2 | |
| 0 | 1329 movff average_depth_hold+0,xC+0 |
| 1330 movff average_depth_hold+1,xC+1 | |
| 1331 movff average_depth_hold+2,xC+2 | |
| 604 | 1332 movff average_depth_hold+3,xC+3 ; copy accumulated depth |
| 1333 movff average_divesecs+0,xB+0 | |
| 1334 movff average_divesecs+1,xB+1 ; copy accumulated time | |
| 1335 call div32x16 ; xC:4 / xB:2 = xC+3:xC+2 with xC+1:xC+0 as remainder | |
| 437 | 1336 movff xC+0,avg_rel_pressure+0 |
| 604 | 1337 movff xC+1,avg_rel_pressure+1 ; store result |
| 1338 | |
| 1339 btfss divemode2 ; displayed divetime is running? | |
| 1340 return ; NO (e.g. too shallow) | |
| 1341 | |
| 1342 ; 3b compute avg_rel_pressure_total on base of average_divesecs_total:2 | |
| 0 | 1343 movff average_depth_hold_total+0,xC+0 |
| 1344 movff average_depth_hold_total+1,xC+1 | |
| 1345 movff average_depth_hold_total+2,xC+2 | |
| 604 | 1346 movff average_depth_hold_total+3,xC+3 ; copy accumulated depth |
| 1347 movff average_divesecs_total+0,xB+0 | |
| 1348 movff average_divesecs_total+1,xB+1 ; copy accumulated time | |
| 1349 call div32x16 ; xC:4 / xB:2 = xC+3:xC+2 with xC+1:xC+0 as remainder | |
| 437 | 1350 movff xC+0,avg_rel_pressure_total+0 |
| 604 | 1351 movff xC+1,avg_rel_pressure_total+1 ; store result |
| 1352 | |
| 1353 btfsc reset_average_depth ; reset the resettable average depth? | |
| 1354 rcall reset_average ; YES - reset the resettable average depth | |
| 1355 | |
| 1356 TSTOSS opt_2ndDepthDisp ; drawing avg depth instead of max depth? | |
| 1357 return ; NO - done | |
| 1358 bsf FLAG_TFT_max_depth ; YES - flag to update display | |
| 0 | 1359 return |
| 1360 | |
| 604 | 1361 |
| 1362 test_switches_divemode: ; checks switches in divemode | |
| 1363 btfsc divemode_menu ; divemode menu shown? | |
| 1364 bra test_switches_divemode_menu ; YES - use menu processor | |
| 1365 btfsc switch_left ; NO - left button pressed? | |
| 1366 goto menuview_toggle ; YES - menu or simulator tasks; and return... | |
| 1367 btfss switch_right ; NO - right button pressed? | |
| 1368 return ; NO - done | |
| 1369 tstfsz menupos2 ; YES - any option shown? | |
| 1370 bra test_switches_divemode1 ; YES - do option tasks | |
| 1371 bsf toggle_customview ; NO - toggle custom view | |
| 1372 return ; - done | |
| 0 | 1373 |
| 1374 test_switches_divemode_menu: | |
| 1375 btfsc switch_left | |
| 604 | 1376 bra test_switches_divemode_menu2 ; move cursor |
| 1377 btfsc switch_right ; left button pressed? | |
| 1378 bra test_switches_divemode_menu3 ; YES - enter submenu or do something | |
| 1379 return ; NO - done | |
| 0 | 1380 |
| 1381 test_switches_divemode_menu1: | |
| 582 | 1382 clrf menupos1 |
| 0 | 1383 test_switches_divemode_menu2: |
| 582 | 1384 incf menupos1,F |
| 604 | 1385 incf menupos4,W ; menupos4 + 1 -> WREG |
| 1386 cpfslt menupos1 ; > menupos4 (set in menu_processor.asm)? | |
| 1387 bra test_switches_divemode_menu1 ; YES - set to 1 | |
| 1388 call TFT_divemode_menu_cursor ; update the cursor | |
| 582 | 1389 bcf switch_left |
| 604 | 1390 movlw divemode_menu_timeout ; reload timeout |
| 1391 movwf timeout_counter2 ; timeout for divemode menu | |
| 582 | 1392 return |
| 0 | 1393 |
| 604 | 1394 test_switches_divemode_menu3: ; enter submenu or do something |
| 582 | 1395 bcf switch_right |
| 1396 ; decf menupos1,F ; menu_processor needs 0-5... | |
| 604 | 1397 goto do_line_menu ; Warning! trashes STKPTR and returns to diveloop_loop4: |
| 0 | 1398 |
| 1399 test_switches_divemode1: | |
| 1400 bcf switch_right | |
| 582 | 1401 movlw divemode_menuview_timeout |
| 604 | 1402 movwf timeout_counter2 ; reload timeout |
| 582 | 1403 movff menupos2,WREG ; menupos2 holds number of customview/divemode menu function |
| 0 | 1404 dcfsnz WREG,F |
| 604 | 1405 bra divemode_option_gaschange ; switch to the the "better gas" / "better diluent" |
| 137 | 1406 dcfsnz WREG,F |
| 604 | 1407 bra divemode_option0 ; start/setup Divemode menu |
| 0 | 1408 dcfsnz WREG,F |
| 604 | 1409 bra divemode_option1 ; quit simulation? |
| 0 | 1410 dcfsnz WREG,F |
| 604 | 1411 bra divemode_option2 ; descent 1m |
| 0 | 1412 dcfsnz WREG,F |
| 604 | 1413 bra divemode_option3 ; ascend 1m |
| 0 | 1414 dcfsnz WREG,F |
| 604 | 1415 bra divemode_option4 ; quit Apnoe mode |
| 0 | 1416 dcfsnz WREG,F |
| 604 | 1417 bra divemode_option5 ; reset stopwatch (gauge mode only) |
|
216
973a0969e0ac
NEW: On-board simulator can increase divetime in 5min steps
heinrichsweikamp
parents:
206
diff
changeset
|
1418 dcfsnz WREG,F |
|
973a0969e0ac
NEW: On-board simulator can increase divetime in 5min steps
heinrichsweikamp
parents:
206
diff
changeset
|
1419 bra divemode_option6 ; +5mins simulation |
|
254
5fe7aff622f3
preparations to set a course for the compass display
heinrichsweikamp
parents:
239
diff
changeset
|
1420 dcfsnz WREG,F |
| 604 | 1421 bra divemode_option7 ; store heading |
| 560 | 1422 dcfsnz WREG,F |
| 604 | 1423 bra divemode_option8 ; switch to alternative layout |
| 582 | 1424 return |
| 0 | 1425 |
| 1426 gas_switched_common: | |
| 604 | 1427 bcf divemode_gaschange ; clear flag |
| 582 | 1428 btfss FLAG_back_to_loop ; check if it is a switchback from OC bailout to loop |
| 1429 bra gas_switched_common0 ; NO - continue with checking if selected gas is valid | |
| 1430 bcf FLAG_back_to_loop ; YES - clear flag | |
| 604 | 1431 movff active_dil,menupos1 ; reload last diluent |
| 582 | 1432 bra gas_switched_common1 ; continue with common part |
| 1433 gas_switched_common0: | |
| 604 | 1434 tstfsz menupos1 ; menupos1 = 0 ? |
| 582 | 1435 bra gas_switched_common1 ; NO - valid gas |
| 1436 return ; YES - something went wrong, invalid gas, abort | |
| 560 | 1437 gas_switched_common1: |
| 582 | 1438 movf menupos1,W ; get selected gas into WREG (1-6) |
| 604 | 1439 btfsc FLAG_oc_mode ; in OC mode? |
| 1440 bra gas_switched_common_OC ; YES | |
| 1441 btfsc FLAG_bailout_mode ; in bailout? | |
| 1442 bra gas_switched_common_OC ; YES | |
| 1443 gas_switched_common_loop: ; NO to both - must be loop mode then | |
| 1444 rcall setup_dil_registers ; with WREG = diluent 1-6 | |
| 1445 rcall deco_setup_cc_diluents ; with WREG = diluent 1-6 | |
| 560 | 1446 bra gas_switched_common3 |
| 604 | 1447 gas_switched_common_OC: |
| 1448 rcall setup_gas_registers ; with WREG = Gas 1-6 | |
| 1449 rcall deco_setup_oc_gases ; with WREG = Gas 1-6 | |
| 560 | 1450 gas_switched_common3: |
| 605 | 1451 banksel int_O_breathed_ppO2 |
| 1452 bcf int_O_breathed_ppO2+1,int_low_flag ; | clear all flags that control color-coding | |
| 1453 bcf int_O_breathed_ppO2+1,int_high_flag ; | to have the new gas initially displayed in | |
| 1454 bcf int_O_breathed_ppO2+1,int_attention_flag ; | memo color instead of a warning or attention | |
| 1455 bcf int_O_breathed_ppO2+1,int_warning_flag ; | color that belonged to the previous gas | |
| 1456 banksel common | |
| 1457 bsf FLAG_TFT_active_gas_divemode ; redraw gas/setpoint/diluent | |
| 1458 call restart_deco_engine_wo_ceiling ; abort any running deco calculations and restart the deco engine | |
| 604 | 1459 ; set flags for profile recording |
| 582 | 1460 bsf event_occured ; set event flag |
| 604 | 1461 btfsc FLAG_bailout_mode ; choose OC Bailouts (OC Gases) |
| 1462 bsf bailoutgas_event ; bailout gas change | |
| 1463 btfss FLAG_bailout_mode ; choose OC Bailouts (OC Gases) | |
| 560 | 1464 bsf stored_gas_changed ; OC gas change |
| 0 | 1465 return |
| 1466 | |
| 560 | 1467 |
| 1468 ; Code to pass all parameters to the C code | |
| 1469 | |
| 582 | 1470 global get_first_gas_to_WREG |
| 604 | 1471 get_first_gas_to_WREG: ; gets first gas (1-5) into WREG |
| 1472 lfsr FSR1,opt_gas_type ; point to gas types | |
| 1473 clrf lo ; start with gas 0 | |
| 560 | 1474 get_first_gas_to_WREG2: |
| 582 | 1475 movf lo,W |
| 604 | 1476 movf PLUSW1,W ; get type of gas #lo |
| 582 | 1477 sublw .1 ; it is = 1 (First Gas) |
| 604 | 1478 bz get_first_gas_to_WREG3 ; found the first gas! |
| 582 | 1479 incf lo,F ; ++ |
| 1480 movlw NUM_GAS+1 | |
| 604 | 1481 cpfseq lo ; all done? |
| 1482 bra get_first_gas_to_WREG2 ; NO - not yet | |
| 1483 ; no first gas found, use #1 | |
| 582 | 1484 movlw .0 |
| 604 | 1485 movff WREG,opt_gas_type+0 ; set gas 1 to First |
| 560 | 1486 incf WREG,W ; 0 -> 1 |
| 1487 return | |
| 1488 get_first_gas_to_WREG3: | |
| 604 | 1489 movf lo,W ; put into WREG |
| 560 | 1490 incf WREG,W ; 0-4 -> 1-5 |
| 604 | 1491 return ; done |
| 560 | 1492 |
| 582 | 1493 global get_first_dil_to_WREG |
| 604 | 1494 get_first_dil_to_WREG: ; gets first dil (1-5) into WREG |
| 1495 lfsr FSR1,opt_dil_type ; point to dil types | |
| 1496 clrf lo ; start with dil 0 | |
| 560 | 1497 get_first_dil_to_WREG2: |
| 582 | 1498 movf lo,W |
| 604 | 1499 movf PLUSW1,W ; get type of Dil #lo |
| 582 | 1500 sublw .1 ; it is = 1 (First Dil) |
| 604 | 1501 bz get_first_dil_to_WREG3 ; found the first dil! |
| 582 | 1502 incf lo,F ; ++ |
| 1503 movlw NUM_GAS+1 | |
| 604 | 1504 cpfseq lo ; all done? |
| 1505 bra get_first_dil_to_WREG2 ; NO - not yet | |
| 1506 ; no first dil found, use #1 | |
| 582 | 1507 movlw .0 |
| 604 | 1508 movff WREG,opt_dil_type+0 ; set dil 1 to First |
| 560 | 1509 incf WREG,W ; 0 -> 1 |
| 1510 return | |
| 1511 get_first_dil_to_WREG3: | |
| 604 | 1512 movf lo,W ; Put into WREG |
| 560 | 1513 incf WREG,W ; 0-4 -> 1-5 |
| 604 | 1514 return ; done |
| 1515 | |
| 1516 | |
| 560 | 1517 deco_setup_oc_gases: ; with currently breathed gas in WREG (1-5 or 6) |
| 1518 movff char_O_deco_status,lo ; working copy of char_O_deco_status in bank common | |
| 604 | 1519 deco_setup_oc_gases_pre: ; entry point with lo preloaded |
| 1520 movff WREG,char_I_current_gas ; set gas to start with when doing the deco calculations | |
| 1521 ; | |
| 1522 ; Memory Map: | |
| 1523 ; --------------------------------------------------------------------------------- | |
| 1524 ; opt_gas_O2_ratio res NUM_GAS | char_I_deco_O2_ratio res NUM_GAS | |
| 1525 ; opt_dil_O2_ratio res NUM_GAS | | |
| 1526 ; opt_gas_He_ratio res NUM_GAS | char_I_deco_He_ratio res NUM_GAS | |
| 1527 ; opt_dil_He_ratio res NUM_GAS | | |
| 1528 ; opt_gas_type res NUM_GAS | char_I_deco_gas_type res NUM_GAS | |
| 1529 ; opt_dil_type res NUM_GAS | | |
| 1530 ; opt_gas_change res NUM_GAS | char_I_deco_gas_change res NUM_GAS | |
| 1531 ; opt_dil_change res NUM_GAS | | |
| 1532 ; | |
| 1533 lfsr FSR2,char_I_deco_O2_ratio ; Load FSR2 with base address of char_I_deco_O2_ratio. | |
| 1534 ; FSR2 will step through all char_I_deco_... vars. | |
| 1535 lfsr FSR1,opt_gas_O2_ratio ; load FSR1 with base address of opt_gas_O2_ratio | |
| 1536 rcall deco_setup_copy ; copy all OC O2 ratios | |
| 1537 lfsr FSR1,opt_gas_He_ratio ; load FSR1 with base address of opt_gas_He_ratio | |
| 1538 rcall deco_setup_copy ; copy all OC He ratios | |
| 1539 lfsr FSR1,opt_gas_type ; load FSR1 with base address of opt_gas_type | |
| 1540 rcall deco_setup_copy ; copy all gas types | |
| 1541 lfsr FSR1,opt_gas_change ; load FSR1 with base address of opt_gas_change | |
| 1542 rcall deco_setup_copy ; copy all gas change depths | |
| 1543 ; switch to oc mode | |
| 560 | 1544 bcf lo,DECO_MODE_PSCR_FLAG ; clear the pSCR-mode flag (may not be set, but never mind) |
| 1545 bcf lo,DECO_MODE_LOOP_FLAG ; clear the loop/CCR-mode flag | |
| 1546 movff lo,char_O_deco_status ; bank safe write-back of char_O_deco_status | |
| 1547 return | |
| 1548 | |
| 582 | 1549 |
| 604 | 1550 deco_setup_cc_diluents: ; with currently breathed diluent in WREG (1-5 or 6) |
| 560 | 1551 movff char_O_deco_status,lo ; working copy of char_O_deco_status in bank common |
| 604 | 1552 deco_setup_cc_diluents_pre: ; entry point with lo preloaded |
| 1553 btfsc FLAG_bailout_mode ; check if in bailout condition | --------------- FOR SAFETY ONLY -------------- | |
| 1554 bra deco_setup_oc_gases_pre ; YES - revert to setting up OC gases | This branch should never happen to be taken... | |
| 1555 movff WREG,char_I_current_gas ; NO - set diluent to start with when doing the deco calculations | |
| 1556 ; | |
| 1557 ; Memory Map: | |
| 1558 ; --------------------------------------------------------------------------------- | |
| 1559 ; opt_gas_O2_ratio res NUM_GAS | | |
| 1560 ; opt_dil_O2_ratio res NUM_GAS | char_I_deco_O2_ratio res NUM_GAS | |
| 1561 ; opt_gas_He_ratio res NUM_GAS | | |
| 1562 ; opt_dil_He_ratio res NUM_GAS | char_I_deco_He_ratio res NUM_GAS | |
| 1563 ; opt_gas_type res NUM_GAS | | |
| 1564 ; opt_dil_type res NUM_GAS | char_I_deco_gas_type res NUM_GAS | |
| 1565 ; opt_gas_change res NUM_GAS | | |
| 1566 ; opt_dil_change res NUM_GAS | char_I_deco_gas_change res NUM_GAS | |
| 1567 ; | |
| 1568 lfsr FSR2,char_I_deco_O2_ratio ; Load FSR2 with base address of char_I_deco_O2_ratio. | |
| 1569 ; FSR2 will step through all char_I_deco_... vars. | |
| 1570 lfsr FSR1,opt_dil_O2_ratio ; load FSR1 with base address of opt_dil_O2_ratio | |
| 1571 rcall deco_setup_copy ; copy all dil O2 ratios | |
| 1572 lfsr FSR1,opt_dil_He_ratio ; load FSR1 with base address of opt_dil_He_ratio | |
| 1573 rcall deco_setup_copy ; copy all dil He ratios | |
| 1574 lfsr FSR1,opt_dil_type ; load FSR1 with base address of opt_dil_type | |
| 1575 rcall deco_setup_copy ; copy all dil types | |
| 1576 lfsr FSR1,opt_dil_change ; load FSR1 with base address of opt_dil_change | |
| 1577 rcall deco_setup_copy ; copy all dil change depths | |
| 1578 ; switch to CCR / pSCR mode | |
| 560 | 1579 bsf lo,DECO_MODE_LOOP_FLAG ; loop flag is set in both, CCR and pSCR mode |
| 1580 bcf lo,DECO_MODE_PSCR_FLAG ; clear pSCR mode flag by default | |
| 1581 btfsc FLAG_pscr_mode ; check if we are in pSCR mode | |
| 1582 bsf lo,DECO_MODE_PSCR_FLAG ; YES - set additional flag for pSCR mode | |
| 604 | 1583 movff lo,char_O_deco_status ; bank safe write-back of char_O_deco_status |
| 560 | 1584 return |
| 0 | 1585 |
| 604 | 1586 deco_setup_copy: |
| 1587 movlw NUM_GAS ; load loop counter with number of gases (5) | |
| 1588 deco_setup_copy_loop: | |
| 1589 movff POSTINC1,POSTINC2 ; copy from (FSR1) to (FSR2) | |
| 1590 decfsz WREG ; decrement loop counter and check if it became 0 | |
| 1591 bra deco_setup_copy_loop ; NO - not yet, loop | |
| 1592 return ; YES - done | |
| 1593 | |
| 1594 | |
| 582 | 1595 global setup_gas_registers |
| 1596 setup_gas_registers: ; with currently breathed gas in WREG (1-5 or 6) | |
| 1597 movwf active_gas ; set as current gas | |
| 560 | 1598 movlw .6 |
| 582 | 1599 cpfseq active_gas ; gas = gas6 ? |
| 1600 bra setup_gas_registers_15 ; NO - load gas 1-5 | |
| 1601 movff gas6_O2_ratio,char_I_O2_ratio ; copy gas6 O2 ratio to deco engine | |
| 604 | 1602 movff gas6_He_ratio,char_I_He_ratio ; copy gas6 H2 ratio to deco engine |
| 1603 movlw .3 ; declare gas6 as a deco gas | |
| 1604 movff WREG,char_I_current_gas_type; copy gas type to deco engine | |
| 1605 movff curr_depth,char_I_gas6_depth; set current depth as change depth | |
| 582 | 1606 bra setup_gas_registers_com ; continue with common part |
| 560 | 1607 setup_gas_registers_15: |
| 582 | 1608 decf active_gas,W ; 1-5 -> 0-4 |
| 604 | 1609 lfsr FSR1,opt_gas_O2_ratio |
| 582 | 1610 movff PLUSW1,char_I_O2_ratio ; copy gas 1-5 O2 ratio to deco engine |
| 604 | 1611 lfsr FSR1,opt_gas_He_ratio |
| 582 | 1612 movff PLUSW1,char_I_He_ratio ; copy gas 1-5 He ratio to deco engine |
| 604 | 1613 lfsr FSR1,opt_gas_type ; |
| 1614 movff PLUSW1,char_I_current_gas_type ; copy gas 1-5 type (0=Disabled, 1=First, 2=Travel, 3=Deco) | |
| 1615 setup_gas_registers_com: | |
| 582 | 1616 movff char_O_main_status,lo ; working copy of char_O_main_status in bank common |
| 1617 bcf lo,DECO_MODE_PSCR_FLAG ; clear the pSCR-mode flag (may not be set, but never mind) | |
| 1618 bcf lo,DECO_MODE_LOOP_FLAG ; clear the loop/CCR-mode flag | |
| 1619 movff lo,char_O_main_status ; bank safe write-back of char_O_main_status | |
| 604 | 1620 movf active_gas,W ; reload WREG with gas 1-5 or 6 (important!) |
| 560 | 1621 return |
| 137 | 1622 |
| 582 | 1623 global setup_dil_registers |
| 1624 setup_dil_registers: ; with currently breathed gas in WREG (1-5 or 6) | |
| 604 | 1625 btfsc FLAG_bailout_mode ; check if in bailout condition | --------------- FOR SAFETY ONLY -------------- |
| 1626 bra setup_gas_registers ; revert to setting up OC gases in bailout condition | This branch should never happen to be taken... | |
| 1627 movwf active_dil ; set as current diluent | |
| 560 | 1628 movlw .6 |
| 604 | 1629 cpfseq active_dil ; diluent = gas6 ? |
| 582 | 1630 bra setup_dil_registers_15 ; NO - load diluent 1-5 |
| 1631 movff gas6_O2_ratio,char_I_O2_ratio ; copy gas6 O2 ratio to deco engine | |
| 1632 movff gas6_He_ratio,char_I_He_ratio ; copy gas6 H2 ratio to deco engine | |
| 604 | 1633 movlw .2 ; declare gas6 as a normal diluent |
| 1634 movff WREG,char_I_current_gas_type; copy gas type to deco engine | |
| 1635 movff curr_depth,char_I_gas6_depth; set current depth as change depth | |
| 582 | 1636 bra setup_dil_registers_com ; continue with common part |
| 560 | 1637 setup_dil_registers_15: |
| 604 | 1638 decf active_dil,W ; 1-5 -> 0-4 |
| 1639 lfsr FSR1,opt_dil_O2_ratio | |
| 582 | 1640 movff PLUSW1,char_I_O2_ratio ; copy diluent 1-5 O2 ratio to deco engine |
| 604 | 1641 lfsr FSR1,opt_dil_He_ratio |
| 582 | 1642 movff PLUSW1,char_I_He_ratio ; copy diluent 1-5 He ratio to deco engine |
| 604 | 1643 lfsr FSR1,opt_dil_type ; |
| 1644 movff PLUSW1,char_I_current_gas_type ; copy dil type (0=Disabled, 1=First, 2=Normal) | |
| 560 | 1645 setup_dil_registers_com: |
| 582 | 1646 movff char_O_main_status,lo ; working copy of char_O_main_status in bank common |
| 1647 bsf lo,DECO_MODE_LOOP_FLAG ; loop flag is set in both, CCR and pSCR mode | |
| 1648 bcf lo,DECO_MODE_PSCR_FLAG ; clear pSCR mode flag by default | |
| 1649 btfsc FLAG_pscr_mode ; check if we are in pSCR mode | |
| 1650 bsf lo,DECO_MODE_PSCR_FLAG ; YES - set additional flag for pSCR mode | |
| 1651 movff lo,char_O_main_status ; bank safe write-back of char_O_main_status | |
| 604 | 1652 movf active_dil,W ; reload WREG with diluent 1-5 or 6 (important!) |
| 560 | 1653 return |
| 1654 | |
| 604 | 1655 |
| 1656 divemode_option_gaschange: ; switch to the "better gas" / "better diluent" | |
| 1657 btfsc FLAG_oc_mode ; in OC mode? | |
| 1658 bra divemode_option_gaschange_oc; YES | |
| 1659 btfsc FLAG_bailout_mode ; in bailout? | |
| 1660 bra divemode_option_gaschange_oc; YES | |
| 1661 divemode_option_gaschange_loop: ; in CCR/pSCR mode and not in bailout | |
| 1662 movff best_dil_number,menupos1 ; NO - select best diluent | |
| 1663 bcf better_dil_available ; - clear flag immediately | |
| 1664 bra divemode_option_gaschange3 ; - continue with common part | |
| 1665 divemode_option_gaschange_oc: ; in OC or bailout | |
| 1666 movff best_gas_number,menupos1 ; select best gas | |
| 1667 bcf better_gas_available ; clear flag immediately | |
| 1668 divemode_option_gaschange3 ; common part | |
| 1669 bsf divemode_gaschange ; command a gas/diluent change | |
| 1670 call menuview_toggle_reset ; terminate the options menu | |
| 560 | 1671 return |
| 1672 | |
| 604 | 1673 divemode_option0: ; start/setup dive mode menu |
| 1674 call TFT_clear_divemode_menu ; clear menu area | |
| 582 | 1675 bcf menuview |
| 560 | 1676 call do_main_divemenu |
| 1677 | |
| 582 | 1678 global divemode_option0_return |
| 0 | 1679 divemode_option0_return: |
| 582 | 1680 ; movlw .1 |
| 604 | 1681 ; movwf menupos1 ; set to first option in dive mode menu |
| 1682 call TFT_divemode_menu_cursor ; show the cursor | |
| 0 | 1683 movlw divemode_menu_timeout |
| 604 | 1684 movwf timeout_counter2 ; timeout for dive mode menu |
| 1685 bsf divemode_menu ; set flag | |
| 1686 clrf menupos2 ; clear option counter | |
| 1687 goto diveloop_loop4 ; go back to dive loop (menu processor trashes STKPTR!) | |
| 0 | 1688 |
| 1689 divemode_option4: | |
| 582 | 1690 movlw d'58' ; two seconds left |
| 1691 movwf timeout_counter1+0 | |
| 1692 movlw apnoe_timeout-1 ; apnoe timeout [min] | |
| 0 | 1693 movwf apnoe_timeout_counter |
| 582 | 1694 btfss simulatormode_active ; in simulator mode? |
| 604 | 1695 return ; NO |
| 1696 ;bra divemode_option1 ; YES | |
| 1697 | |
| 1698 divemode_option1: ; quit simulation mode | |
| 0 | 1699 banksel isr_backup |
| 582 | 1700 movlw LOW .1000 |
| 1701 movwf sim_pressure+0 | |
| 1702 movlw HIGH .1000 | |
| 604 | 1703 movwf sim_pressure+1 ; set to 0m -> end of dive |
| 582 | 1704 banksel common |
| 604 | 1705 call menuview_toggle_reset ; reset to zero (zero = no menu view) |
| 1706 | |
| 1707 btfss FLAG_apnoe_mode ; in apnoe mode? | |
| 1708 return ; NO - done | |
| 582 | 1709 movlw d'58' ; two seconds left |
| 1710 movwf timeout_counter1+0 | |
| 1711 movlw apnoe_timeout-1 ; apnoe timeout [min] | |
| 0 | 1712 movwf apnoe_timeout_counter |
| 1713 return | |
| 1714 | |
| 582 | 1715 divemode_option3: ; minus 1m |
| 0 | 1716 banksel isr_backup |
|
315
4f83470dcece
VSIbar #3: remaining changes for the split style bar
Janos Kovacs <kovjanos@gmail.com>
parents:
310
diff
changeset
|
1717 movlw d'100' |
| 0 | 1718 subwf sim_pressure+0 |
| 1719 movlw .0 | |
| 1720 subwfb sim_pressure+1 | |
| 1721 rcall divemode_simulator_check_limits | |
| 582 | 1722 banksel common |
| 0 | 1723 return |
| 1724 | |
| 582 | 1725 divemode_option2: ; plus 1m |
| 0 | 1726 banksel isr_backup |
|
315
4f83470dcece
VSIbar #3: remaining changes for the split style bar
Janos Kovacs <kovjanos@gmail.com>
parents:
310
diff
changeset
|
1727 movlw d'100' |
| 604 | 1728 addwf sim_pressure+0,F |
| 0 | 1729 movlw .0 |
| 604 | 1730 addwfc sim_pressure+1,F |
| 0 | 1731 rcall divemode_simulator_check_limits |
| 582 | 1732 banksel common |
| 0 | 1733 return |
| 1734 | |
| 1735 divemode_option5: | |
| 604 | 1736 call menuview_toggle_reset ; reset to zero (zero = no menu view) |
| 1737 bsf reset_average_depth ; set flag | |
| 582 | 1738 return |
| 0 | 1739 |
|
216
973a0969e0ac
NEW: On-board simulator can increase divetime in 5min steps
heinrichsweikamp
parents:
206
diff
changeset
|
1740 divemode_option6: |
| 604 | 1741 ; advance tissues and deco by 5 minutes |
| 1742 movlw .5 ; + 5 minutes | |
| 1743 movff WREG,char_I_sim_advance_time; copy to mailbox | |
| 1744 call restart_deco_engine | |
| 1745 | |
| 1746 ; stop divetime incrementing in ISR | |
| 1747 bcf divemode2 | |
| 1748 | |
| 1749 ; add 5 minutes to divemins | |
| 582 | 1750 movlw .5 |
| 1751 addwf divemins+0,F | |
| 1752 movlw .0 | |
| 604 | 1753 addwfc divemins+1,F |
| 1754 | |
| 1755 ; add 5 minutes (5 * 60 seconds) to total_divetime_seconds | |
| 1756 movlw LOW (.5*.60) | |
| 1757 addwf total_divetime_seconds+0,F | |
| 1758 movlw HIGH (.5*.60) | |
| 1759 addwfc total_divetime_seconds+1,F | |
| 1760 | |
| 1761 ; continue dive time incrementing in ISR | |
| 1762 bsf divemode2 | |
| 1763 | |
| 1764 ; add 5 minutes (5 * 60 seconds) to resettable time accumulator | |
| 582 | 1765 movlw LOW (.5*.60) |
| 1766 addwf average_divesecs+0,F | |
| 1767 movlw HIGH (.5*.60) | |
| 604 | 1768 addwfc average_divesecs+1,F |
| 1769 | |
| 1770 ; add 5 minutes (5 * 60 seconds) to total time accumulator | |
| 582 | 1771 movlw LOW (.5*.60) |
| 604 | 1772 addwf average_divesecs_total+0,F |
| 582 | 1773 movlw HIGH (.5*.60) |
| 604 | 1774 addwfc average_divesecs_total+1,F |
| 1775 | |
| 1776 | |
| 1777 ; calculate 300 x depth in mbar (300 = 5 min * 60 sec/min) | |
| 1778 SAFE_2BYTE_COPY rel_pressure, xB | |
| 582 | 1779 movlw LOW (.5*.60) |
| 1780 movwf xA+0 | |
| 1781 movlw HIGH (.5*.60) | |
| 1782 movwf xA+1 | |
| 1783 call mult16x16 ; xA*xB=xC | |
| 386 | 1784 |
| 604 | 1785 ; add to the resettable depth accumulator |
| 1786 movf xC+0,W | |
| 386 | 1787 addwf average_depth_hold+0,F |
| 604 | 1788 movf xC+1,W |
| 386 | 1789 addwfc average_depth_hold+1,F |
| 604 | 1790 movf xC+2,W |
| 386 | 1791 addwfc average_depth_hold+2,F |
| 604 | 1792 movf xC+3,W |
| 1793 addwfc average_depth_hold+3,F | |
| 1794 | |
| 1795 ; add to the total depth accumulator | |
| 386 | 1796 movf xC+0,w |
| 1797 addwf average_depth_hold_total+0,F | |
| 1798 movf xC+1,w | |
| 1799 addwfc average_depth_hold_total+1,F | |
| 1800 movf xC+2,w | |
| 1801 addwfc average_depth_hold_total+2,F | |
| 560 | 1802 movf xC+3,w |
| 604 | 1803 addwfc average_depth_hold_total+3,F |
| 1804 | |
| 1805 IFDEF _cave_mode | |
| 1806 ; update backtracking data | |
| 1807 movlw .5 ; add backtrack data for 5 minutes | |
| 1808 call update_backtrack ; make it so | |
| 1809 ENDIF | |
| 1810 | |
| 582 | 1811 goto menuview_toggle_reset ; and return... |
|
216
973a0969e0ac
NEW: On-board simulator can increase divetime in 5min steps
heinrichsweikamp
parents:
206
diff
changeset
|
1812 |
|
254
5fe7aff622f3
preparations to set a course for the compass display
heinrichsweikamp
parents:
239
diff
changeset
|
1813 divemode_option7: |
| 582 | 1814 ; Store heading for compass view |
| 1815 movff compass_heading_shown+0,compass_bearing+0 | |
| 1816 movff compass_heading_shown+1,compass_bearing+1 | |
| 1817 bsf compass_bearing_set ; set flag | |
| 604 | 1818 goto menuview_toggle_reset ; and return... |
| 1819 | |
| 560 | 1820 divemode_option8: |
| 604 | 1821 bsf alternative_divelayout ; set flag for alternative layout mode |
| 1822 call menuview_toggle_reset ; terminate the pre-menu | |
| 1823 call TFT_ClearScreen ; clear the whole screen | |
| 1824 bsf FLAG_TFT_divemode_mask_alt ; set flag to draw the alternative mask | |
| 1825 movff menupos3,customview_divemode; back-up the custom view shown in normal layout | |
| 1826 clrf menupos3 ; select the default alternative layout | |
| 1827 call customview_mask_alternative ; draw the default alternative layout | |
| 1828 return ; done | |
| 1829 | |
|
216
973a0969e0ac
NEW: On-board simulator can increase divetime in 5min steps
heinrichsweikamp
parents:
206
diff
changeset
|
1830 |
| 0 | 1831 divemode_simulator_check_limits: |
| 604 | 1832 ; check limits (150m and 0m) |
| 1833 movlw LOW d'16000' ; compare to 16 bar = 16000 mbar (150m) | |
| 582 | 1834 subwf sim_pressure+0,W |
| 1835 movlw HIGH d'16000' | |
| 1836 subwfb sim_pressure+1,W | |
| 604 | 1837 bnc divemode_simulator_check_limits2 ; no carry = borrow = not deeper |
| 1838 | |
| 1839 ; too deep, limit to 150m | |
| 582 | 1840 movlw LOW d'16000' |
| 0 | 1841 movwf sim_pressure+0 |
| 582 | 1842 movlw HIGH d'16000' |
| 0 | 1843 movwf sim_pressure+1 |
| 1844 return | |
| 604 | 1845 |
| 0 | 1846 divemode_simulator_check_limits2: |
| 604 | 1847 movlw LOW d'1000' ; compare to 1 bar == 0m == 1000 mbar |
| 582 | 1848 subwf sim_pressure+0,W |
| 1849 movlw HIGH d'1000' | |
| 1850 subwfb sim_pressure+1,W | |
| 604 | 1851 btfsc STATUS,C ; no carry = borrow = not deeper |
| 1852 return ; deeper than 0 m == ok | |
| 1853 ; too shallow, limit to 0m | |
| 582 | 1854 movlw LOW d'1000' |
| 0 | 1855 movwf sim_pressure+0 |
| 582 | 1856 movlw HIGH d'1000' |
| 0 | 1857 movwf sim_pressure+1 |
| 1858 return | |
| 1859 | |
| 1860 ;============================================================================= | |
| 604 | 1861 ; Find the best gas and diluent for the current depth |
| 1862 ; and check if a gas/diluent change is to be advised. | |
| 1863 ; | |
| 1864 ; Output: best_gas_number : number of best gas, 0= none avail, 255= not computed | |
| 1865 ; best_dil_number : number of best dil, 0= none avail, 255= not computed | |
| 1866 ; better_gas_available : flag indicating if a change is advised | |
| 1867 ; better_dil_available : flag indicating if a change is advised | |
| 1868 ; | |
| 1869 ; | |
| 1870 ; in CCR and pSCR mode: - checks both, gases and diluents for respective best gas / best diluent | |
| 1871 ; - if not in bailout, sets better_dil_available on diluents | |
| 1872 ; - if in bailout, sets better_gas_available on OC gases | |
| 1873 ; | |
| 1874 ; in OC mode : - checks only gases for best gas | |
| 1875 ; - sets better_gas_available on OC gases | |
| 0 | 1876 ; |
| 604 | 1877 check_gas_best: |
| 1878 movff amb_press_10+0,xA+0 ; copy ambient pressure / 10 into xA:2, will be used by ppO2 min/max checks later | |
| 1879 movff amb_press_10+1,xA+1 ; ... | |
| 1880 ; set maximum ppO2 allowed | |
| 1881 movff char_I_ppO2_max,ppO2_max ; max ppO2 for working phase (default) | |
| 1882 movff char_O_deco_info,lo ; bank-safe copy of deco info vector | |
| 1883 btfsc lo,deco_flag ; is the ppo2 deco limit enabled? | |
| 1884 movff char_I_ppO2_max_deco,ppO2_max ; YES - replace by max ppO2 for deco phase | |
| 1885 ; check dive mode | |
| 1886 btfsc FLAG_oc_mode ; in OC mode? | |
| 1887 bra check_gas_best_gas ; YES - skip diluents, check for best gas only | |
| 1888 | |
| 1889 check_gas_best_dil: | |
| 1890 ; set minimum ppO2 required | |
| 1891 movff char_I_ppO2_min,WREG ; min ppO2 for pure diluent in CCR mode (default) | |
| 1892 btfsc FLAG_pscr_mode ; in pSCR mode? | |
| 1893 movff char_I_ppO2_min_loop,ppO2_min ; YES - replace by min ppO2 for pure diluent in pSCR mode | |
| 1894 ; preset results to nothing found | |
| 1895 clrf best_gas_num ; initialize best diluent as 0 = nothing found yet | |
| 1896 bcf better_dil_available ; =1: a better diluent is available and a gas change is advised in divemode | |
| 1897 ; ; current diluent = 'gas6' ? | |
| 1898 ; movlw .6 ; | |
| 1899 ; cpfseq active_dil ; using 'gas6' as current diluent? | |
| 1900 ; bra check_gas_best_dil0 ; NO - continue | |
| 1901 ; bra check_gas_best_dil3 ; YES - suppress better diluent search in this case | |
| 1902 ;check_gas_best_dil0: | |
| 1903 ; check all diluents | |
| 1904 lfsr FSR1,opt_dil_O2_ratio ; set base address for diluent arrays | |
| 1905 movff active_dil,lo ; number of currently used diluent | |
| 1906 setf best_gas_depth ; initialize change depth of best dil found so far to 255 meter | |
| 1907 ; original code | |
| 1908 clrf check_gas_num | |
| 1909 incf check_gas_num,F | |
| 1910 rcall check_gas_best_common ; check diluent 1 | |
| 1911 incf check_gas_num,F | |
| 1912 rcall check_gas_best_common ; check diluent 2 | |
| 1913 incf check_gas_num,F | |
| 1914 rcall check_gas_best_common ; check diluent 3 | |
| 1915 incf check_gas_num,F | |
| 1916 rcall check_gas_best_common ; check diluent 4 | |
| 1917 incf check_gas_num,F | |
| 1918 rcall check_gas_best_common ; check diluent 5 | |
| 1919 ; alternative code | |
| 1920 ; movlw .5 | |
| 1921 ; movwf check_gas_num | |
| 1922 ;check_gas_best_dil_loop: | |
| 1923 ; rcall check_gas_best_common | |
| 1924 ; decfsz check_gas_num | |
| 1925 ; bra check_gas_best_dil_loop | |
| 0 | 1926 ; |
| 604 | 1927 ; store result |
| 1928 movff best_gas_num,best_dil_number ; store new best diluent found (1-5 or 0 of no usable diluent available) | |
| 1929 ; check if change advices shall be given in general | |
| 1930 btfsc FLAG_bailout_mode ; in bailout? | |
| 1931 bra check_gas_best_gas ; YES - no better diluent advice when in bailout | |
| 1932 check_gas_best_dil1: | |
| 1933 ; check if a change advice shall be given right now | |
| 1934 movf best_dil_number,W ; load number of best diluent into WREG (1-5) | |
| 1935 bz check_gas_best_dil3 ; has a best diluent been found at all? NO - nothing to signal for | |
| 1936 cpfseq active_dil ; is this the currently used diluent? | |
| 1937 bra check_gas_best_dil2 ; NO | |
| 1938 bra check_gas_best_dil3 ; YES - no need to signal a better diluent if this diluent is already in use | |
| 1939 check_gas_best_dil2: | |
| 1940 btfsc setpoint_fallback ; is a fallback warning active? | |
| 1941 bra check_gas_best_dil3 ; YES - suppress better diluent prompt in this case | |
| 1942 ; not using the best gas - show better diluent hint whenever a better diluent is available | |
| 1943 bsf better_dil_available ; signal that a better diluent is available | |
| 1944 bsf FLAG_TFT_active_gas_divemode ; redraw gas/setpoint/diluent | |
| 1945 check_gas_best_dil3: | |
| 1946 btfss better_dil_available ; shall a better diluent be signaled for? | |
| 1947 bcf blinking_better_dil ; NO - clear blinking flag | |
| 1948 ; continue with checking for best bailout gas | |
| 1949 | |
| 1950 check_gas_best_gas: | |
| 1951 ; set minimum ppO2 required | |
| 1952 movff char_I_ppO2_min,ppO2_min ; min ppO2 for OC/Bailout | |
| 1953 ; preset results to nothing found | |
| 1954 clrf best_gas_num ; initialize best gas as 0 = nothing found yet | |
| 1955 bcf better_gas_available ; =1: a better gas is available and a gas change is advised in divemode | |
| 1956 ; ; current gas = 'gas6' ? | |
| 1957 ; movlw .6 ; | |
| 1958 ; cpfseq active_gas ; using 'gas6' as current gas? | |
| 1959 ; bra check_gas_best_gas0 ; NO - continue | |
| 1960 ; bra check_gas_best_gas3 ; YES - suppress better gas search in this case | |
| 1961 ;check_gas_best_gas0: | |
| 1962 ; check all gases | |
| 1963 lfsr FSR1,opt_gas_O2_ratio ; set base address for gas arrays | |
| 1964 movff active_gas,lo ; number of currently used gas | |
| 1965 setf best_gas_depth ; initialize change depth of best gas found so far to 255 meter | |
| 1966 ; original code | |
| 1967 clrf check_gas_num | |
| 1968 incf check_gas_num,F | |
| 1969 rcall check_gas_best_common ; check gas 1 | |
| 1970 incf check_gas_num,F | |
| 1971 rcall check_gas_best_common ; check gas 2 | |
| 1972 incf check_gas_num,F | |
| 1973 rcall check_gas_best_common ; check gas 3 | |
| 1974 incf check_gas_num,F | |
| 1975 rcall check_gas_best_common ; check gas 4 | |
| 1976 incf check_gas_num,F | |
| 1977 rcall check_gas_best_common ; check gas 5 | |
| 1978 ; alternative code | |
| 1979 ; movlw .5 | |
| 1980 ; movwf check_gas_num | |
| 1981 ;check_gas_best_gas_loop: | |
| 1982 ; rcall check_gas_best_common | |
| 1983 ; decfsz check_gas_num | |
| 1984 ; bra check_gas_best_gas_loop | |
| 1985 ; | |
| 1986 ; store result | |
| 1987 movff best_gas_num,best_gas_number ; store new best gas found (1-5 or 0 of no usable gas available) | |
| 1988 ; check if change advices shall be given in general | |
| 1989 btfsc FLAG_oc_mode ; in OC mode? | |
| 1990 bra check_gas_best_gas1 ; YES | |
| 1991 btfsc FLAG_bailout_mode ; in bailout? | |
| 1992 bra check_gas_best_gas1 ; YES | |
| 1993 return ; NO - no better (OC) gas advice when not in OC or bailout mode | |
| 1994 check_gas_best_gas1: ; check if we are already on the best gas | |
| 1995 ; check if a change advice shall be given right now | |
| 1996 movf best_gas_number,W ; load number of best gas into WREG (1-5) | |
| 1997 bz check_gas_best_gas3 ; has a best gas been found at all? NO - nothing to signal for | |
| 1998 cpfseq active_gas ; is this the currently used gas? | |
| 1999 bra check_gas_best_gas2 ; NO | |
| 2000 bra check_gas_best_gas3 ; YES - no need to signal a better gas if this gas is already in use | |
| 2001 check_gas_best_gas2: | |
| 2002 ; not using the best gas - show better gas hint whenever a better gas is available | |
| 2003 bsf better_gas_available ; YES - signal that a better gas is available | |
| 2004 bsf FLAG_TFT_active_gas_divemode ; YES - redraw gas/setpoint/diluent | |
| 2005 check_gas_best_gas3: | |
| 2006 btfss better_gas_available ; shall a better gas be signaled for? | |
| 2007 bcf blinking_better_gas ; NO - clear blinking flag | |
| 582 | 2008 return |
| 0 | 2009 |
| 604 | 2010 check_gas_best_common: ; with gas to be checked in check_gas_num (1-5) |
| 2011 ; ; and current gas in lo (1-5) | |
| 2012 ; | |
| 2013 ; Memory Map: | |
| 2014 ; --------------------------------------------------------------------------------------- | |
| 2015 ; opt_gas_O2_ratio res 5 ; base address for gases | |
| 2016 ; opt_dil_O2_ratio res 5 ; base address for diluents | |
| 2017 ; opt_gas_He_ratio res 5 ; (not needed here) | |
| 2018 ; opt_dil_He_ratio res 5 ; (not needed here) | |
| 2019 ; opt_gas_type res 5 ; has offset of 20 bytes from base address for gases | |
| 2020 ; opt_dil_type res 5 ; has offset of 20 bytes from base address for diluents | |
| 2021 ; opt_gas_change res 5 ; has offset of 10 bytes from opt_gas_type | |
| 2022 ; opt_dil_change res 5 ; has offset of 10 bytes from opt_dil_type | |
| 2023 | |
| 2024 ; get gas data | |
| 2025 decf check_gas_num,W ; (1-5) -> (0-4) into WREG to be used as index | |
| 2026 movff PLUSW1,check_gas_O2_ratio ; load O2 ratio (%) of current gas/dil into check_gas_O2_ratio | |
| 2027 addlw .20 ; add offset of 20 bytes to index type in opt_gas_type/opt_dil_type | |
| 2028 movff PLUSW1,check_gas_type ; load type of current gas/dil into check_gas_type (0=disabled, 1=first, 2=travel/normal, 3=deco/-) | |
| 2029 addlw .10 ; add offset of 10 bytes to index change depth in opt_gas_change/opt_dil_change | |
| 2030 movff PLUSW1,check_gas_depth ; load change depth of current gas/dil into check_gas_depth | |
| 2031 ; check if gas is usable (i.e. not disabled) | |
| 2032 tstfsz check_gas_type ; type = disabled (0)? | |
| 2033 bra check_gas_best_common0 ; NO - continue checks | |
| 2034 movf check_gas_num,W ; YES - get the number of the gas to be checked (1-5) | |
| 2035 cpfseq lo ; - is this the currently used gas? | |
| 2036 return ; NO - skip disabled gases which are not the current gas | |
| 2037 bra check_gas_best_common1 ; YES - a gas in use overrides it's disabled status, therefore treat it as available | |
| 2038 check_gas_best_common0: | |
| 2039 ; skip deco gases (type=3) if not in deco mode, but search among all enabled gases when in loop or bailout mode | |
| 2040 movlw .3 | |
| 2041 cpfseq check_gas_type ; type = deco (3)? | |
| 2042 bra check_gas_best_common1 ; NO - proceed | |
| 2043 btfsc FLAG_bailout_mode ; YES - in bailout? | |
| 2044 bra check_gas_best_common1 ; YES - proceed, include deco gases | |
| 2045 movff char_O_main_status,WREG ; NO - get main deco mode | |
| 2046 btfsc WREG,DECO_MODE_LOOP_FLAG ; - in loop mode? | |
| 2047 bra check_gas_best_common1 ; YES - proceed, include deco gases | |
| 2048 movff char_O_deco_info,WREG ; NO - get deco info vector | |
| 2049 btfss WREG,deco_flag ; - in deco mode (deco_flag set), i.e. use of deco gases allowed? | |
| 2050 return ; NO - skip deco gas while not in deco mode | |
| 2051 check_gas_best_common1: ; YES - proceed | |
| 2052 ; ; check if gas change depth is below minimum change depth | |
| 2053 ; movlw minimum_change_depth ; for value see definition in hwos.inc | |
| 2054 ; cpfsgt check_gas_depth ; change depth of checked gas > minimum_change_depth? | |
| 2055 ; return ; NO - change depth not deep enough, skip and check next gas | |
| 2056 ; check if gas is usable, i.e. its change depth is below or equal to the current depth | |
| 2057 movf curr_depth,W ; load current depth (in m) into WREG | |
| 2058 cpfslt check_gas_depth ; change depth of checked gas < (shallower than) current depth? | |
| 2059 bra check_gas_best_common2 ; NO - gas is usable | |
| 2060 return ; YES - gas is not usable | |
| 2061 check_gas_best_common2: | |
| 2062 ; check if this gas is the first best gas candidate | |
| 2063 movf best_gas_num,W ; get best gas found so far (1-5) or 0 if none found yet | |
| 2064 tstfsz WREG ; has a best gas candidate been found yet? | |
| 2065 bra check_gas_best_common3 ; YES - check if the new one is better than the one we have so far | |
| 2066 bra check_gas_best_common4 ; NO - no need to do the above mentioned check | |
| 2067 check_gas_best_common3: | |
| 2068 ; check if the change depth of the checked gas is < (shallower) than the change depth of the best gas found so far | |
| 2069 movf best_gas_depth,W ; load change depth of best gas so far into WREG | |
| 2070 cpfslt check_gas_depth ; change depth of checked gas < (shallower than) change depth of best gas so far? | |
| 2071 return ; NO - this gas is not better than the best already found | |
| 2072 check_gas_best_common4: | |
| 2073 ; check if the gas fits into the ppO2 limits | |
| 2074 movff check_gas_O2_ratio,xB+0 ; xB = O2 ratio, xA is still loaded with (p_amb / 10) | |
| 69 | 2075 clrf xB+1 |
| 604 | 2076 call mult16x16 ; xC = O2 ratio * (p_amb / 10) |
| 2077 ; check for very high ppO2 | |
| 2078 tstfsz xC+2 ; O2_ratio * p_amb / 10 > 65536, i.e. ppO2 > 6.55 bar ? | |
| 2079 return ; YES - gas is not usable | |
| 2080 btfsc xC+1,7 ; check if ppO2 > 3.30 bar | |
| 2081 return ; YES - gas is not usable | |
| 2082 ; check for low ppO2 | |
|
526
0d1cda9f2d43
BUGFIX: Skip MOD Test for CCR in Sensor modes (OSTC cR and OSTC3 only)
heinrichsweikamp
parents:
521
diff
changeset
|
2083 movff xC+0,sub_a+0 |
|
0d1cda9f2d43
BUGFIX: Skip MOD Test for CCR in Sensor modes (OSTC cR and OSTC3 only)
heinrichsweikamp
parents:
521
diff
changeset
|
2084 movff xC+1,sub_a+1 |
| 604 | 2085 movf ppO2_min,W |
| 2086 mullw .100 ; char_I_ppO2_min * 100 | |
|
526
0d1cda9f2d43
BUGFIX: Skip MOD Test for CCR in Sensor modes (OSTC cR and OSTC3 only)
heinrichsweikamp
parents:
521
diff
changeset
|
2087 movff PRODL,sub_b+0 |
|
0d1cda9f2d43
BUGFIX: Skip MOD Test for CCR in Sensor modes (OSTC cR and OSTC3 only)
heinrichsweikamp
parents:
521
diff
changeset
|
2088 movff PRODH,sub_b+1 |
| 604 | 2089 call subU16 ; sub_c = sub_a - sub_b |
| 2090 btfsc neg_flag ; within limit? | |
| 2091 return ; NO - too low, gas is not usable | |
| 2092 ; check for high ppO2 | |
| 2093 movf ppO2_max,W | |
| 2094 mullw .100 ; ppO2_max * 100 | |
| 2095 movff PRODL,sub_b+0 | |
| 2096 movff PRODH,sub_b+1 | |
| 2097 infsnz sub_b+0,F ; add 1 mbar to allowance to avoid exclusion on equal | |
| 2098 incf sub_b+1,F | |
| 2099 call subU16 ; sub_c = sub_a - sub_b | |
| 2100 btfss neg_flag ; within limit? | |
| 2101 return ; NO - too high, gas is not usable | |
| 2102 ; we have a (new) best gas | |
| 2103 movff check_gas_num, best_gas_num ; set checked gas (1-5) as best gas | |
| 2104 movff check_gas_depth,best_gas_depth ; memorize its change depth | |
| 582 | 2105 return |
| 0 | 2106 |
|
338
2811932b4e99
NEW: Mode Auto SP: Automatically switches the SP during descent (CC Mode)
heinrichsweikamp
parents:
337
diff
changeset
|
2107 |
|
2811932b4e99
NEW: Mode Auto SP: Automatically switches the SP during descent (CC Mode)
heinrichsweikamp
parents:
337
diff
changeset
|
2108 ;============================================================================= |
|
2811932b4e99
NEW: Mode Auto SP: Automatically switches the SP during descent (CC Mode)
heinrichsweikamp
parents:
337
diff
changeset
|
2109 ; Check for Auto-SP |
|
2811932b4e99
NEW: Mode Auto SP: Automatically switches the SP during descent (CC Mode)
heinrichsweikamp
parents:
337
diff
changeset
|
2110 ; |
| 604 | 2111 check_dive_autosp: ; check for Auto-SP |
| 582 | 2112 movff opt_ccr_mode,WREG ; =0: Fixed SP, =1: Sensor, =2: Auto SP |
| 2113 sublw .2 ; opt_ccr_mode = 2 (Auto SP)? | |
| 604 | 2114 bz check_dive_autosp2 ; YES - check |
| 2115 return ; NO - return for sensor or fixed mode | |
|
338
2811932b4e99
NEW: Mode Auto SP: Automatically switches the SP during descent (CC Mode)
heinrichsweikamp
parents:
337
diff
changeset
|
2116 check_dive_autosp2: |
| 582 | 2117 ; Check SP2 |
| 604 | 2118 btfsc sp2_switched ; SP 2 used so far? |
| 2119 bra check_dive_autosp3 ; YES - continue with SP 3 | |
| 2120 movff char_I_setpoint_change+1,lo ; NO - get depth in m | |
| 2121 tstfsz lo ; - SP change depth = 0 ? | |
| 2122 bra check_dive_autosp2a ; NO - continue | |
| 2123 bra check_dive_autosp3 ; YES - continue with SP 3 | |
| 560 | 2124 check_dive_autosp2a: |
| 604 | 2125 decf lo,W ; SP change depth -1 -> WREG |
| 2126 cpfsgt curr_depth ; current depth > change depth - 1 ? | |
| 2127 bra check_dive_autosp3 ; NO - continue with SP 3 | |
| 582 | 2128 ; auto switch to SP2 |
| 604 | 2129 movff char_I_setpoint_cbar+1,char_I_const_ppO2 ; YES - use SP |
| 2130 rcall xmit_sp_set_flag ; - send SP to external devices | |
| 2131 bsf sp2_switched ; - set SP 2 used flag | |
|
338
2811932b4e99
NEW: Mode Auto SP: Automatically switches the SP during descent (CC Mode)
heinrichsweikamp
parents:
337
diff
changeset
|
2132 check_dive_autosp3: |
| 582 | 2133 ; Check SP3 |
| 604 | 2134 btfsc sp3_switched ; SP 3 used so far? |
| 2135 bra check_dive_autosp4 ; YES - continue with SP 4 | |
| 2136 movff char_I_setpoint_change+2,lo ; NO - get depth in m | |
| 2137 tstfsz lo ; - SP change depth = 0 ? | |
| 2138 bra check_dive_autosp3a ; NO - continue | |
| 2139 bra check_dive_autosp4 ; YES - continue with SP 4 | |
| 560 | 2140 check_dive_autosp3a: |
| 604 | 2141 decf lo,W ; SP change depth -1 -> WREG |
| 2142 cpfsgt curr_depth ; current depth > change depth - 1 ? | |
| 2143 bra check_dive_autosp4 ; NO - continue with SP 4 | |
| 582 | 2144 ; auto switch to SP3 |
| 604 | 2145 movff char_I_setpoint_cbar+2,char_I_const_ppO2 ; YES - use SP |
| 2146 rcall xmit_sp_set_flag ; - send SP to external devices | |
| 2147 bsf sp3_switched ; - set SP 3 used flag | |
|
338
2811932b4e99
NEW: Mode Auto SP: Automatically switches the SP during descent (CC Mode)
heinrichsweikamp
parents:
337
diff
changeset
|
2148 check_dive_autosp4: |
| 582 | 2149 ; Check SP4 |
| 604 | 2150 btfsc sp4_switched ; SP 4 used so far? |
| 2151 bra check_dive_autosp5 ; YES - continue with SP 5 | |
| 2152 movff char_I_setpoint_change+3,lo ; NO - get depth in m | |
| 2153 tstfsz lo ; - SP change depth = 0 ? | |
| 2154 bra check_dive_autosp4a ; NO - continue | |
| 2155 bra check_dive_autosp5 ; YES - continue with SP 5 | |
| 560 | 2156 check_dive_autosp4a: |
| 604 | 2157 decf lo,W ; SP change depth -1 -> WREG |
| 2158 cpfsgt curr_depth ; current depth > change depth - 1 ? | |
| 2159 bra check_dive_autosp5 ; NO - continue with SP 5 | |
| 582 | 2160 ; auto switch to SP4 |
| 604 | 2161 movff char_I_setpoint_cbar+3,char_I_const_ppO2 ; YES - use SP |
| 2162 rcall xmit_sp_set_flag ; - send SP to external devices | |
| 2163 bsf sp4_switched ; - set SP 4 used flag | |
|
338
2811932b4e99
NEW: Mode Auto SP: Automatically switches the SP during descent (CC Mode)
heinrichsweikamp
parents:
337
diff
changeset
|
2164 check_dive_autosp5: |
| 582 | 2165 ; Check SP5 |
| 604 | 2166 btfsc sp5_switched ; SP 5 used so far? |
| 2167 bra check_dive_autosp6 ; YES - done | |
| 2168 movff char_I_setpoint_change+4,lo ; NO - get depth in m | |
| 2169 tstfsz lo ; - SP change depth = 0 ? | |
| 2170 bra check_dive_autosp5a ; NO - continue | |
| 2171 bra check_dive_autosp6 ; YES - done | |
| 560 | 2172 check_dive_autosp5a: |
| 604 | 2173 decf lo,W ; SP change depth -1 -> WREG |
| 2174 cpfsgt curr_depth ; current depth > change depth - 1 ? | |
| 2175 bra check_dive_autosp6 ; NO - done | |
| 582 | 2176 ; auto switch to SP5 |
| 604 | 2177 movff char_I_setpoint_cbar+4,char_I_const_ppO2 ; YES - use SP |
| 2178 rcall xmit_sp_set_flag ; - send SP to external devices | |
| 2179 bsf sp5_switched ; - set SP 5 used flag | |
|
352
5c6da9fa5cb0
add setpoint change to first sample in CCR mode
heinrichsweikamp
parents:
339
diff
changeset
|
2180 check_dive_autosp6: |
| 582 | 2181 return |
|
352
5c6da9fa5cb0
add setpoint change to first sample in CCR mode
heinrichsweikamp
parents:
339
diff
changeset
|
2182 |
|
5c6da9fa5cb0
add setpoint change to first sample in CCR mode
heinrichsweikamp
parents:
339
diff
changeset
|
2183 xmit_sp_set_flag: |
| 582 | 2184 movff char_I_const_ppO2,WREG |
| 604 | 2185 call transmit_setpoint ; transmit current setpoint from WREG (in cbar) to external electronics |
| 2186 bsf setpoint_changed ; set flag (for profile) | |
| 2187 bsf event_occured ; set event flag | |
| 582 | 2188 return |
| 2189 | |
| 2190 set_logbook_marker: | |
| 2191 bcf FLAG_set_marker ; clear flag | |
| 604 | 2192 movlw d'6' ; set type of alarm (manual marker) |
| 2193 movwf AlarmType ; copy to alarm register | |
| 2194 bsf event_occured ; set event flag | |
| 582 | 2195 return |
|
338
2811932b4e99
NEW: Mode Auto SP: Automatically switches the SP during descent (CC Mode)
heinrichsweikamp
parents:
337
diff
changeset
|
2196 |
| 0 | 2197 ;============================================================================= |
| 604 | 2198 ; Setup everything to enter dive mode |
| 0 | 2199 ; |
| 604 | 2200 global dive_boot_oc_bail |
| 2201 dive_boot_oc_bail: | |
| 2202 ; copy opt_gas_types into backup (for "lost gas" feature) | |
| 2203 movff opt_gas_type+0,opt_gas_type_backup+0 ; 0=Disabled, 1=First, 2=Travel, 3=Deco | |
| 2204 movff opt_gas_type+1,opt_gas_type_backup+1 ; 0=Disabled, 1=First, 2=Travel, 3=Deco | |
| 2205 movff opt_gas_type+2,opt_gas_type_backup+2 ; 0=Disabled, 1=First, 2=Travel, 3=Deco | |
| 2206 movff opt_gas_type+3,opt_gas_type_backup+3 ; 0=Disabled, 1=First, 2=Travel, 3=Deco | |
| 2207 movff opt_gas_type+4,opt_gas_type_backup+4 ; 0=Disabled, 1=First, 2=Travel, 3=Deco | |
| 2208 ; done | |
| 2209 return | |
| 2210 | |
| 2211 global dive_boot_oc | |
| 0 | 2212 dive_boot_oc: |
| 604 | 2213 ; set-up registers |
| 2214 rcall get_first_gas_to_WREG ; get first gas (1-5) into WREG | |
| 582 | 2215 rcall setup_gas_registers ; set-up of gas parameters of currently breathed gas (with WREG = gas 1-5) |
| 2216 rcall deco_setup_oc_gases ; set-up of gas list for deco calculations (with WREG = gas 1-5) | |
| 2217 return | |
| 0 | 2218 |
| 604 | 2219 global dive_boot_cc |
| 0 | 2220 dive_boot_cc: |
| 604 | 2221 ; copy opt_dil_types into backup (for "lost diluent" feature) |
| 2222 movff opt_dil_type+0,opt_dil_type_backup+0 ; 0=Disabled, 1=First, 2=Normal | |
| 2223 movff opt_dil_type+1,opt_dil_type_backup+1 ; 0=Disabled, 1=First, 2=Normal | |
| 2224 movff opt_dil_type+2,opt_dil_type_backup+2 ; 0=Disabled, 1=First, 2=Normal | |
| 2225 movff opt_dil_type+3,opt_dil_type_backup+3 ; 0=Disabled, 1=First, 2=Normal | |
| 2226 movff opt_dil_type+4,opt_dil_type_backup+4 ; 0=Disabled, 1=First, 2=Normal | |
| 2227 ; clear flags | |
| 2228 bcf FLAG_bailout_mode ; =1: bailout | |
| 2229 bcf setpoint_fallback ; =1: fallback to SP1 due to external O2 sensor failure | |
| 2230 ; set-up registers | |
| 2231 rcall get_first_dil_to_WREG ; get first diluent (1-5) into WREG | |
| 2232 rcall setup_dil_registers ; set-up of diluent parameters for currently breathed diluent (with WREG = current diluent 1-5) | |
| 2233 rcall deco_setup_cc_diluents ; set-up of diluent list for deco calculations (with WREG = current diluent 1-5) | |
| 2234 ; done | |
| 2235 return | |
| 2236 | |
| 2237 dive_boot_cc_part2: | |
| 560 | 2238 ; revoke sensors from usage if they do not have a valid calibration |
| 2239 bsf use_O2_sensor1 | |
| 2240 bsf use_O2_sensor2 | |
| 2241 bsf use_O2_sensor3 | |
| 2242 btfss sensor1_calibrated_ok | |
| 2243 bcf use_O2_sensor1 | |
| 2244 btfss sensor2_calibrated_ok | |
| 2245 bcf use_O2_sensor2 | |
| 2246 btfss sensor3_calibrated_ok | |
| 2247 bcf use_O2_sensor3 | |
| 604 | 2248 ; check for external HUD/ppO2 Monitor |
| 583 | 2249 btfss optical_input ; do we have an optical input? |
| 604 | 2250 bra dive_boot_cc_part2_1 ; NO |
| 2251 ; copy (initial) valid flags from HUD/ppO2 Monitor | |
| 583 | 2252 btfsc sensor1_active |
| 604 | 2253 bsf use_O2_sensor1 |
| 2254 btfsc sensor2_active | |
| 2255 bsf use_O2_sensor2 | |
| 583 | 2256 btfsc sensor3_active |
| 604 | 2257 bsf use_O2_sensor3 |
| 2258 dive_boot_cc_part2_1: | |
| 560 | 2259 ; In pSCR mode, only settings 0 (calculated ppO2) and 1 (ppO2 from sensors) are defined. |
| 604 | 2260 ; In case we still have 3 (auto SP) selected out of previous CCR mode, we reset to 0. |
| 560 | 2261 btfss FLAG_pscr_mode |
| 604 | 2262 bra dive_boot_cc_part2_2 |
| 582 | 2263 movff opt_ccr_mode,WREG ; =0: Fixed SP (CCR) / calculated SP (pSCR), =1: Sensor, =2: Auto SP |
| 2264 sublw .2 ; opt_ccr_mode = 1 (Auto SP)? | |
| 604 | 2265 bnz dive_boot_cc_part2_2 |
| 560 | 2266 movlw .0 |
| 2267 movff WREG,opt_ccr_mode | |
| 604 | 2268 dive_boot_cc_part2_2: |
| 582 | 2269 bsf setpoint_changed ; set flag (for profile) |
| 604 | 2270 bcf sp2_switched ; =1: this setpoint has been auto-selected already |
| 2271 bcf sp3_switched ; =1: this setpoint has been auto-selected already | |
| 2272 bcf sp4_switched ; =1: this setpoint has been auto-selected already | |
| 2273 bcf sp5_switched ; =1: this setpoint has been auto-selected already | |
| 560 | 2274 ; Start with SP1 (CCR) or 0 (pSCR) as default. |
| 2275 ; If in sensor mode, this value will be overwritten by calc_deko_divemode_sensor | |
| 582 | 2276 clrf WREG ; preload WREG with setpoint value 0 for pSCR calculated |
| 604 | 2277 btfsc FLAG_ccr_mode ; are we in CCR mode? |
| 582 | 2278 movff char_I_setpoint_cbar+0,WREG ; YES - get value of setpoint 1 |
| 2279 movff WREG,char_I_const_ppO2 ; write setpoint to deco engine | |
| 2280 call transmit_setpoint ; transmit current setpoint from WREG (in cbar) to external electronics | |
| 2281 goto calc_deko_divemode_sensor ; read & process sensor data (and return) | |
| 0 | 2282 |
| 604 | 2283 |
| 0 | 2284 diveloop_boot: |
| 604 | 2285 |
| 2286 ; do the basic initialization | |
| 0 | 2287 call restart_set_modes_and_flags |
| 2288 | |
| 604 | 2289 ; stop accelerometer and compass |
| 2290 call I2C_sleep_accelerometer | |
| 2291 call I2C_sleep_compass | |
| 2292 | |
| 2293 ; reset max pressure aka max depth | |
| 2294 clrf WREG | |
| 2295 movff WREG,max_pressure+0 | |
| 2296 movff WREG,max_pressure+1 | |
| 2297 | |
| 2298 ; initialize press needs to zero and invalid (not yet computed) state | |
| 2299 clrf WREG ; set WREG to 0 | |
| 2300 IFDEF _cave_mode | |
| 2301 movff WREG,char_I_backtrack_time ; clear backtracking time (index to char_I_backtrack_depth) | |
| 2302 movff WREG,char_I_backtrack_depth ; prime first entry with depth 0 | |
| 2303 ENDIF | |
| 2304 bsf WREG,int_is_zero ; set zero flag | |
| 2305 bsf WREG,int_invalid_flag ; set invalid flag (additionally) | |
| 2306 banksel int_O_ascent_pres_need ; select bank with shared output vars | |
| 2307 movwf int_O_ascent_pres_need+1 ; Set flags for tank pressure needs = 0 before p2_deco.c | |
| 2308 movwf int_O_ascent_pres_need+3 ; can do it. If this is not done here and the gas needs | |
| 2309 movwf int_O_ascent_pres_need+5 ; custom view is shown before p2_deco.c completes the first | |
| 2310 movwf int_O_ascent_pres_need+7 ; deco calculation, some rubbish numbers from last dive or | |
| 2311 movwf int_O_ascent_pres_need+9 ; simulation may be shown | |
| 2312 banksel common ; back to bank common | |
| 2313 | |
| 2314 ; configure the deco engine | |
| 2315 clrf hi | |
| 2316 bsf hi,DECO_Z_FACTOR_FLAG ; enable Z factor mode by default | |
| 2317 TSTOSS opt_ZfactorUse ; shall use Z factor mode? | |
| 2318 bcf hi,DECO_Z_FACTOR_FLAG ; NO - disable again | |
| 2319 IFDEF _rx_functions | |
| 2320 bsf hi,DECO_TR_FUNCTIONS ; enable TR mode by default | |
| 2321 btfss FLAG_tr_enabled ; shall use TR mode? | |
| 2322 bcf hi,DECO_TR_FUNCTIONS ; NO - disable again | |
| 2323 ENDIF | |
| 2324 movff hi,char_O_main_status ; bank-safe copy to deco engine | |
| 2325 | |
| 2326 movff char_O_deco_status,lo ; bank-safe read | |
| 2327 bsf lo,DECO_STATUS_0_FLAG ; set init- | ATTENTION: The deco engine must be started in init state! If omitted, it may | |
| 2328 bsf lo,DECO_STATUS_1_FLAG ; state, | enter an infinite loop at some point in time and brick the OSTC! | |
| 2329 bcf lo,DECO_PLAN_FLAG ; normal plan mode, | |
| 2330 bcf lo,DECO_VOLUME_FLAG ; disable gas volume calculation, and | |
| 2331 bcf lo,DECO_ASCENT_FLAG ; disable delayed ascent calculation | |
| 2332 movff lo,char_O_deco_status ; bank-safe copy back to deco engine | |
| 0 | 2333 |
| 2334 clrf WREG | |
| 604 | 2335 movff WREG,char_O_deco_warnings ; clear any deco warnings remaining from last dive |
| 2336 movff WREG,char_O_deco_info ; clear any deco infos remaining from last dive | |
| 2337 | |
| 2338 movlw deco_distance ; load distance between actual depth and depth used for deco calculation | |
| 2339 movff WREG,char_I_deco_distance ; write distance to the deco engine | |
| 2340 | |
| 2341 movff opt_last_stop,char_I_depth_last_deco ; write last stop depth to deco engine | |
| 2342 movff opt_GF_low,char_I_GF_Low_percentage ; write GF low to deco engine | |
| 2343 movff opt_GF_high,char_I_GF_High_percentage ; write GF high to deco engine | |
| 2344 | |
| 2345 bcf onesectoggle ; clear toggle bit for calculation phasing | |
| 2346 bcf use_agf ; start with normal GF set | |
| 2347 bcf divemode_menu ; clear dive mode menu flag | |
| 2348 bcf alternative_divelayout ; start with default layout | |
| 582 | 2349 bcf blinking_depth_prev ; clear flag for blinking depth |
| 2350 bcf blinking_depth_toggle ; clear flag for blinking depth | |
| 604 | 2351 bcf blinking_depth_warning ; clear flag for blinking depth as warning |
| 2352 bcf blinking_depth_attention ; clear flag for blinking depth as attention | |
| 2353 bcf max_depth_greater_100m ; clear flag for last max/avg depth was > 100 m | |
| 582 | 2354 |
| 0 | 2355 movlw d'1' |
| 2356 movwf apnoe_max_pressure+0 | |
| 2357 clrf apnoe_max_pressure+1 | |
| 386 | 2358 ; clrf apnoe_surface_mins |
| 582 | 2359 ; clrf apnoe_surface_secs |
| 604 | 2360 |
| 2361 ; copy date and time for logbook | |
| 582 | 2362 movff year,start_year |
| 2363 movff month,start_month | |
| 2364 movff day,start_day | |
| 2365 movff hours,start_hours | |
| 2366 movff mins,start_mins | |
| 2367 | |
| 2368 movff int_O_CNS_fraction+0,CNS_start+0 ; save CNS value at beginning of dive | |
| 2369 movff int_O_CNS_fraction+1,WREG ; get high byte to WREG | |
| 604 | 2370 bcf WREG,int_warning_flag ; clear warning flag |
| 2371 bcf WREG,int_attention_flag ; clear attention flag | |
| 582 | 2372 movff WREG,CNS_start+1 ; move high byte on |
| 2373 movff int_O_gradient_factor+0,GF_start ; save GF value at beginning of dive (only lower byte used for value) | |
| 545 | 2374 |
| 604 | 2375 bcf no_more_divesecs ; =1: do no longer show seconds in dive mode |
| 0 | 2376 bcf divemode_menu_active |
| 582 | 2377 clrf menupos1 |
| 604 | 2378 clrf menupos2 ; reset to zero (Zero=no pre-menu or simulator task) |
| 2379 bsf sensors_agree ; init of sensors disagree warning system | |
| 2380 | |
| 2381 bcf show_safety_stop ; =1: show the safety stop | |
| 2382 clrf safety_stop_countdown ; clear count-down | |
| 2383 | |
| 2384 clrf samplesecs ; timer for data logging | |
| 0 | 2385 clrf apnoe_timeout_counter ; timeout in minutes |
| 582 | 2386 clrf timeout_counter1+0 ; takes care of the timeout (low byte) |
| 2387 clrf timeout_counter1+1 ; takes care of the timeout (high byte) | |
| 0 | 2388 clrf AlarmType ; Clear all alarms |
| 2389 bcf event_occured ; clear flag | |
| 604 | 2390 clrf average_divesecs_total+0 ; clear non-resettable time accumulator |
| 2391 clrf average_divesecs_total+1 | |
| 2392 clrf average_depth_hold_total+0 ; clear non-resettable average depth | |
| 0 | 2393 clrf average_depth_hold_total+1 |
| 2394 clrf average_depth_hold_total+2 | |
| 604 | 2395 clrf average_depth_hold_total+3 |
| 2396 call reset_average ; reset the resettable average depth | |
| 2397 | |
| 2398 IFDEF _rx_functions | |
| 2399 btfss FLAG_tr_enabled ; TR functions enabled? | |
| 2400 bra diveloop_boot_0 ; NO - skip TR function initialization | |
| 2401 ; YES - initialize TR function variables | |
| 2402 banksel int_O_sac_rate | |
| 2403 clrf int_O_sac_rate+0 ; clear low byte of SAC rate | |
| 2404 clrf int_O_pressure_need+0 ; clear low byte of 1st pressure need value | |
| 2405 clrf int_O_pressure_need+2 ; clear low byte of 2nd pressure need value | |
| 2406 banksel int_IO_pressure_value | |
| 2407 clrf int_IO_pressure_value+0 ; clear low byte of 1st pressure reading value | |
| 2408 clrf int_IO_pressure_value+2 ; clear low byte of 2nd pressure reading value | |
| 2409 clrf int_I_pressure_drop+0 ; clear low byte of 1st pressure drop value | |
| 2410 clrf int_I_pressure_drop+2 ; clear low byte of 2nd pressure drop value | |
| 2411 clrf char_I_pressure_gas+0 ; clear gas selection of 1st pressure reading | |
| 2412 clrf char_I_pressure_gas+1 ; clear gas selection of 2nd pressure reading | |
| 2413 clrf char_I_pressure_age+0 ; clear age of 1st pressure reading | |
| 2414 clrf char_I_pressure_age+1 ; clear age of 2nd pressure reading | |
| 2415 clrf char_I_pressure_stat+0 ; clear status of 1st pressure reading | |
| 2416 clrf char_I_pressure_stat+1 ; clear status of 2nd pressure reading | |
| 2417 clrf WREG ; clear WREG | |
| 2418 bsf WREG,int_not_avail_flag ; set WREG to coding for integer numbers -> data not available | |
| 2419 banksel int_O_sac_rate | |
| 2420 movwf int_O_sac_rate+1 ; copy to high byte of SAC rate | |
| 2421 movwf int_O_pressure_need+1 ; copy to high byte of 1st pressure need value | |
| 2422 movwf int_O_pressure_need+3 ; copy to high byte of 1st pressure need value | |
| 2423 banksel int_IO_pressure_value | |
| 2424 movwf int_IO_pressure_value+1 ; copy to high byte of 1st pressure reading value | |
| 2425 movwf int_IO_pressure_value+3 ; copy to high byte of 2nd pressure reading value | |
| 2426 movwf int_I_pressure_drop+1 ; copy to high byte of 1st pressure drop value | |
| 2427 movwf int_I_pressure_drop+3 ; copy to high byte of 1st pressure drop value | |
| 2428 banksel gas__last_1st ; select bank with vars for pressure drop calculation | |
| 2429 setf gas__last_1st ; invalidate last gas of 1st reading | |
| 2430 setf gas__last_2nd ; invalidate last gas of 2nd reading | |
| 2431 banksel common ; back to bank common | |
| 2432 ENDIF | |
| 2433 | |
| 2434 diveloop_boot_0: | |
| 2435 bcf decostop_active ; clear flag for being in deco | |
| 2436 setf best_gas_number ; initialize best gas as not computed yet (255) | |
| 2437 setf best_dil_number ; initialize best diluent as not computed yet (255) | |
| 2438 bcf better_gas_available ; =1: a better gas is available and a gas change is advised | |
| 2439 bcf better_dil_available ; =1: a better diluent is available and a gas change is advised | |
| 2440 | |
| 2441 rcall dive_boot_oc_bail ; basic settings required for all modes | |
| 2442 | |
| 2443 btfsc FLAG_oc_mode ; in OC mode? | |
| 2444 rcall dive_boot_oc ; YES - add OC mode settings | |
| 2445 | |
| 2446 btfsc FLAG_ccr_mode ; in CCR mode? | |
| 2447 rcall dive_boot_cc ; YES - add CC mode settings | |
| 2448 btfsc FLAG_ccr_mode ; in CCR mode? | |
| 2449 rcall dive_boot_cc_part2 ; YES - add CC sensor and SP settings | |
| 2450 | |
| 2451 btfsc FLAG_pscr_mode ; in pSCR mode? | |
| 2452 rcall dive_boot_cc ; YES - add CC mode settings | |
| 2453 btfsc FLAG_pscr_mode ; in pSCR mode? | |
| 2454 rcall dive_boot_cc_part2 ; YES - add CC sensor and SP settings | |
| 2455 | |
| 2456 call ghostwriter_short_header ; write short header with dive number into profile memory | |
| 0 | 2457 |
| 582 | 2458 btfsc simulatormode_active |
| 2459 bra diveloop_boot_1 | |
| 604 | 2460 |
| 2461 ; normal mode = surface pressure is the pressure 30 minutes before dive | |
| 2462 SAFE_2BYTE_COPY last_surfpressure_30min, int_I_pres_surface ;copy surface pressure to deco routine | |
| 2463 SAFE_2BYTE_COPY last_surfpressure_30min, last_surfpressure ;copy surface pressure to last_surfpressure for correct depth | |
| 582 | 2464 bra diveloop_boot_2 |
| 0 | 2465 |
| 2466 diveloop_boot_1: | |
| 604 | 2467 ; simulator mode: set surface pressure to 1 bar because simulated depths are also based on 1 bar surface pressure |
| 2468 movlw LOW .1000 | |
| 2469 movff WREG,int_I_pres_surface+0 ; LOW copy surface pressure to deco routine | |
| 582 | 2470 movlw HIGH .1000 |
| 2471 movff WREG,int_I_pres_surface+1 ; HIGH copy surface pressure to deco routine | |
| 0 | 2472 |
| 2473 diveloop_boot_2: | |
| 604 | 2474 SAFE_2BYTE_COPY temperature,minimum_temperature ; reset minimum temperature registers |
| 0 | 2475 |
| 582 | 2476 call init_recording_params ; set up all the divisors |
| 0 | 2477 |
| 604 | 2478 bsf FLAG_diluent_setup ; for CCR mode (required to have better gas working) |
| 2479 btfsc FLAG_ccr_mode ; =1: CCR mode (fixed ppO2 or Sensor) active | |
| 2480 bra diveloop_boot_3 | |
| 582 | 2481 btfsc FLAG_pscr_mode |
| 604 | 2482 bra diveloop_boot_3 |
| 2483 bcf FLAG_diluent_setup ; for OC mode (required to have better gas working) | |
| 2484 | |
| 2485 diveloop_boot_3: | |
| 582 | 2486 bcf LEDg ; switch off green LED / release reset to RX circuitry |
| 604 | 2487 bcf LEDr ; switch off red LED |
| 0 | 2488 bcf realdive |
| 604 | 2489 btfss simulatormode_active ; in simulator mode? |
| 2490 call disable_rs232 ; NO - disable RS232 | |
| 2491 | |
| 2492 IFDEF _screendump | |
| 2493 btfsc enable_screen_dumps ; =1: ignore vin_usb, wait for "l" command (screen dump) | |
| 2494 call enable_rs232 ; also sets to speed_normal | |
| 2495 ENDIF | |
| 2496 | |
| 2497 ; reset dive time seconds | |
| 2498 ; movlw .2 ; start at 2 seconds | |
| 2499 ; movwf total_divetime_seconds+0 | |
| 2500 ; clrf total_divetime_seconds+1 | |
| 2501 ; movwf divesecs | |
| 2502 ; movwf apnoe_secs | |
| 2503 ; bsf divemode2 ; displayed dive time is running (dive time starts HERE) | |
| 2504 | |
| 2505 ; clear the timers (start dive times at zero) | |
| 2506 clrf total_divetime_seconds+0 | |
| 582 | 2507 clrf total_divetime_seconds+1 |
| 604 | 2508 clrf divesecs |
| 2509 clrf divemins+0 | |
| 2510 clrf divemins+1 | |
| 2511 clrf apnoe_secs | |
| 2512 clrf apnoe_mins | |
| 2513 | |
| 2514 ; divemode2 flag will be set by pressure & timeout evaluation in function set_dive_modes | |
| 2515 | |
| 2516 return ; done with dive mode boot | |
| 2517 | |
| 2518 | |
| 2519 ;============================================================================= | |
| 0 | 2520 |
| 2521 divemode_check_for_warnings: | |
| 604 | 2522 movlw .1 ; one message at a time in alternative layout |
| 582 | 2523 btfss alternative_divelayout |
| 604 | 2524 movlw .2 ; two messages at a time in default layout |
| 2525 cpfsgt message_counter ; only one (or two) messages active? | |
| 2526 bra divemode_check_for_warnings1; YES - update every second | |
| 2527 | |
| 2528 btfss secs,0 ; every two seconds... | |
| 582 | 2529 return |
| 604 | 2530 btfss secs,1 ; every four seconds... |
| 582 | 2531 return |
| 0 | 2532 |
| 131 | 2533 divemode_check_for_warnings1: |
| 604 | 2534 bcf message_advice ; clear flag for messages of level advice |
| 2535 bcf message_attention ; clear flag for messages of level attention | |
| 2536 bcf message_warning ; clear flag for messages of level warning | |
| 2537 clrf message_counter ; clear message counter | |
| 2538 | |
| 2539 ; messages sorted by severity: highest severity warnings first, then attentions, advices and last info | |
| 2540 | |
| 2541 ; warnings for all modes | |
| 2542 call check_warn_battery ; check if the battery level should be displayed/warned | |
| 2543 call check_divetimeout ; check and show the dive mode timeout (not actually a warning) | |
| 2544 | |
| 2545 btfsc FLAG_apnoe_mode ; in Apnoe mode? | |
| 2546 bra divemode_check_for_warnings2; YES | |
| 2547 btfsc FLAG_gauge_mode ; in gauge mode? | |
| 2548 bra divemode_check_for_warnings2; YES | |
| 2549 | |
| 2550 ; warnings applicable only in deco modes | |
| 582 | 2551 rcall check_ppO2 ; check ppO2 and displays warning, if required |
| 0 | 2552 |
| 582 | 2553 btfss sensors_agree ; are the sensor values within the threshold range? |
| 2554 rcall check_warn_sensors_disagree ; NO - further evaluate | |
| 2555 btfsc sensors_agree ; are the sensor values within the threshold range? | |
| 2556 bcf sensor_warning ; YES - revoke memorized sensor warning | |
| 2557 | |
| 604 | 2558 rcall check_outside ; check of ZHL16 model violation |
| 560 | 2559 |
| 582 | 2560 rcall check_IBCD ; check for IBCD attention or warning |
| 2561 | |
| 604 | 2562 rcall check_OC_gas_avail ; check if a breathable OC gas is available |
| 2563 | |
| 2564 btfsc decostop_active ; in deco mode? | |
| 2565 rcall check_and_store_gf_violation; YES - sets warnings, if required | |
| 2566 | |
| 2567 rcall check_mbubbles ; check for micro bubbles | |
| 582 | 2568 |
| 2569 rcall check_cns_violation ; Check CNS value and display it, if required | |
| 560 | 2570 |
| 604 | 2571 rcall check_gas_needs_ascent ; show gas needs warning if any gas need for ascent is > threshold |
| 2572 | |
| 2573 rcall check_eod_cns_violation ; check CNS values for end-of-dive and display warning, if required | |
| 2574 | |
| 2575 rcall check_display_ftts ; show @+x time | |
| 2576 | |
| 2577 IFDEF _cave_mode | |
| 2578 btfsc FLAG_cave_mode ; cave mode enabled? | |
| 2579 rcall check_cavemode ; YES - check cave mode status | |
| 2580 ENDIF | |
| 2581 | |
| 2582 btfsc use_agf ; in aGF mode? | |
| 2583 rcall warn_agf ; YES - show memo | |
| 2584 | |
| 2585 btfsc setpoint_fallback ; fallback to SP1 due to external O2 sensor failure? | |
| 2586 rcall warn_fallback ; YES - show a warning | |
| 2587 | |
| 2588 btfsc better_dil_available ; is a better diluent available? | |
| 2589 rcall advice_gas_change ; YES - display an advice | |
| 2590 btfsc better_gas_available ; is a better gas available? | |
| 2591 rcall advice_gas_change ; YES - display an advice | |
| 582 | 2592 |
| 0 | 2593 divemode_check_for_warnings2: |
| 604 | 2594 IFDEF _rx_functions |
| 2595 btfss FLAG_tr_enabled ; TR functions enabled? | |
| 2596 bra divemode_check_for_warnings3 ; NO - skip | |
| 2597 call check_tr_functions ; YES - check transmitter functions | |
| 2598 call check_tr_messages ; - check SAC attention and switch advice | |
| 2599 ENDIF | |
| 2600 | |
| 2601 divemode_check_for_warnings3: | |
| 2602 ; Display the attention or warning icon? | |
| 2603 btfsc message_advice ; any message of level advice? | |
| 2604 bsf FLAG_TFT_divemode_warning ; YES | |
| 2605 btfsc message_attention ; any message of level attention? | |
| 2606 bsf FLAG_TFT_divemode_warning ; YES | |
| 2607 btfsc message_warning ; any message of level warning? | |
| 2608 bsf FLAG_TFT_divemode_warning ; YES | |
| 2609 btfss FLAG_TFT_divemode_warning ; any message of above levels? | |
| 2610 bsf FLAG_TFT_divemode_warning_clear ; NO - clear warning icon | |
| 2611 | |
| 2612 ; Setup message page number | |
| 2613 incf message_page,F | |
| 2614 movf message_page,W | |
| 582 | 2615 bcf STATUS,C |
| 604 | 2616 btfss alternative_divelayout ; in alternative layout? |
| 2617 rlcf message_page,W ; NO - *2 | |
| 2618 cpfsgt message_counter ; > message_counter? | |
| 2619 clrf message_page ; NO - clear | |
| 2620 | |
| 2621 ; Clear both rows of messages if there is nothing to show at all | |
| 2622 tstfsz message_counter ; any messages? | |
| 2623 bra divemode_check_for_warnings4 ; YES - look if second row needs to be cleared | |
| 2624 bsf FLAG_TFT_dive_warning_text_clear; set flag | |
| 560 | 2625 return |
| 604 | 2626 |
| 2627 divemode_check_for_warnings4: | |
| 2628 ; Clear 2nd row of messages if there is nothing to show (on this page) | |
| 2629 btfss second_row_warning ; =1: the second row contains a warning | |
| 2630 bsf FLAG_TFT_dive_warning_text_clr2 ; set flag for 2nd row | |
| 2631 return ; done | |
| 0 | 2632 |
| 582 | 2633 global check_warn_battery |
| 0 | 2634 check_warn_battery: |
| 582 | 2635 movff batt_percent,lo |
| 2636 movlw battery_show_level+1 | |
| 604 | 2637 cpfslt lo ; battery percentage ok? |
| 2638 return ; YES - no display, no warning | |
| 582 | 2639 ; Display Battery, but warn? |
| 2640 movff batt_percent,lo | |
| 2641 movlw color_code_battery_low+1 | |
| 604 | 2642 cpfsgt lo ; battery percent below warning threshold? |
| 2643 bsf message_warning ; YES - set warning flag | |
| 2644 btfsc alternative_divelayout ; in alternative layout? | |
| 2645 bra check_warn_battery2 ; YES - show warning | |
| 2646 movlw index_clock_batt_surfpress ; NO - index of custom view clock, battery and surface pressure | |
| 2647 cpfseq menupos3 ; - battery shown in custom view? | |
| 2648 bra check_warn_battery2 ; NO - show warning | |
| 2649 return ; YES - do not show twice (in custom view and in message area) | |
|
472
4fdf6886004b
CHANGE: Show warnings either in Customview (If active) _or_ next to warning sign
heinrichsweikamp
parents:
471
diff
changeset
|
2650 check_warn_battery2: |
| 604 | 2651 incf message_counter,F ; increase counter |
| 2652 goto TFT_update_batt_percent_divemode ; show percent (and return) | |
| 513 | 2653 |
| 55 | 2654 check_divetimeout: |
| 604 | 2655 btfsc divemode2 ; dive time running? |
| 2656 return ; YES - do nothing | |
| 2657 incf message_counter,F ; increase counter | |
| 2658 goto TFT_divetimeout ; show timeout counter (and return) | |
| 55 | 2659 |
| 560 | 2660 check_ppO2: |
| 604 | 2661 btfsc FLAG_oc_mode ; are we in OC mode? |
| 2662 bra check_ppO2_1 ; YES - continue with breathed gas | |
| 2663 btfsc FLAG_bailout_mode ; NO - in bailout? | |
| 2664 bra check_ppO2_1 ; YES - continue with breathed gas | |
| 2665 ; CCR / pSCR mode - checks on pure diluent | |
| 2666 movff int_O_pure_ppO2+0,lo ; get value and attention/warning flags for the pure diluent | |
| 2667 movff int_O_pure_ppO2+1,hi ; | |
| 2668 btfsc hi,int_warning_flag ; ppO2 of the pure diluent to low or high? | |
| 2669 rcall check_ppO2_dw ; YES - show warning and return on next line | |
| 2670 btfsc hi,int_attention_flag ; ppO2 of the pure diluent in attention state? | |
| 2671 rcall check_ppO2_da ; YES - show attention and return on next line | |
| 2672 ; all modes - checks on breathed gas (OC or from loop) | |
| 2673 check_ppO2_1: | |
| 2674 movff int_O_breathed_ppO2+0,lo ; get value and attention/warning flags for the breathed gas | |
| 2675 movff int_O_breathed_ppO2+1,hi ; get warnings for breathed gas | |
| 2676 btfsc hi,int_attention_flag ; breathed ppO2 in attention state (when in loop mode, no attention will be generated)? | |
| 2677 bra check_ppo2_display_a ; YES - set attention flag and show ppO2 | |
| 2678 btfsc hi,int_low_flag ; breathed ppO2 to low? | |
| 560 | 2679 bra check_ppO2_low ; YES - record the warning and show ppO2 |
| 604 | 2680 btfsc hi,int_high_flag ; breathed ppO2 to high? |
| 560 | 2681 bra check_ppO2_high ; YES - record the warning and show ppO2 |
| 582 | 2682 TSTOSS opt_showppo2 ; show ppO2 anyhow? (0 = no, 1 = show always) |
| 604 | 2683 return ; NO - no warnings, no show - done |
| 2684 bra check_ppO2_common_2 ; YES - but only when in OC or bailout... | |
| 560 | 2685 check_ppO2_low: |
| 582 | 2686 movlw d'4' ; set type of alarm (ppO2 low) |
| 2687 bra check_ppO2_common ; continue with common part | |
| 560 | 2688 check_ppO2_high: |
| 2689 movlw d'5' ; set type of alarm (ppO2 high) | |
| 2690 check_ppO2_common: | |
| 2691 movwf AlarmType ; copy alarm type to alarm register | |
| 604 | 2692 bsf event_occured ; set event flag |
| 2693 bsf message_warning ; show warning sign | |
| 2694 check_ppO2_common_2: | |
| 2695 btfsc FLAG_oc_mode ; are we in OC mode? | |
| 2696 bra check_ppo2_display ; YES | |
| 2697 btfsc FLAG_bailout_mode ; are we in bailout mode? | |
| 2698 bra check_ppo2_display ; YES | |
| 2699 return ; NO - in loop mode, ppO2 is already shown via setpoint display | |
| 2700 check_ppo2_display_a: | |
| 2701 bsf message_attention ; show attention sign | |
| 2702 check_ppo2_display: | |
| 2703 btfsc alternative_divelayout ; in alternative layout? | |
| 2704 bra check_ppO2_d ; YES - show warning | |
| 2705 movlw index_ppo2_ead_end_cns ; NO - index of custom view ppO2, EAD/END and CNS) | |
| 2706 cpfseq menupos3 ; ppO2 shown? | |
| 2707 bra check_ppO2_b ; NO | |
| 2708 return ; YES - do not show twice (in custom view and in warning area) | |
|
471
9edb1359ce43
NEW: New Customview 11 in dive mode shows ppO2, EAD/END and CNS
heinrichsweikamp
parents:
444
diff
changeset
|
2709 check_ppO2_b: |
| 604 | 2710 movlw index_pscr_info ; index of custom view with pSCR data |
| 2711 cpfseq menupos3 ; ppO2 shown? | |
| 2712 bra check_ppO2_d ; NO - show warning | |
| 2713 return ; YES - do not show twice (in custom view and in warning area) | |
| 2714 check_ppO2_dw: | |
| 2715 bsf message_warning ; show warning sign | |
| 2716 check_ppO2_da: | |
| 2717 bsf message_attention ; show attention sign (no problem if a warning sign is set as well, as it will take priority) | |
| 582 | 2718 check_ppO2_d: |
| 604 | 2719 incf message_counter,F ; increase counter |
| 2720 goto TFT_display_ppo2_warning ; show breathed gas or diluent ppO2 warning (and return) | |
| 2721 | |
| 2722 | |
| 2723 check_display_ftts: | |
| 2724 movff char_I_extra_time,lo ; get extra time | |
| 2725 tstfsz lo ; extra time > 0 ? | |
| 2726 bra check_display_ftts_1 ; YES - continue checking bailout condition | |
| 2727 return ; NO - done | |
| 2728 check_display_ftts_1: | |
| 2729 btfsc FLAG_bailout_mode ; in bailout mode? | |
| 2730 return ; YES - in bailout no fTTS will be computed, so nothing to display | |
| 2731 incf message_counter,F ; NO - increase counter | |
| 2732 goto TFT_display_ftts ; - show @+x time | |
| 582 | 2733 |
|
376
e99bb91f6f92
CHANGE: Do not show ppO2 in warning area if already shown in custom view
heinrichsweikamp
parents:
352
diff
changeset
|
2734 |
| 582 | 2735 global check_cns_violation |
| 0 | 2736 check_cns_violation: |
| 582 | 2737 ; Check if CNS should be displayed |
| 2738 movff int_O_CNS_fraction+1,WREG ; get high byte | |
| 2739 btfsc WREG,int_warning_flag ; warning flag set? | |
| 604 | 2740 bra check_cns_violation_1 ; YES - issue warning |
| 2741 btfsc WREG,int_attention_flag ; NO - attention flag set? | |
| 2742 bra check_cns_violation_2 ; YES - issue attention | |
| 2743 return ; NO - done | |
| 2744 check_cns_violation_1: | |
| 2745 bsf message_warning ; show warning sign | |
| 2746 check_cns_violation_2: | |
| 2747 bsf message_attention ; show attention sign | |
| 2748 btfsc alternative_divelayout ; in alternative layout? | |
| 2749 bra check_cns_violation_4 ; YES - show attention | |
| 2750 movlw index_ppo2_ead_end_cns ; NO - index of custom view ppO2, EAD/END and CNS | |
| 2751 cpfseq menupos3 ; - CNS shown? | |
| 2752 bra check_cns_violation_3 ; NO | |
| 2753 return ; YES - do not show twice (in custom view and in warning area) | |
| 2754 check_cns_violation_3: | |
| 2755 movlw index_CNS ; index of custom view with CNS values | |
| 2756 cpfseq menupos3 ; CNS shown? | |
| 2757 bra check_cns_violation_4 ; NO | |
| 2758 return ; YES - do not show twice (in custom view and in warning area) | |
| 2759 check_cns_violation_4: | |
| 2760 incf message_counter,F ; increase counter | |
| 2761 goto TFT_display_cns ; show CNS (and return) | |
| 582 | 2762 |
| 0 | 2763 |
| 582 | 2764 global check_eod_cns_violation ; check end-of-dive CNS values |
| 560 | 2765 check_eod_cns_violation: |
| 582 | 2766 movff int_O_CNS_fraction+1,WREG ; get high-byte of current CNS value |
| 2767 btfsc WREG,int_warning_flag ; current CNS value in warning state? | |
| 604 | 2768 return ; YES - inhibit end-of-dive warning if current CNS is already in warning |
| 582 | 2769 movff int_O_normal_CNS_fraction+1,WREG |
| 560 | 2770 btfsc WREG,int_invalid_flag ; flag for invalid value set? |
| 2771 bra check_eod_cns_violation1 ; YES - continue with checking the other CNS value | |
| 582 | 2772 btfsc WREG,int_warning_flag ; NO - flag for warning set? |
| 2773 bra check_eod_cns_violation2 ; YES - issue warning | |
| 2774 check_eod_cns_violation1: ; NO - continue with checking the other CNS value | |
| 2775 movff int_O_alternate_CNS_fraction+1,WREG | |
| 560 | 2776 btfsc WREG,int_invalid_flag ; flag for invalid value set? |
| 2777 return ; YES - done with CNS checking | |
| 2778 btfsc WREG,int_warning_flag ; NO - flag for warning set? | |
| 604 | 2779 bra check_eod_cns_violation2 ; YES - issue warning |
| 582 | 2780 return ; NO - done with CNS checking |
| 604 | 2781 check_eod_cns_violation2: ; issue warning (actually only on attention level) |
| 2782 bsf message_attention ; show attention sign | |
| 2783 btfsc alternative_divelayout ; in alternative layout? | |
| 2784 bra display_eod_cns_violation ; YES - show warning | |
| 2785 movlw index_CNS ; NO - index of custom view with CNS values | |
| 2786 cpfseq menupos3 ; - CNS values shown? | |
| 2787 bra display_eod_cns_violation ; NO - issue textual warning | |
| 2788 return ; YES - do not show twice (in custom view and in warning area) | |
| 560 | 2789 display_eod_cns_violation: |
| 604 | 2790 incf message_counter,F ; increase counter |
| 582 | 2791 goto TFT_display_eod_cns ; issue CNS at end-of-dive warning (and return) |
| 560 | 2792 |
| 2793 | |
| 582 | 2794 global check_and_store_gf_violation |
| 0 | 2795 check_and_store_gf_violation: |
| 560 | 2796 movff int_O_gradient_factor+1,WREG ; get upper byte of gradient factor |
| 2797 btfss WREG,int_warning_flag ; check if the warning flag is set | |
| 582 | 2798 bra check_and_store_gf_violation2 ; NO - continue with checking for attention flag |
| 2799 movlw d'2' ; YES - set type of alarm | |
| 2800 movwf AlarmType ; copy to alarm register | |
| 2801 bsf event_occured ; set event flag | |
| 604 | 2802 bsf message_warning ; set warning flag |
| 560 | 2803 bra check_and_store_gf_violation3 ; show gf warning |
| 2804 check_and_store_gf_violation2: | |
| 582 | 2805 btfsc WREG,int_attention_flag ; check if the attention flag is set |
| 2806 bra check_and_store_gf_violation3 ; YES - show gf | |
| 560 | 2807 TSTOSS opt_enable_IBCD ; NO - IBCD warning activated? |
| 582 | 2808 bra check_and_store_gf_violation4 ; NO - continue checking of deco info |
| 2809 movff char_O_deco_warnings,WREG ; YES - get the deco warnings vector | |
| 2810 btfss WREG,IBCD_warning ; is the IBCD warning flag set? | |
| 2811 bra check_and_store_gf_violation4 ; NO - continue checking for deco info | |
| 2812 check_and_store_gf_violation3: ; YES - show gf | |
| 604 | 2813 bsf message_attention ; show attention sign |
| 2814 incf message_counter,F ; increase counter | |
| 582 | 2815 goto TFT_warning_gf ; show GF (and return) |
| 560 | 2816 check_and_store_gf_violation4: ; check for deco info |
| 604 | 2817 btfss divemode ; in dive mode? |
| 560 | 2818 return ; NO - done, return |
| 604 | 2819 btfsc FLAG_bailout_mode ; YES - in bailout mode? |
| 2820 return ; YES - done, return (deco_decreasing flag is not updated when in bailout mode) | |
| 2821 movff char_O_deco_info,WREG ; NO - get the deco info vector | |
| 2822 btfss WREG,deco_decreasing ; check if the deco_decreasing flag is set | |
| 2823 return ; NO - done, return | |
| 2824 incf message_counter,F ; YES - increase counter | |
| 2825 goto TFT_info_deco ; - show deco info | |
| 2826 | |
| 2827 | |
| 2828 check_outside: | |
| 2829 movff char_O_deco_warnings,WREG ; bank-safe copy of deco warnings | |
| 2830 btfss WREG,outside_warning_lock ; are we outside of the ZH-L16 model? | |
| 2831 return ; NO - done | |
| 2832 incf message_counter,F ; YES - increase counter | |
| 2833 bsf message_attention ; - show attention sign | |
| 2834 btfsc WREG,outside_warning ; - are we outside the ZH-L16 model right now (-> warning)? | |
| 2835 bsf message_warning ; - set warning flag | |
| 2836 goto TFT_warning_outside ; - show outside-ZHL-model warning/attention (and return) | |
| 2837 | |
| 2838 | |
| 2839 global check_mbubbles | |
| 2840 check_mbubbles: | |
| 2841 movff char_O_deco_warnings,WREG ; bank-safe copy for deco warnings | |
| 2842 btfsc WREG,mbubble_warning ; are we in micro bubbling zone right now? | |
| 2843 bra check_mbubbles_warn ; YES | |
| 2844 btfss WREG,mbubble_warning_lock ; were we in micro bubbling zone? | |
| 2845 return ; NO - done | |
| 2846 check_mbubble_att ; YES - attention level | |
| 2847 incf message_counter,F ; increase counter | |
| 2848 bsf message_attention ; show attention sign | |
| 2849 goto TFT_warning_mbubbles ; show micro bubble attention (and return) - TFT_warning_mbubbles switches by itself between attention and warning | |
| 2850 check_mbubbles_warn: ; locked micro bubbles - warning level if at issue, attention level if locked | |
| 2851 incf message_counter,F ; increase counter | |
| 2852 bsf message_warning ; set warning flag | |
| 2853 goto TFT_warning_mbubbles ; show micro bubbles warning (and return) | |
| 2854 | |
| 2855 IFDEF _cave_mode | |
| 2856 check_cavemode: | |
| 2857 incf message_counter,F ; increase counter | |
| 2858 btfsc FLAG_dive_turned ; dive turned? | |
| 2859 goto TFT_info_dive_turned ; YES - show info that dive is turned | |
| 2860 btfsc FLAG_cave_mode_shutdown ; NO - has cave mode shut down? | |
| 2861 goto TFT_warn_cave_shutdown ; YES - show that cave mode has shut down | |
| 2862 goto TFT_info_cave_mode ; NO - show that cave mode is active | |
| 2863 ENDIF | |
| 2864 | |
| 0 | 2865 warn_agf: |
| 604 | 2866 incf message_counter,F ; increase counter |
| 2867 goto TFT_warning_agf ; show aGF warning (and return) | |
|
145
e3ac5b2021bc
NEW: Setpoint-Fallback option for external O2 sensor failure
heinrichsweikamp
parents:
138
diff
changeset
|
2868 |
|
e3ac5b2021bc
NEW: Setpoint-Fallback option for external O2 sensor failure
heinrichsweikamp
parents:
138
diff
changeset
|
2869 warn_fallback: |
| 604 | 2870 incf message_counter,F ; increase counter |
| 2871 bsf message_warning ; set warning flag | |
| 2872 goto TFT_warning_fallback ; show fallback warning (and return) | |
| 2873 | |
| 2874 | |
| 2875 IFDEF _rx_functions | |
| 2876 | |
| 2877 check_tr_messages: | |
| 2878 movff int_O_sac_rate+1,WREG ; bank-safe copy of current SAC rate | |
| 2879 btfss WREG,int_attention_flag ; attention flag set? | |
| 2880 bra check_tr_messages2 ; NO - skip | |
| 2881 btfsc WREG,int_not_avail_flag ; SAC rate available? | |
| 2882 bra check_tr_messages2 ; NO - continue with swap advice | |
| 2883 bsf message_attention ; YES - show attention sign | |
| 2884 btfsc alternative_divelayout ; - in alternative layout? | |
| 2885 bra check_tr_messages1 ; YES - show attention message | |
| 2886 movlw index_pressures_SAC ; NO - index of custom view with SAC rate | |
| 2887 cpfseq menupos3 ; - SAC rate shown right now? | |
| 2888 bra check_tr_messages1 ; NO - show attention message | |
| 2889 bra check_tr_messages2 ; YES - do not show twice, continue with swap advice | |
| 2890 check_tr_messages1: | |
| 2891 incf message_counter,F ; increase counter | |
| 2892 call TFT_attention_sac ; show SAC attention | |
| 2893 check_tr_messages2: | |
| 2894 movff char_O_deco_info,WREG ; bank-safe copy of deco info vector | |
| 2895 btfss WREG,ind_double_switch ; swap tank flag set? | |
| 2896 return ; NO | |
| 2897 incf message_counter,F ; YES - increase counter | |
| 2898 bsf message_advice ; - show advice sign | |
| 2899 goto TFT_advice_switch ; - show swap advice | |
| 2900 | |
| 2901 | |
| 2902 #DEFINE show_custview ul,0 ; show pressure readings custom view | |
| 2903 #DEFINE show_transmitter ul,1 ; show transmitter attention | |
| 2904 #DEFINE show_pres_warning ul,2 ; show transmitter pressure warning | |
| 2905 #DEFINE show_pres_attention ul,3 ; show transmitter pressure attention | |
| 2906 | |
| 2907 check_tr_functions: | |
| 2908 clrf ul ; set all messages as not shown yet | |
| 2909 btfsc alternative_divelayout ; in alternative layout? | |
| 2910 bra check_tr_functions_tr1 ; YES - continue with checking transmitter 1 | |
| 2911 movlw index_pressures_SAC ; NO - index of custom view pressure readings | |
| 2912 cpfseq menupos3 ; - pressure readings shown? | |
| 2913 bra check_tr_functions_tr1 ; NO - continue with checking transmitter 1 | |
| 2914 bsf show_custview ; YES - suppress redraw by faking it has already been redrawn | |
| 2915 check_tr_functions_tr1: | |
| 2916 movff char_I_pressure_stat+0,WREG ; get status of 1st pressure reading | |
| 2917 rcall check_tr_functions_helper1 ; check for transmitter 1 lost | |
| 2918 rcall check_tr_functions_helper2 ; check for transmitter 1 low battery | |
| 2919 movff int_IO_pressure_value+1,WREG ; get high byte of 1st pressure reading | |
| 2920 rcall check_tr_functions_helper3 ; check for transmitter 1 pressure warning | |
| 2921 rcall check_tr_functions_helper4 ; check for transmitter 1 pressure attention | |
| 2922 check_tr_functions_tr2: | |
| 2923 movff char_I_pressure_stat+1,WREG ; get status of 2nd pressure reading | |
| 2924 rcall check_tr_functions_helper5 ; check for transmitter 2 lost | |
| 2925 rcall check_tr_functions_helper6 ; check for transmitter 2 low battery | |
| 2926 movff int_IO_pressure_value+3,WREG ; get high byte of 2nd pressure reading | |
| 2927 rcall check_tr_functions_helper7 ; check for transmitter 2 pressure warning | |
| 2928 rcall check_tr_functions_helper8 ; check for transmitter 2 pressure attention | |
| 2929 check_tr_functions_show_xmtr: | |
| 2930 btfss show_transmitter ; shall show transmitter message? | |
| 2931 bra check_tr_functions_show_warn ; NO - continue with pressure warning | |
| 2932 bsf message_attention ; YES - set flag for attention | |
| 2933 incf message_counter,F ; - increase counter | |
| 2934 call TFT_attention_transmitter ; - show transmitter attention message | |
| 2935 check_tr_functions_show_warn: | |
| 2936 btfss show_pres_warning ; shall show pressure warning? | |
| 2937 bra check_tr_functions_show_att ; NO - continue with pressure attention | |
| 2938 bsf message_warning ; YES - set flag for warning | |
| 2939 incf message_counter,F ; - increase counter | |
| 2940 goto TFT_warning_pres_reading ; - pressure reading warning message and done then | |
| 2941 check_tr_functions_show_att: | |
| 2942 btfss show_pres_attention ; shall show pressure attention? | |
| 2943 return ; NO - done | |
| 2944 bsf message_attention ; YES - set flag for attention | |
| 2945 incf message_counter,F ; - increase counter | |
| 2946 goto TFT_attention_pres_reading ; - pressure reading warning message and done then | |
| 2947 | |
| 2948 check_tr_functions_helper1: | |
| 2949 btfsc WREG,char_transmitter_lost ; transmitter 1 lost? | |
| 2950 bra check_tr_functions_helper1a ; YES - show transmitter attention message | |
| 2951 bcf transmitter1_lost ; NO - clear flag for old lost attention | |
| 2952 return ; - done | |
| 2953 check_tr_functions_helper1a: | |
| 2954 bsf show_transmitter ; show transmitter attention | |
| 2955 btfsc transmitter1_lost ; is it a new message? | |
| 2956 return ; NO - do not show the pressure readings custom view again | |
| 2957 bsf transmitter1_lost ; YES - memorize it's an old message now | |
| 2958 bra check_tr_functions_show_cv ; - show custom view | |
| 2959 | |
| 2960 check_tr_functions_helper2: | |
| 2961 btfsc WREG,char_transmitter_low_bat ; transmitter 1 low battery? | |
| 2962 bra check_tr_functions_helper2a ; YES - show transmitter attention message | |
| 2963 bcf transmitter1_battery ; NO - clear flag for old battery attention | |
| 2964 return ; - done | |
| 2965 check_tr_functions_helper2a: | |
| 2966 bsf show_transmitter ; show transmitter attention | |
| 2967 btfsc transmitter1_battery ; is it a new message? | |
| 2968 return ; NO - do not show the pressure readings custom view again | |
| 2969 bsf transmitter1_battery ; YES - memorize it's an old message now | |
| 2970 bra check_tr_functions_show_cv ; - show custom view | |
| 2971 | |
| 2972 check_tr_functions_helper3: | |
| 2973 btfsc WREG,int_warning_flag ; transmitter 1 pressure warning? | |
| 2974 bra check_tr_functions_helper3a ; YES - show pressure reading message as warning | |
| 2975 bcf transmitter1_pres_warn ; NO - clear flag for old warning | |
| 2976 return ; - done | |
| 2977 check_tr_functions_helper3a: | |
| 2978 bsf show_pres_warning ; show pressure warning | |
| 2979 btfsc transmitter1_pres_warn ; is it a new message? | |
| 2980 return ; NO - do not show the pressure readings custom view again | |
| 2981 bsf transmitter1_pres_warn ; YES - memorize it's an old message now | |
| 2982 bra check_tr_functions_show_cv ; - show custom view | |
| 2983 | |
| 2984 check_tr_functions_helper4: | |
| 2985 btfsc WREG,int_attention_flag ; transmitter 1 pressure attention? | |
| 2986 bra check_tr_functions_helper4a ; YES - show pressure reading message as attention | |
| 2987 bcf transmitter1_pres_att ; NO - clear flag for old attention | |
| 2988 return ; - done | |
| 2989 check_tr_functions_helper4a | |
| 2990 bsf show_pres_attention ; show pressure attention | |
| 2991 btfsc transmitter1_pres_att ; is it a new message? | |
| 2992 return ; NO - do not show the pressure readings custom view again | |
| 2993 bsf transmitter1_pres_att ; YES - memorize it's an old message now | |
| 2994 bra check_tr_functions_show_cv ; - show custom view | |
| 2995 | |
| 2996 check_tr_functions_helper5: | |
| 2997 btfsc WREG,char_transmitter_lost ; transmitter 2 lost? | |
| 2998 bra check_tr_functions_helper5a ; YES - show transmitter attention message | |
| 2999 bcf transmitter2_lost ; NO - clear flag for old lost attention | |
| 3000 return ; - done | |
| 3001 check_tr_functions_helper5a: | |
| 3002 bsf show_transmitter ; show transmitter attention | |
| 3003 btfsc transmitter2_lost ; is it a new message? | |
| 3004 return ; NO - do not show the pressure readings custom view again | |
| 3005 bsf transmitter2_lost ; YES - memorize it's an old message now | |
| 3006 bra check_tr_functions_show_cv ; - show custom view | |
| 3007 | |
| 3008 check_tr_functions_helper6: | |
| 3009 btfsc WREG,char_transmitter_low_bat ; transmitter 2 low battery? | |
| 3010 bra check_tr_functions_helper6a ; YES - show transmitter attention message | |
| 3011 bcf transmitter2_battery ; NO - clear flag for old battery attention | |
| 3012 return ; - done | |
| 3013 check_tr_functions_helper6a: | |
| 3014 bsf show_transmitter ; show transmitter attention | |
| 3015 btfsc transmitter2_battery ; is it a new message? | |
| 3016 return ; NO - do not show the pressure readings custom view again | |
| 3017 bsf transmitter2_battery ; YES - memorize it's an old message now | |
| 3018 bra check_tr_functions_show_cv ; - show custom view | |
| 3019 | |
| 3020 check_tr_functions_helper7: | |
| 3021 btfsc WREG,int_warning_flag ; transmitter 2 pressure warning? | |
| 3022 bra check_tr_functions_helper7a ; YES - show pressure reading message as warning | |
| 3023 bcf transmitter2_pres_warn ; NO - clear flag for old warning | |
| 3024 return ; - done | |
| 3025 check_tr_functions_helper7a: | |
| 3026 bsf show_pres_warning ; show pressure warning | |
| 3027 btfsc transmitter2_pres_warn ; is it a new message? | |
| 3028 return ; NO - do not show the pressure readings custom view again | |
| 3029 bsf transmitter2_pres_warn ; YES - memorize it's an old message now | |
| 3030 bra check_tr_functions_show_cv ; - show custom view | |
| 3031 | |
| 3032 check_tr_functions_helper8: | |
| 3033 btfsc WREG,int_attention_flag ; transmitter 2 pressure attention? | |
| 3034 bra check_tr_functions_helper8a ; YES - show pressure reading message as attention | |
| 3035 bcf transmitter2_pres_att ; NO - clear flag for old attention | |
| 3036 return ; - done | |
| 3037 check_tr_functions_helper8a | |
| 3038 bsf show_pres_attention ; show pressure attention | |
| 3039 btfsc transmitter2_pres_att ; is it a new message? | |
| 3040 return ; NO - do not show the pressure readings custom view again | |
| 3041 bsf transmitter2_pres_att ; YES - memorize it's an old message now | |
| 3042 ;bra check_tr_functions_show_cv ; - show custom view | |
| 3043 | |
| 3044 check_tr_functions_show_cv: | |
| 3045 btfsc show_custview ; is the pressure readings custom view not shown yet shown? | |
| 3046 return ; NO - already shown, done | |
| 3047 bsf show_custview ; YES - mark as shown | |
| 3048 btfsc alternative_divelayout ; - in alternative layout? | |
| 3049 call switch_layout_to_normal ; YES - switch to normal layout | |
| 3050 movlw index_pressures_SAC-1 ; custom view number one below pressure readings | |
| 3051 movwf menupos3 ; set custom view number | |
| 3052 bsf toggle_customview ; initiate toggle to desired custom view -> pressure readings view will be shown | |
| 3053 return ; done | |
| 3054 | |
| 3055 ENDIF | |
| 3056 | |
| 3057 | |
| 3058 check_gas_needs_ascent: | |
| 3059 banksel int_O_ascent_pres_need | |
| 3060 movf int_O_ascent_pres_need+1,w ; get high byte from pres need of 1st tank | |
| 3061 iorwf int_O_ascent_pres_need+3,w ; inclusive or with high byte from pres need of 2nd tank | |
| 3062 iorwf int_O_ascent_pres_need+5,w ; inclusive or with high byte from pres need of 3rd tank | |
| 3063 iorwf int_O_ascent_pres_need+7,w ; inclusive or with high byte from pres need of 4th tank | |
| 3064 iorwf int_O_ascent_pres_need+9,w ; inclusive or with high byte from pres need of 5th tank | |
| 560 | 3065 banksel common |
| 582 | 3066 btfsc WREG,int_invalid_flag ; check if invalid flag is set |
| 560 | 3067 return ; YES - no further checking required |
| 604 | 3068 btfsc WREG,int_warning_flag ; check if any gas has a pres_need >= pres_fill |
| 3069 bsf message_warning ; YES - set warning flag | |
| 3070 btfsc WREG,int_warning_flag ; check if any gas has a pres_need >= pres_fill | |
| 560 | 3071 goto TFT_warning_gas_needs_warn ; Yes - show a warning |
| 604 | 3072 btfsc WREG,int_attention_flag ; check if any gas has a pres_need >= pres_fill * threshold |
| 3073 bsf message_attention ; YES - set attention flag | |
| 3074 btfsc WREG,int_attention_flag ; check if any gas has a pres_need >= pres_fill * threshold | |
| 560 | 3075 goto TFT_warning_gas_needs_att ; YES - show an attention |
| 3076 bcf gas_needs_attention ; NO - clear flag for a new attention | |
| 3077 bcf gas_needs_warning ; clear flag for a new warning | |
| 3078 return | |
| 0 | 3079 |
| 582 | 3080 |
| 560 | 3081 check_warn_sensors_disagree: |
| 604 | 3082 incf message_counter,F ; increase counter |
| 3083 bsf message_warning ; YES - set warning flag | |
| 582 | 3084 goto TFT_warning_sensor_disagree ; show sensor disagree warning (and return) |
| 560 | 3085 |
| 3086 | |
| 3087 check_IBCD: | |
| 3088 TSTOSS opt_enable_IBCD ; IBCD warning activated? | |
| 3089 return ; NO - done | |
| 3090 movff char_O_deco_warnings,WREG ; YES - get deco warnings vector | |
| 582 | 3091 btfss WREG,IBCD_warning ; IBCD warning flag set? |
| 3092 return ; NO - return | |
| 604 | 3093 incf message_counter,F ; YES - increase counter |
| 582 | 3094 goto TFT_warning_IBCD ; write warning to display |
| 560 | 3095 |
| 3096 | |
| 604 | 3097 check_OC_gas_avail: |
| 3098 tstfsz best_gas_number ; is a breathable gas available? | |
| 3099 return ; > 0 : a breathable gas is available | |
| 3100 btfsc FLAG_ccr_mode ; = 0 : problem - in CCR mode? | |
| 3101 bra check_OC_gas_avail_1 ; YES - real problem | |
| 3102 btfsc FLAG_pscr_mode ; NO - in PSCR mode? | |
| 3103 bra check_OC_gas_avail_1 ; YES - real problem | |
| 3104 return ; NO - neither CCR nor pSCR mode, suppress warning | |
| 3105 check_OC_gas_avail_1: | |
| 3106 btfsc FLAG_bailout_mode ; in bailout? | |
| 3107 return ; YES - suppress warning | |
| 3108 incf message_counter,F ; NO - increase counter | |
| 3109 bsf message_attention ; set attention flag | |
| 3110 goto TFT_warning_no_BO_gas ; show message (and return) | |
| 3111 | |
| 3112 | |
| 3113 advice_gas_change: | |
| 3114 bsf message_advice ; show advice sign | |
| 3115 incf message_counter,F ; increase counter | |
| 3116 goto TFT_advice_gas_change | |
| 3117 | |
| 3118 | |
| 560 | 3119 global restart_deco_engine |
| 3120 global restart_deco_engine_wo_ceiling | |
| 3121 restart_deco_engine: | |
| 604 | 3122 ; invalidate ceiling |
| 560 | 3123 movff int_O_ceiling+1,WREG |
| 3124 bsf WREG,char_invalid_flag ; int_O_ceiling has its invalid flag on a char's position! | |
| 3125 movff WREG,int_O_ceiling+1 | |
| 3126 | |
| 3127 restart_deco_engine_wo_ceiling: | |
| 604 | 3128 ; invalidate deco data (stop table data) |
| 560 | 3129 movff char_O_deco_gas+0,WREG |
| 3130 bsf WREG,char_invalid_flag | |
| 3131 movff WREG,char_O_deco_gas+0 | |
| 3132 | |
| 604 | 3133 ; invalidate ascent time (normal plan) |
| 560 | 3134 movff int_O_ascenttime+1,WREG |
| 3135 bsf WREG,int_invalid_flag | |
| 3136 movff WREG,int_O_ascenttime+1 | |
| 3137 | |
| 604 | 3138 ; invalidate CNS at end of dive in normal plan |
| 560 | 3139 movff int_O_normal_CNS_fraction+1,WREG |
| 3140 bsf WREG,int_invalid_flag | |
| 3141 movff WREG,int_O_normal_CNS_fraction+1 | |
| 3142 | |
| 604 | 3143 ; restart deco engine |
| 3144 movff char_O_main_status,WREG ; get current main engine configuration | |
| 3145 bcf WREG,DECO_COMPLETED_NORM ; eventually clear flag stating completion of normal plan | |
| 3146 bsf WREG,DECO_COMPLETED_ALT ; fake we came from alternative plan to force normal plan to be done next | |
| 3147 movff WREG,char_O_main_status ; write back new configuration | |
| 3148 movff char_O_deco_status,WREG ; get current deco engine status | |
| 3149 bcf WREG,DECO_STATUS_0_FLAG ; set status flags to... | |
| 3150 bcf WREG,DECO_STATUS_1_FLAG ; ... DECO_STATUS_START | |
| 3151 movff WREG,char_O_deco_status ; write back new configuration to restart deco computations | |
| 3152 | |
| 3153 inval_alternative_plan_data: | |
| 3154 ; invalidate ascent time (alternative plan) | |
| 3155 movff int_O_alternate_ascenttime+1,WREG | |
| 3156 bsf WREG,int_invalid_flag | |
| 3157 movff WREG,int_O_alternate_ascenttime+1 | |
| 3158 | |
| 3159 ; invalidate CNS at end of dive in alternative plan | |
| 560 | 3160 movff int_O_alternate_CNS_fraction+1,WREG |
| 3161 bsf WREG,int_invalid_flag | |
| 3162 movff WREG,int_O_alternate_CNS_fraction+1 | |
| 3163 | |
| 604 | 3164 ; invalidate ascent gas needs |
| 3165 movff int_O_ascent_pres_need+1,WREG | |
| 560 | 3166 bsf WREG,int_invalid_flag |
| 604 | 3167 movff WREG,int_O_ascent_pres_need+1 |
| 3168 | |
| 3169 IFDEF _rx_functions | |
| 3170 ; invalidate pressure needs (TR functions) | |
| 3171 movff int_O_pressure_need+1,WREG | |
| 3172 bsf WREG,int_not_avail_flag | |
| 3173 movff WREG,int_O_pressure_need+1 | |
| 3174 movff int_O_pressure_need+3,WREG | |
| 3175 bsf WREG,int_not_avail_flag | |
| 3176 movff WREG,int_O_pressure_need+3 | |
| 3177 ENDIF | |
| 3178 | |
| 3179 ; update display depended on NDL or deco mode | |
| 3180 bsf FLAG_TFT_display_ndl_or_deko | |
| 582 | 3181 |
| 3182 return | |
| 3183 | |
| 3184 ;============================================================================= | |
| 604 | 3185 ; Simulator Mode |
| 582 | 3186 ; |
| 3187 | |
| 3188 global do_demo_divemode | |
| 3189 do_demo_divemode: | |
| 604 | 3190 call TFT_ClearScreen ; blank screen |
| 3191 call option_save_all ; save all settings into EEPROM before starting simulation | |
| 582 | 3192 call deco_push_tissues_to_vault ; C-code: back-up status of the real tissues |
| 604 | 3193 banksel common ; bank 1 |
| 3194 | |
| 3195 ; +++ COMMENT OUT FOR TESTING PURPOSE ONLY !!! +++ | |
| 3196 bsf restore_deco_data ; restore tissue and CNS after simulator use | |
| 3197 ; +++ DO NOT COMMENT OUT IN OPERATIONAL USE !!! +++ | |
| 560 | 3198 |
| 582 | 3199 bcf pressure_refresh |
| 604 | 3200 btfss pressure_refresh ; wait for sensor |
| 582 | 3201 bra $-2 |
| 3202 | |
| 604 | 3203 bsf simulatormode_active ; set flag |
| 3204 | |
| 3205 banksel char_I_bottom_depth ; compute dive ambient conditions | |
| 582 | 3206 movf char_I_bottom_depth,W |
| 3207 mullw .100 | |
| 3208 movff PRODL,rel_pressure+0 | |
| 3209 movff PRODH,rel_pressure+1 | |
| 3210 movlw LOW (.1000) | |
| 3211 addwf PRODL,W | |
| 3212 movff WREG,sim_pressure+0 | |
| 3213 movlw HIGH (.1000) | |
| 3214 addwfc PRODH,W | |
| 3215 movff WREG,sim_pressure+1 | |
| 604 | 3216 banksel common ; bank 1 |
| 582 | 3217 |
| 3218 bsf divemode | |
| 604 | 3219 goto diveloop ; switch into dive mode |
| 582 | 3220 |
| 3221 END |