Mercurial > public > hwos_code
view src/ghostwriter.asm @ 34:d7e6dfd5b498
small cleanup
author | heinrichsweikamp |
---|---|
date | Sun, 04 Aug 2013 17:52:44 +0200 |
parents | e402813343b6 |
children | eca4a201d8cf |
line wrap: on
line source
;============================================================================= ; ; File ghostwriter.asm ; ; Ghostwriter (Log profile recorder) ; ; Copyright (c) 2011, JD Gascuel, HeinrichsWeikamp, all right reserved. ;============================================================================= ; HISTORY ; 2011-11-27 : [mH] Creation #include "ostc3.inc" ; Mandatory header #include "shared_definitions.h" ; Mailbox from/to p2_deco.c #include "external_flash.inc" #include "surfmode.inc" #include "eeprom_rs232.inc" #include "strings.inc" #include "isr.inc" #include "tft_outputs.inc" #include "divemode.inc" ghostwriter CODE global store_dive_data store_dive_data: ; 5 seconds gone bcf store_sample ; update only any 5 seconds ifndef __DEBUG btfsc simulatormode_active ; Are we in simulator mode? return ; Yes, discard everything endif SAFE_2BYTE_COPY rel_pressure, lo movf lo,W ; store depth with every sample rcall ghostwrite_byte_profile ; WREG -> Profile in ext. Flash movf hi,W rcall ghostwrite_byte_profile ; WREG -> Profile in ext. Flash ;First, find out how many bytes will append to this sample.... clrf ProfileFlagByte ; clear number of bytes to append ; Check Extented informations decfsz divisor_temperature,W ; Check divisor bra check_extended1 movlw infolength_temperature addwf ProfileFlagByte,F ; add to ProfileFlagByte check_extended1: decfsz divisor_deco,W ; Check divisor bra check_extended2 movlw infolength_deco addwf ProfileFlagByte,F ; add to ProfileFlagByte check_extended2: decfsz divisor_gf,W ; Check divisor bra check_extended3 movlw infolength_gf addwf ProfileFlagByte,F ; add to ProfileFlagByte check_extended3: decfsz divisor_ppo2_sensors,W ; Check divisor bra check_extended4 movlw infolength_ppo2_sensors addwf ProfileFlagByte,F ; add to ProfileFlagByte check_extended4: decfsz divisor_decoplan,W ; Check divisor bra check_extended5 movlw infolength_decoplan addwf ProfileFlagByte,F ; add to ProfileFlagByte check_extended5: decfsz divisor_cns,W ; Check divisor bra check_extended6 movlw infolength_cns addwf ProfileFlagByte,F ; add to ProfileFlagByte check_extended6: decfsz divisor_tank,W ; Check divisor bra check_extended7 movlw infolength_tank addwf ProfileFlagByte,F ; add to ProfileFlagByte check_extended7: ; Second, check global event flag btfss event_occured ; Check global event flag bra store_dive_data3 ; No Event incf ProfileFlagByte,F ; add one byte (The EventByte) clrf EventByte ; reset EventByte movf AlarmType,W ; Type of Alarm Bit 0-3 addwf EventByte,F ; Copy to EventByte Bit 0-3 clrf AlarmType ; Reset AlarmType ; Third, check events and add aditional bytes btfss gas6_changed ; Check flag bra check_event2 movlw d'2' ; Information length addwf ProfileFlagByte,F ; add to ProfileFlagByte bsf EventByte,4 ; Also set Flag in EventByte! check_event2: btfss stored_gas_changed ; Check flag bra check_event3 movlw d'1' ; Information length addwf ProfileFlagByte,F ; add to ProfileFlagByte bsf EventByte,5 ; Also set Flag in EventByte! check_event3: btfss setpoint_changed ; Check flag bra check_event4 movlw d'1' ; Information length addwf ProfileFlagByte,F ; add to ProfileFlagByte bsf EventByte,6 ; Also set Flag in EventByte! check_event4: ; more events? bsf ProfileFlagByte,7 ; Set EventByte Flag in ProfileFlagByte store_dive_data3: movf ProfileFlagByte,W ; finally, write ProfileFlagByte! rcall ghostwrite_byte_profile ; WREG -> Profile in ext. Flash btfss event_occured ; Check global event flag (again) bra store_dive_data4 ; No Event ; Store the EventByte + additional bytes now movf EventByte,W rcall ghostwrite_byte_profile ; WREG -> Profile in ext. Flash btfss gas6_changed ; Check flag bra store_dive_data3b movff char_I_O2_ratio,WREG rcall ghostwrite_byte_profile ; WREG -> Profile in ext. Flash movff char_I_He_ratio,WREG rcall ghostwrite_byte_profile ; WREG -> Profile in ext. Flash bcf gas6_changed ; Clear this event store_dive_data3b: btfss stored_gas_changed ; Check flag bra store_dive_data3c movf active_gas,W ; Store active gas rcall ghostwrite_byte_profile ; WREG -> Profile in ext. Flash bcf stored_gas_changed ; Clear this event store_dive_data3c: btfss setpoint_changed ; Check flag bra store_dive_data3d movff char_I_const_ppO2,WREG rcall ghostwrite_byte_profile ; WREG -> Profile in ext. Flash bcf setpoint_changed ; Clear this event store_dive_data3d: store_dive_data4: ; Store extended informations decfsz divisor_temperature,F ; Check divisor bra store_extended1 rcall store_dive_temperature store_extended1: decfsz divisor_deco,F ; Check divisor bra store_extended2 rcall store_dive_decodata store_extended2: decfsz divisor_gf,F ; Check divisor bra store_extended3 rcall store_dive_gf store_extended3: decfsz divisor_ppo2_sensors,F ; Check divisor bra store_extended4 rcall store_dive_ppO2_sensors store_extended4: decfsz divisor_decoplan,F ; Check divisor bra store_extended5 rcall store_dive_decoplan store_extended5: decfsz divisor_cns,F ; Check divisor bra store_extended6 rcall store_dive_cns store_extended6: decfsz divisor_tank,F ; Check divisor bra store_extended7 rcall store_dive_tank store_extended7: ; The next block is required to take care of "store never" btfsc divisor_temperature,7 ; Test highest Bit (Register must have been zero before the "decfsz" command!) clrf divisor_temperature ; And clear register again, so it will never reach zero... btfsc divisor_deco,7 clrf divisor_deco btfsc divisor_gf,7 clrf divisor_gf btfsc divisor_ppo2_sensors,7 clrf divisor_ppo2_sensors btfsc divisor_decoplan,7 clrf divisor_decoplan btfsc divisor_cns,7 clrf divisor_cns btfsc divisor_tank,7 clrf divisor_tank store_dive_data5: bcf event_occured ; Clear the global event flag return ; Done. (Sample with all informations written to external flash) store_dive_cns: movff int_O_CNS_fraction+0,WREG rcall ghostwrite_byte_profile ; WREG -> Profile in ext. Flash movff int_O_CNS_fraction+1,WREG rcall ghostwrite_byte_profile ; WREG -> Profile in ext. Flash movlw div_cns movwf divisor_cns ; Reload divisor from CF return store_dive_tank: movlw div_tank movwf divisor_tank ; Reload divisor from CF return store_dive_decoplan: ; Store the decoplan lfsr FSR1,char_O_deco_time_for_log+.0 movlw .15 movwf lo store_dive_decoplan_loop: movf POSTINC1,W rcall ghostwrite_byte_profile ; WREG -> Profile in ext. Flash decfsz lo,F bra store_dive_decoplan_loop movlw div_decoplan movwf divisor_decoplan ; Reload divisor from CF return store_dive_ppO2_sensors: movf o2_ppo2_sensor1,W ; Sensor1 ppO2 (in 0.01bar steps) rcall ghostwrite_byte_profile ; WREG -> Profile in ext. Flash SAFE_2BYTE_COPY o2_mv_sensor1,lo ; o2_mv_sensor may be modifified via ISR during the two writes here... movf lo,W ; in 0.1mV steps rcall ghostwrite_byte_profile ; WREG -> Profile in ext. Flash movf hi,W ; in 0.1mV steps rcall ghostwrite_byte_profile ; WREG -> Profile in ext. Flash movf o2_ppo2_sensor2,W ; Sensor2 ppO2 (in 0.01bar steps) rcall ghostwrite_byte_profile ; WREG -> Profile in ext. Flash SAFE_2BYTE_COPY o2_mv_sensor2,lo ; o2_mv_sensor may be modifified via ISR during the two writes here... movf lo,W ; in 0.1mV steps rcall ghostwrite_byte_profile ; WREG -> Profile in ext. Flash movf hi,W ; in 0.1mV steps rcall ghostwrite_byte_profile ; WREG -> Profile in ext. Flash movf o2_ppo2_sensor3,W ; Sensor3 ppO2 (in 0.01bar steps) rcall ghostwrite_byte_profile ; WREG -> Profile in ext. Flash SAFE_2BYTE_COPY o2_mv_sensor3,lo ; o2_mv_sensor may be modifified via ISR during the two writes here... movf lo,W ; in 0.1mV steps rcall ghostwrite_byte_profile ; WREG -> Profile in ext. Flash movf hi,W ; in 0.1mV steps rcall ghostwrite_byte_profile ; WREG -> Profile in ext. Flash movlw div_ppo2_sensors movwf divisor_ppo2_sensors ; Reload divisor return store_dive_gf: movff char_O_gradient_factor,WREG ; gradient factor absolute rcall ghostwrite_byte_profile ; WREG -> Profile in ext. Flash movlw div_gf movwf divisor_gf ; Reload divisor return store_dive_decodata: movf decodata+0,W ; =0:no stop dive, if in deco mode: ceiling in m rcall ghostwrite_byte_profile ; WREG -> Profile in ext. Flash movf decodata+1,W ; no stop time of length of first stop rcall ghostwrite_byte_profile ; WREG -> Profile in ext. Flash movlw div_deco movwf divisor_deco ; Reload divisor return store_dive_temperature: SAFE_2BYTE_COPY temperature,lo movf lo,W ; append temperature to current sample! rcall ghostwrite_byte_profile ; WREG -> Profile in ext. Flash movf hi,W rcall ghostwrite_byte_profile ; WREG -> Profile in ext. Flash movlw div_temperature movwf divisor_temperature ; Reload divisor return ghostwrite_byte_header: goto write_byte_ext_flash_plus_header ; (This call will also delete the 4kB TOC entry first) ; returns... ghostwrite_byte_profile: goto write_byte_ext_flash_plus ; writes byte and increases address with banking at 0x200000 ; returns... global ghostwriter_end_dive ghostwriter_end_dive: movff ext_flash_address+0,ext_flash_log_pointer+0 movff ext_flash_address+1,ext_flash_log_pointer+1 movff ext_flash_address+2,ext_flash_log_pointer+2 ; Save end-of-profile pointer to store in header btfss realdive ; dive longer then one minute goto ghostwriter_end_dive_common ; No, discard everything ; In DEBUG compile, keep all simulated dives in logbook, Desat time, nofly, etc... ifndef __DEBUG btfsc simulatormode_active ; Are we in simulator mode? goto ghostwriter_end_dive_common ; Yes, discard everything endif ; Dive finished (and longer then one minute or Apnoe timeout occured) btfsc FLAG_apnoe_mode ; Calc max. depth (again) for very short apnoe dives call apnoe_calc_maxdepth ; calculate desaturation time movff last_surfpressure_30min+0,int_I_pres_surface+0 ; Pass surface to desat routine ! movff last_surfpressure_30min+1,int_I_pres_surface+1 call deco_calc_desaturation_time ; calculate desaturation time movlb b'00000001' ; select ram bank 1 movff int_O_desaturation_time+0, desaturation_time+0 movff int_O_desaturation_time+1, desaturation_time+1 ; Buffer call calc_deko_surfmode rcall calculate_noflytime ; Calc NoFly time ; store header and ... movlw 0xFD ; .... End-of-Profile Bytes rcall ghostwrite_byte_profile ; WREG -> Profile in ext. Flash movlw 0xFD rcall ghostwrite_byte_profile ; WREG -> Profile in ext. Flash movff ext_flash_address+0,ext_flash_log_pointer+0 movff ext_flash_address+1,ext_flash_log_pointer+1 movff ext_flash_address+2,ext_flash_log_pointer+2 ; Save end-of-profile pointer to store in header ; Set to first address again to store dive length ext_flash_dive_counter:3 clrf EEADRH ; Make sure to select eeprom bank 0 read_int_eeprom .4 movff EEDATA,ext_flash_address+0 read_int_eeprom .5 movff EEDATA,ext_flash_address+1 read_int_eeprom .6 movff EEDATA,ext_flash_address+2 incf_ext_flash_address_0x20 d'6' ; Skip internal "0xFA 0xFA #Divenumber:2 0xFA 0xFA" Header ; Store dive length movf ext_flash_dive_counter+0,W call write_byte_ext_flash_plus_nocnt ; WREG -> Profile in ext. flash (No ext_flash_dive_counter:3 increase) movf ext_flash_dive_counter+1,W call write_byte_ext_flash_plus_nocnt ; WREG -> Profile in ext. flash (No ext_flash_dive_counter:3 increase) movf ext_flash_dive_counter+2,W call write_byte_ext_flash_plus_nocnt ; WREG -> Profile in ext. flash (No ext_flash_dive_counter:3 increase) ; profile recording done. ; Load total number of dives read_int_eeprom .2 movff EEDATA,lo read_int_eeprom .3 movff EEDATA,hi ; +1 increase total dive counter incf lo,F movlw d'0' addwfc hi,F ; Store new number in EEPROM movff lo,EEDATA write_int_eeprom .2 movff hi,EEDATA write_int_eeprom .3 decf lo,F ; -1 ; Set ext_flash_address:3 to TOC entry of this dive ; 1st: 200000h-200FFFh -> lo=0 ; 2nd: 201000h-201FFFh -> lo=1 ; 3rd: 202000h-202FFFh -> lo=2 ; 255: 2FF000h-2FFFFFh -> lo=255 clrf ext_flash_address+0 clrf ext_flash_address+1 movlw 0x20 movwf ext_flash_address+2 movlw .16 mulwf lo ; lo*16 = offset to 0x2000 (up:hi) movf PRODL,W addwf ext_flash_address+1,F movf PRODH,W addwfc ext_flash_address+2,F ; Now, write header movlw 0xFA ; Header start rcall ghostwrite_byte_header ; (This call will also delete the 4kB TOC entry first) movlw 0xFA rcall ghostwrite_byte_header ; WREG -> Header in ext. flash ; store pointer to begin of diveprofile read_int_eeprom .4 movf EEDATA,W rcall ghostwrite_byte_header ; WREG -> Header in ext. flash read_int_eeprom .5 movf EEDATA,W rcall ghostwrite_byte_header ; WREG -> Header in ext. flash read_int_eeprom .6 movf EEDATA,W rcall ghostwrite_byte_header ; WREG -> Header in ext. flash ; store pointer to end of diveprofile movf ext_flash_log_pointer+0,W rcall ghostwrite_byte_header ; WREG -> Header in ext. flash movf ext_flash_log_pointer+1,W rcall ghostwrite_byte_header ; WREG -> Header in ext. flash movf ext_flash_log_pointer+2,W rcall ghostwrite_byte_header ; WREG -> Header in ext. flash ; write rest of header movlw logbook_profile_version ; Defined in ostc3.inc rcall ghostwrite_byte_header ; WREG -> Header in ext. flash ; Store dive length movf ext_flash_dive_counter+0,W rcall ghostwrite_byte_header ; WREG -> Header in ext. flash movf ext_flash_dive_counter+1,W rcall ghostwrite_byte_header ; WREG -> Header in ext. flash movf ext_flash_dive_counter+2,W rcall ghostwrite_byte_header ; WREG -> Header in ext. flash movf year,W ; Date rcall ghostwrite_byte_header ; WREG -> Header in ext. flash movf month,W rcall ghostwrite_byte_header ; WREG -> Header in ext. flash movf day,W rcall ghostwrite_byte_header ; WREG -> Header in ext. flash movf hours,W ; End of dive time rcall ghostwrite_byte_header ; WREG -> Header in ext. flash movf mins,W rcall ghostwrite_byte_header ; WREG -> Header in ext. flash btfss FLAG_apnoe_mode ; Store apnoe max or normal max (Which is only max from the last descent) bra end_dive1 ; Store normal depth movff apnoe_max_pressure+0,lo movff apnoe_max_pressure+1,hi call adjust_depth_with_salinity ; computes salinity setting into lo:hi [mbar] movff lo,apnoe_max_pressure+0 movff hi,apnoe_max_pressure+1 movf apnoe_max_pressure+0,W ; Max. depth rcall ghostwrite_byte_header ; WREG -> Header in ext. flash movf apnoe_max_pressure+1,W rcall ghostwrite_byte_header ; WREG -> Header in ext. flash bra end_dive2 ; skip normal max. depth end_dive1: movff max_pressure+0,lo movff max_pressure+1,hi call adjust_depth_with_salinity ; computes salinity setting into lo:hi [mbar] movff lo,max_pressure+0 movff hi,max_pressure+1 movff max_pressure+0,WREG ; Max. depth rcall ghostwrite_byte_header ; WREG -> Header in ext. flash movff max_pressure+1,WREG rcall ghostwrite_byte_header ; WREG -> Header in ext. flash end_dive2: movf divemins+0,W ; divetime minutes rcall ghostwrite_byte_header ; WREG -> Header in ext. flash movf divemins+1,W rcall ghostwrite_byte_header ; WREG -> Header in ext. flash movf divesecs,W ; divetime seconds rcall ghostwrite_byte_header ; WREG -> Header in ext. flash movff minimum_temperature+0,WREG ; minimum temperature rcall ghostwrite_byte_header ; WREG -> Header in ext. flash movff minimum_temperature+1,WREG rcall ghostwrite_byte_header ; WREG -> Header in ext. flash movff last_surfpressure_30min+0,WREG ; airpressure before dive rcall ghostwrite_byte_header ; WREG -> Header in ext. flash movff last_surfpressure_30min+1,WREG rcall ghostwrite_byte_header ; WREG -> Header in ext. flash movff int_O_desaturation_time+0,WREG ; desaturation time in minutes rcall ghostwrite_byte_header ; WREG -> Header in ext. flash movff int_O_desaturation_time+1,WREG rcall ghostwrite_byte_header ; WREG -> Header in ext. flash btfss FLAG_ccr_mode ; In CCR mode... bra end_dive_oc_gaslist ; No, write OC gases ; Write Diluents... movff opt_dil_O2_ratio+0,WREG rcall ghostwrite_byte_header ; %O2 movff opt_dil_He_ratio+0,WREG rcall ghostwrite_byte_header ; %He movff char_I_dil_change+0,WREG rcall ghostwrite_byte_header ; Configured change depth in m movff opt_dil_type+0,WREG rcall ghostwrite_byte_header ; 0=Disabled, 1=First, 2=Normal movff opt_dil_O2_ratio+1,WREG rcall ghostwrite_byte_header ; %O2 movff opt_dil_He_ratio+1,WREG rcall ghostwrite_byte_header ; %He movff char_I_dil_change+1,WREG rcall ghostwrite_byte_header ; Configured change depth in m movff opt_dil_type+1,WREG rcall ghostwrite_byte_header ; 0=Disabled, 1=First, 2=Normal movff opt_dil_O2_ratio+2,WREG rcall ghostwrite_byte_header ; %O2 movff opt_dil_He_ratio+2,WREG rcall ghostwrite_byte_header ; %He movff char_I_dil_change+2,WREG rcall ghostwrite_byte_header ; Configured change depth in m movff opt_dil_type+2,WREG rcall ghostwrite_byte_header ; 0=Disabled, 1=First, 2=Normal movff opt_dil_O2_ratio+3,WREG rcall ghostwrite_byte_header ; %O2 movff opt_dil_He_ratio+3,WREG rcall ghostwrite_byte_header ; %He movff char_I_dil_change+3,WREG rcall ghostwrite_byte_header ; Configured change depth in m movff opt_dil_type+3,WREG rcall ghostwrite_byte_header ; 0=Disabled, 1=First, 2=Normal movff opt_dil_O2_ratio+4,WREG rcall ghostwrite_byte_header ; %O2 movff opt_dil_He_ratio+4,WREG rcall ghostwrite_byte_header ; %He movff char_I_dil_change+4,WREG rcall ghostwrite_byte_header ; Configured change depth in m movff opt_dil_type+4,WREG rcall ghostwrite_byte_header ; 0=Disabled, 1=First, 2=Normal bra end_dive_oc_cc_common end_dive_oc_gaslist: ; OC Gases... movff opt_gas_O2_ratio+0,WREG rcall ghostwrite_byte_header ; %O2 movff opt_gas_He_ratio+0,WREG rcall ghostwrite_byte_header ; %He movff char_I_deco_gas_change+0,WREG rcall ghostwrite_byte_header ; Configured change depth in m movff opt_gas_type+0,WREG rcall ghostwrite_byte_header ; 0=Disabled, 1=First, 2= Travel, 3= Deco movff opt_gas_O2_ratio+1,WREG rcall ghostwrite_byte_header ; %O2 movff opt_gas_He_ratio+1,WREG rcall ghostwrite_byte_header ; %He movff char_I_deco_gas_change+1,WREG rcall ghostwrite_byte_header ; Configured change depth in m movff opt_gas_type+1,WREG rcall ghostwrite_byte_header ; 0=Disabled, 1=First, 2= Travel, 3= Deco movff opt_gas_O2_ratio+2,WREG rcall ghostwrite_byte_header ; %O2 movff opt_gas_He_ratio+2,WREG rcall ghostwrite_byte_header ; %He movff char_I_deco_gas_change+2,WREG rcall ghostwrite_byte_header ; Configured change depth in m movff opt_gas_type+2,WREG rcall ghostwrite_byte_header ; 0=Disabled, 1=First, 2= Travel, 3= Deco movff opt_gas_O2_ratio+3,WREG rcall ghostwrite_byte_header ; %O2 movff opt_gas_He_ratio+3,WREG rcall ghostwrite_byte_header ; %He movff char_I_deco_gas_change+3,WREG rcall ghostwrite_byte_header ; Configured change depth in m movff opt_gas_type+3,WREG rcall ghostwrite_byte_header ; 0=Disabled, 1=First, 2= Travel, 3= Deco movff opt_gas_O2_ratio+4,WREG rcall ghostwrite_byte_header ; %O2 movff opt_gas_He_ratio+4,WREG rcall ghostwrite_byte_header ; %He movff char_I_deco_gas_change+4,WREG rcall ghostwrite_byte_header ; Configured change depth in m movff opt_gas_type+4,WREG rcall ghostwrite_byte_header ; 0=Disabled, 1=First, 2= Travel, 3= Deco ; bra end_dive_oc_cc_common end_dive_oc_cc_common: movlw softwareversion_x ; Firmware version rcall ghostwrite_byte_header movlw softwareversion_y rcall ghostwrite_byte_header movf batt_voltage+0,W ; Battery voltage rcall ghostwrite_byte_header movf batt_voltage+1,W rcall ghostwrite_byte_header movf samplingrate,W ; Sampling rate btfsc FLAG_apnoe_mode ; Apnoe mode? movlw samplingrate_apnoe ; Apnoe sampling rate rcall ghostwrite_byte_header ; WREG -> Header in ext. flash ; CNS at gebinning of dive movff CNS_start+0,WREG rcall ghostwrite_byte_header ; WREG -> Header in ext. flash movff CNS_start+1,WREG rcall ghostwrite_byte_header ; WREG -> Header in ext. flash ; Gradient factor movff GF_start,WREG rcall ghostwrite_byte_header ; WREG -> Header in ext. flash movff char_O_relative_gradient_GF,WREG rcall ghostwrite_byte_header ; WREG -> Header in ext. flash ; Logbook offset call do_logoffset_common_read; Read into lo:hi movf lo,W rcall ghostwrite_byte_header ; WREG -> Header in ext. flash movf hi,W rcall ghostwrite_byte_header ; WREG -> Header in ext. flash ; Spare at Byte 60 movlw 0xFF rcall ghostwrite_byte_header ; WREG -> Header in ext. flash ; Store 5 Setpoints movff char_I_setpoint_cbar+0,WREG rcall ghostwrite_byte_header ; Setpoint in cbar movff char_I_setpoint_change+0,WREG rcall ghostwrite_byte_header ; Change depth movff char_I_setpoint_cbar+1,WREG rcall ghostwrite_byte_header ; Setpoint in cbar movff char_I_setpoint_change+1,WREG rcall ghostwrite_byte_header ; Change depth movff char_I_setpoint_cbar+2,WREG rcall ghostwrite_byte_header ; Setpoint in cbar movff char_I_setpoint_change+2,WREG rcall ghostwrite_byte_header ; Change depth movff char_I_setpoint_cbar+3,WREG rcall ghostwrite_byte_header ; Setpoint in cbar movff char_I_setpoint_change+3,WREG rcall ghostwrite_byte_header ; Change depth movff char_I_setpoint_cbar+4,WREG rcall ghostwrite_byte_header ; Setpoint in cbar movff char_I_setpoint_change+4,WREG rcall ghostwrite_byte_header ; Change depth movff opt_salinity,WREG ; Salinity (0-5%) rcall ghostwrite_byte_header ; Store Salinity to Dive movff int_O_CNS_fraction+0,WREG ; copy into bank1 rcall ghostwrite_byte_header; Stores CNS% movff int_O_CNS_fraction+1,WREG ; copy into bank1 rcall ghostwrite_byte_header; Stores CNS% movff avr_rel_pressure_total+0,WREG ; Average Depth rcall ghostwrite_byte_header ; WREG -> Header in ext. flash movff avr_rel_pressure_total+1,WREG ; Average Depth rcall ghostwrite_byte_header ; WREG -> Header in ext. flash movff total_divetime_seconds+0,WREG ; Total dive time (Regardless of start_dive_threshold) rcall ghostwrite_byte_header ; WREG -> Header in ext. flash movff total_divetime_seconds+1,WREG ; Total dive time (Regardless of start_dive_threshold) rcall ghostwrite_byte_header ; WREG -> Header in ext. flash movff char_I_GF_Low_percentage,WREG ; GF_lo movff char_I_deco_model,lo decfsz lo,F ; jump over next line if char_I_deco_model == 1 movff char_I_saturation_multiplier,WREG ; Saturation Multiplier rcall ghostwrite_byte_header ; WREG -> Header in ext. flash movff char_I_GF_High_percentage,WREG ; GF_hi movff char_I_deco_model,lo decfsz lo,F ; jump over next line if char_I_deco_model == 1 movff char_I_desaturation_multiplier,WREG ; Desaturation Multiplier rcall ghostwrite_byte_header ; WREG -> Header in ext. flash movff char_I_deco_model,WREG ; 0 = ZH-L16, 1 = ZH-L16-GF rcall ghostwrite_byte_header; writes byte and increases address (no banking) read_int_eeprom .2 movf EEDATA,W rcall ghostwrite_byte_header ; Total dive counter, low read_int_eeprom .3 movf EEDATA,W rcall ghostwrite_byte_header ; Total dive counter, high movff opt_dive_mode,WREG rcall ghostwrite_byte_header ; 0=OC, 1=CC, 2=Gauge, 3=Apnea ; Store all tissue data available movlw .16 movwf lo lfsr FSR1,char_O_tissue_N2_saturation+0 end_dive_store_tissues_N2: movf POSTINC1,W rcall ghostwrite_byte_header ; WREG -> Header in ext. flash decfsz lo,F bra end_dive_store_tissues_N2 ; No movlw .64 movwf lo lfsr FSR1,0x700;pres_tissue_N2+0 ; 16*4Byte Float = 64Bytes end_dive_store_tissues_N2_2: movf POSTINC1,W rcall ghostwrite_byte_header ; WREG -> Header in ext. flash decfsz lo,F bra end_dive_store_tissues_N2_2 ; No movlw .16 movwf lo lfsr FSR1,char_O_tissue_He_saturation+0 end_dive_store_tissues_He: movf POSTINC1,W rcall ghostwrite_byte_header ; WREG -> Header in ext. flash decfsz lo,F bra end_dive_store_tissues_He ; No movlw .64 movwf lo lfsr FSR1,0x740;pres_tissue_He+0 ; 16*4Byte Float = 64Bytes end_dive_store_tissues_He_2: movf POSTINC1,W rcall ghostwrite_byte_header ; WREG -> Header in ext. flash decfsz lo,F bra end_dive_store_tissues_He_2 ; No ; Some deco stuff movff char_I_depth_last_deco,WREG ; last stop [m] rcall ghostwrite_byte_header ; WREG -> Header in ext. flash movff char_I_deco_distance,WREG ; assumed distance to shown stop rcall ghostwrite_byte_header ; WREG -> Header in ext. flash ; Last HUD data movff hud_battery_mv+0,WREG ; Last HUD battery value rcall ghostwrite_byte_header ; WREG -> Header in ext. flash movff hud_battery_mv+1,WREG ; Last HUD battery value rcall ghostwrite_byte_header ; WREG -> Header in ext. flash movff hud_status_byte,WREG ; Last HUD status rcall ghostwrite_byte_header ; WREG -> Header in ext. flash ; Battery gauge registers [nAs] movff battery_gauge+0,WREG ; Battery gauge register rcall ghostwrite_byte_header ; WREG -> Header in ext. flash movff battery_gauge+1,WREG ; Battery gauge register rcall ghostwrite_byte_header ; WREG -> Header in ext. flash movff battery_gauge+2,WREG ; Battery gauge register rcall ghostwrite_byte_header ; WREG -> Header in ext. flash movff battery_gauge+3,WREG ; Battery gauge register rcall ghostwrite_byte_header ; WREG -> Header in ext. flash movff battery_gauge+4,WREG ; Battery gauge register rcall ghostwrite_byte_header ; WREG -> Header in ext. flash movff battery_gauge+5,WREG ; Battery gauge register rcall ghostwrite_byte_header ; WREG -> Header in ext. flash ; Header stop movlw 0xFB rcall ghostwrite_byte_header ; WREG -> Header in ext. flash movlw 0xFB rcall ghostwrite_byte_header ; WREG -> Header in ext. flash call divemode_store_statistics ; Store/update statistics for this unit clrf surface_interval+0 clrf surface_interval+1 ; Clear surface interval timer ghostwriter_end_dive_common: ; Update ext_flash_log_pointer into EEPROM clrf EEADRH movff ext_flash_log_pointer+0,EEDATA write_int_eeprom .4 movff ext_flash_log_pointer+1,EEDATA write_int_eeprom .5 movff ext_flash_log_pointer+2,EEDATA write_int_eeprom .6 bcf simulatormode_active ; if we were in simulator mode ; In DEBUG compile, keep all simulated dives in logbook, Desat time, nofly, etc... ifndef __DEBUG extern deco_pull_tissues_from_vault btfsc restore_deco_data ; Restore decodata? call deco_pull_tissues_from_vault banksel common ; Bank1 endif call update_battery_registers ; update battery registers into EEPROM goto surfloop ; and return to surfaceloop global ghostwriter_short_header ghostwriter_short_header: ; Write short header with divenumber into profile memory ; load pointer for profile storing into RAM (Updated in EEPROM after the dive) clrf EEADRH ; Make sure to select eeprom bank 0 read_int_eeprom .4 movff EEDATA,ext_flash_address+0 read_int_eeprom .5 movff EEDATA,ext_flash_address+1 read_int_eeprom .6 movff EEDATA,ext_flash_address+2 ; Clear dive length counter clrf ext_flash_dive_counter+0 clrf ext_flash_dive_counter+1 clrf ext_flash_dive_counter+2 ; Write short header with divenumber into profile memory movlw 0xFA rcall ghostwrite_byte_profile ; WREG -> Profile in ext. flash movlw 0xFA rcall ghostwrite_byte_profile ; WREG -> Profile in ext. flash ; Load total number of dives (low byte only) read_int_eeprom .2 incf EEDATA,W ;+1 rcall ghostwrite_byte_profile ; WREG -> Profile in ext. flash read_int_eeprom .3 movf EEDATA,W rcall ghostwrite_byte_profile ; WREG -> Profile in ext. flash movlw 0xFA rcall ghostwrite_byte_profile ; WREG -> Profile in ext. flash movlw 0xFA rcall ghostwrite_byte_profile ; WREG -> Profile in ext. flash ; Keep room for dive length ext_flash_dive_counter:3 (Stored at the end of the dive) incf_ext_flash_address_0x20 d'3' ; Skip Bytes in external flash (faster) movf samplingrate,W ; Sampling rate btfsc FLAG_apnoe_mode ; Apnoe mode? movlw samplingrate_apnoe ; Apnoe sampling rate rcall ghostwrite_byte_profile ; WREG -> Profile in ext. flash movlw .7 ; Number of divisors rcall ghostwrite_byte_profile ; WREG -> Profile in ext. flash movlw .0 ; Type rcall ghostwrite_byte_profile ; WREG -> Profile in ext. flash movlw infolength_temperature rcall ghostwrite_byte_profile ; WREG -> Profile in ext. flash movlw div_temperature ; Divisor temperature rcall ghostwrite_byte_profile ; WREG -> Profile in ext. flash movlw .1 ; Type rcall ghostwrite_byte_profile ; WREG -> Profile in ext. flash movlw infolength_deco rcall ghostwrite_byte_profile ; WREG -> Profile in ext. flash movlw div_deco ; Divisor decodata rcall ghostwrite_byte_profile ; WREG -> Profile in ext. flash movlw .2 ; Type rcall ghostwrite_byte_profile ; WREG -> Profile in ext. flash movlw infolength_gf rcall ghostwrite_byte_profile ; WREG -> Profile in ext. flash movlw div_gf ; Divisor gf rcall ghostwrite_byte_profile ; WREG -> Profile in ext. flash movlw .3 ; Type rcall ghostwrite_byte_profile ; WREG -> Profile in ext. flash movlw infolength_ppo2_sensors rcall ghostwrite_byte_profile ; WREG -> Profile in ext. flash movlw div_ppo2_sensors ; Divisor ppO2 rcall ghostwrite_byte_profile ; WREG -> Profile in ext. flash movlw .4 ; Type rcall ghostwrite_byte_profile ; WREG -> Profile in ext. flash movlw infolength_decoplan rcall ghostwrite_byte_profile ; WREG -> Profile in ext. flash movlw div_decoplan ; Divisor debug rcall ghostwrite_byte_profile ; WREG -> Profile in ext. flash movlw .5 ; Type rcall ghostwrite_byte_profile ; WREG -> Profile in ext. flash movlw infolength_cns rcall ghostwrite_byte_profile ; WREG -> Profile in ext. flash movlw div_cns ; Divisor CNS rcall ghostwrite_byte_profile ; WREG -> Profile in ext. flash movlw .6 ; Type rcall ghostwrite_byte_profile ; WREG -> Profile in ext. flash movlw infolength_tank rcall ghostwrite_byte_profile ; WREG -> Profile in ext. flash movlw div_tank ; Divisor Tank rcall ghostwrite_byte_profile ; WREG -> Profile in ext. flash return calculate_noflytime: ; calculate nofly time movff int_O_desaturation_time+0,xA+0 movff int_O_desaturation_time+1,xA+1 btfsc xA+1,7 ; Is desat time negative ? bra calculate_noflytime_3 ; Then surely not valid ! tstfsz xA+0 ; Desat=0? bra calculate_noflytime2 tstfsz xA+1 ; Desat=0? bra calculate_noflytime2 calculate_noflytime_3: ; Desaturation time = zero clrf nofly_time+0 ; Clear nofly time clrf nofly_time+1 ; Clear nofly time return calculate_noflytime2: movff xA+0,int_I_temp+0 movff xA+1,int_I_temp+1 movlw no_fly_time_ratio ; nofly_time_ratio movff WREG,char_I_temp call deco_calc_percentage movlb b'00000001' ; select ram bank 1 movff int_I_temp+0,xA+0 movff int_I_temp+1,xA+1 tstfsz xA+0 ; Desat=0? bra calculate_noflytime_2_final tstfsz xA+1 ; Desat=0? bra calculate_noflytime_2_final bra calculate_noflytime_3 calculate_noflytime_2_final: movff xA+0,nofly_time+0 movff xA+1,nofly_time+1 return divemode_store_statistics: ; Store/update statistics for this unit rcall do_logoffset_common_read ; Existing logbook offset into lo:hi tstfsz lo ; lo=0? bra change_logbook_offset1 ; No, adjust offset tstfsz hi ; hi=0? bra change_logbook_offset1 ; No, adjust offset bra change_logbook_offset2 ; lo=0 and hi=0 -> skip Offset routine change_logbook_offset1: movlw d'1' addwf lo movlw d'0' addwfc hi rcall do_logoffset_common_write ; lo:hi -> EEPROM change_logbook_offset2: ; Add more here... return global do_logoffset_common_write do_logoffset_common_write: movff lo,EEDATA write_int_eeprom 0x0D movff hi,EEDATA write_int_eeprom 0x0E return global do_logoffset_common_read do_logoffset_common_read: clrf EEADRH read_int_eeprom 0x0D movff EEDATA,lo read_int_eeprom 0x0E movff EEDATA,hi ; Existing logbook offset into lo:hi return global update_battery_registers update_battery_registers: ; save battery_gauge:6 into EEPROM 0x07-0x0C clrf EEADRH movff battery_gauge+0,EEDATA write_int_eeprom 0x07 movff battery_gauge+1,EEDATA write_int_eeprom 0x08 movff battery_gauge+2,EEDATA write_int_eeprom 0x09 movff battery_gauge+3,EEDATA write_int_eeprom 0x0A movff battery_gauge+4,EEDATA write_int_eeprom 0x0B movff battery_gauge+5,EEDATA write_int_eeprom 0x0C bcf onehourupdate ; Clear flag return END