Mercurial > public > hwos_code
view src/start.asm @ 588:bf0c76e9b01b
Sync safety stop countdown output
author | heinrichsweikamp |
---|---|
date | Sat, 10 Mar 2018 15:39:33 +0100 (2018-03-10) |
parents | b455b31ce022 |
children | 05053910d668 |
line wrap: on
line source
;============================================================================= ; ; File start.asm REFACTORED VERSION V2.98 ; ; Startup subroutines ; ; Copyright (c) 2011, JD Gascuel, HeinrichsWeikamp, all right reserved. ;============================================================================= ; HISTORY ; 2011-08-06 : [mH] moving from OSTC code #include "hwos.inc" ; Mandatory header #include "ms5541.inc" #include "isr.inc" #include "shared_definitions.h" ; Mailbox from/to p2_deco.c #include "eeprom_rs232.inc" #include "math.inc" #include "tft.inc" #include "surfmode.inc" #include "wait.inc" #include "rtc.inc" #include "external_flash.inc" #include "convert.inc" #include "strings.inc" #include "tft_outputs.inc" #include "adc_lightsensor.inc" #include "i2c.inc" extern init_ostc extern option_restore_all extern deco_setup extern restore_decodata_from_eeprom extern color_image extern oPressureAdjust extern option_reset extern option_save extern option_save_all extern option_check_all extern do_new_battery_select extern use_old_batteries extern use_old_prior_209 ;============================================================================= ; Reset vector: What to do on device wake-up and hard reset. ; reset_v code 0x00000 ; goto start goto 0x1FF00 ; Bootloader ORG 0x00004 ; Needed for second-level bootloader goto start ;============================================================================= boot CODE global start start: lfsr FSR0,0x000 ; Clear rambank 0-14 clear_rambank: clrf POSTINC0 movlw 0x0F cpfseq FSR0H ; Bank 14 done? bra clear_rambank ; clear... call init_ostc ; Get button type from Bootloader-Info movlw .16 movff WREG,analog_counter ; init averaging bsf analog_switches movlw 0x7C movwf TBLPTRL movlw 0xF7 movwf TBLPTRH movlw 0x01 movwf TBLPTRU TBLRD*+ ; Reads 0x07 for analog buttons movlw 0x07 cpfseq TABLAT bcf analog_switches ; read button polarity movlw LOW .897 movwf EEADR movlw HIGH .897 movwf EEADRH call read_eeprom ; EEDATA into EEPROM@EEADR clrf EEADRH ; Reset EEADRH movff EEDATA,button_polarity ; 0xFF (Both normal), 0x00 (Both inverted), 0x01 (Left inverted only), 0x02 (Right inverted only) ; Air pressure compensation after reset call get_calibration_data ; get calibration data from pressure sensor banksel common ; get_calibration_data uses isr_backup call TFT_DisplayOff ; turn off display bsf LEDr ; turn on red LED bcf pressure_refresh ; First pass will not have valid temperature! btfss pressure_refresh ; Air pressure compensation bra $-2 ; Second pass bcf pressure_refresh btfss pressure_refresh ; Air pressure compensation bra $-2 bcf LEDr clrf rel_pressure+0 clrf rel_pressure+1 clrf surface_interval+0 clrf surface_interval+1 SAFE_2BYTE_COPY amb_pressure, last_surfpressure movlw LOW max_surfpressure movff WREG,sub_a+0 ; max. "allowed" air pressure in mbar movlw HIGH max_surfpressure movff WREG,sub_a+1 ; max. "allowed" air pressure in mbar movff last_surfpressure+0,sub_b+0 movff last_surfpressure+1,sub_b+1 call subU16 ; sub_c = sub_a - sub_b btfss neg_flag ; Is 1080mbar < amb_pressure ? bra start_copy_pressure ; NO: current air pressure is lower then "allowed" air pressure, ok! ; not ok! Overwrite with max. "allowed" air pressure movlw LOW max_surfpressure movff WREG,last_surfpressure+0 ; max. "allowed" air pressure in mbar movlw HIGH max_surfpressure movff WREG,last_surfpressure+1 ; max. "allowed" air pressure in mbar start_copy_pressure: movff last_surfpressure+0,last_surfpressure_15min+0 movff last_surfpressure+1,last_surfpressure_15min+1 movff last_surfpressure+0,last_surfpressure_30min+0 movff last_surfpressure+1,last_surfpressure_30min+1 ; resets all air pressure registers ; initialize GF high (needed by deco engine for color-coding the GF value) movff opt_GF_high,char_I_GF_High_percentage SAFE_2BYTE_COPY amb_pressure,int_I_pres_respiration ; breathing at surface movff int_I_pres_respiration+0,int_I_pres_surface+0 ; surface pressure movff int_I_pres_respiration+1,int_I_pres_surface+1 call deco_setup ; set up all model parameters (code located in simulator.asm) call deco_clear_tissue ; Set all tissues to Pamb * N2_ratio (code located in p2_deco.c) banksel common ; back to bank 1, needed after every return from C code call rtc_init ; init clock movlw HIGH .512 ; =2 movwf EEADRH read_int_eeprom .0 clrf EEADRH movlw 0xAA cpfseq EEDATA ; =0xAA bra no_deco_restore ; No call restore_decodata_from_eeprom ; Reload deco data and date/time from eeprom no_deco_restore: call deco_calc_dive_interval_1min ; calculate deco in surface mode call deco_calc_desaturation_time ; calculate desaturation and no-fly time banksel common bcf menubit ; clear menu flag ; Check for Power-on reset here ; ***************************************************************************** ; "new_battery_menu" and "use_old_batteries" 'goto' back to "power_on_return" ; ***************************************************************************** ; Try to migrate the old battery status from firmware 2.09 or earlier.. btfsc RCON,POR ; Was this a power-on reset? call use_old_prior_209 ; No bcf use_old_batt_flag btfsc RCON,POR ; Was this a power-on reset? bsf use_old_batt_flag ; No call lt2942_get_status ; Check for gauge IC btfss battery_gauge_available ; cR or 2 hardware? bra power_on_return2 ; no movlw .30 movff WREG,opt_cR_button_right movff WREG,opt_cR_button_left ; Reset on power-on reset call piezo_config ; Yes, configure buttons call piezo_config ; Yes, configure buttons (2 times) power_on_return2: ; check firmware and reset Custom Functions after an update movlw d'1' movwf EEADR ; =1 movwf EEADRH ; =1 call read_eeprom ; read current version x movff EEDATA,lo incf EEADR,F ; set to 0x102 call read_eeprom ; read current version y movff EEDATA,hi clrf EEADRH ; Reset EEADRH movlw softwareversion_x cpfseq lo ; compare version x bra check_firmware_new ; is not equal -> reset CF and store new version in EEPROM movlw softwareversion_y cpfseq hi ; compare version y bra check_firmware_new ; is not equal -> reset CF and store new version in EEPROM bra restart ; x and y are equal -> do not reset cf check_firmware_new: call TFT_boot ; Initialize TFT (includes clear screen) clrf CCPR1L ; Backlight off WIN_TOP .50 WIN_LEFT .10 movlw LOW 0x1E000 movwf TBLPTRL movlw HIGH 0x1E000 movwf TBLPTRH movlw UPPER 0x1E000 movwf TBLPTRU call color_image ; Show logo call TFT_standard_color WIN_SMALL .10,.100 STRCPY_PRINT "Update successful!" ; Hard coded since language switch does not work here WIN_SMALL .10,.140 STRCPY "New Firmware: " movlw softwareversion_x movwf lo bsf leftbind output_8 PUTC "." movlw softwareversion_y movwf lo output_99x bcf leftbind STRCAT_PRINT "" ; Print second row call TFT_Display_FadeIn ; Display resulting surface screen. ; place "after-update reset" here... lfsr FSR0,oPressureAdjust call option_reset ; Reset FSR0 option to factory default. lfsr FSR0,oPressureAdjust call option_save ; Save in EEPROM rcall backup_flash_page ; backup the first 128 bytes from flash to EEPROM movlw d'1' ; store current version in EEPROM movwf EEADR ; =1 movwf EEADRH ; =1 movlw softwareversion_x movwf EEDATA call write_eeprom ; write version x incf EEADR,F ; set to 0x102 movlw softwareversion_y movwf EEDATA call write_eeprom ; write version y clrf EEADRH ; Reset EEADRH movlw .7 movwf lo check_firmware_new2: ; Wait 1 second bcf onesecupdate btfss onesecupdate bra $-2 decfsz lo,F ; Wait 10 seconds... bra check_firmware_new2 global restart restart: clrf STKPTR ; Never return from here clrf CCP1CON ; stop PWM bcf PORTC,2 ; Pull PWM out to GND btfsc menubit ; Return from Menu/COMM mode or timeout? call option_save_all ; Yes, save all settings into EEPROM call option_restore_all ; Restore everything from EEPROM into RAM call option_check_all ; Check all options (and reset if not within their min/max boundaries) call option_save_all ; Save all settings into EEPROM after they have been checked clrf flag1 ; clear all flags clrf flag2 clrf flag3 clrf flag4 clrf flag5 clrf flag6 clrf flag7 clrf flag8 clrf flag9 clrf flag10 ; Do not clear flag11 (Sensor calibration and charger status) clrf flag12 ; Do not clear flag13 (Important hardware flags) clrf flag14 clrf hardware_flag ; hardware descriptor flag bsf tft_is_dimming ; TFT is dimming up (soon), ignore ambient sensor! ; configure hardware_flag byte bsf ambient_sensor ; Set flag bsf optical_input ; Set flag call lt2942_get_status ; Check for gauge IC btfss battery_gauge_available ; cR/2 hardware? bra restart2 ; No call lt2942_init ; Yes, init battery gauge IC bcf optical_input ; Clear flag banksel 0xF16 bcf ANCON0,7 ; AN7 Digital input banksel common bcf lightsen_power ; Power-down ambient light sensor bcf ambient_sensor ; Clear flag nop btfss PORTF,2 ; Light sensor available? bsf ambient_sensor ; Yes. banksel 0xF16 bsf ANCON0,7 ; AN7 Analog again banksel common bsf lightsen_power ; Power-up ambient light sensor again restart2: btfsc vusb_in bra restart3 ; USB (and powered on) bcf PORTE,0 ; Start comms WAITMS d'1' btfss vusb_in bra restart3 ; USB (and powered off) bsf ble_available ; ble available restart3: bsf PORTE,0 ; Stop comms btfsc ble_available ; ble available? bra restart4 ; Yes, can't be a cR btfss battery_gauge_available ; Rechargeable bra restart4 ; No, can't be a cR bsf analog_o2_input ; Set flag for analog ; The hardware_flag is now: ; 0x11: 2 with BLE ; 0x13: 2 with BLE & ambient ; 0x05: cR ; 0x0A: 3 ; 0x1A: 3 with BLE restart4: ; Select high altitude (Fly) mode? movff last_surfpressure_30min+0,sub_b+0 movff last_surfpressure_30min+1,sub_b+1 movlw HIGH high_altitude_threshold movwf sub_a+1 movlw LOW high_altitude_threshold ; hard-wired 880mbar movwf sub_a+0 call subU16 ; sub_c = sub_a - sub_b btfss neg_flag ; result negative (ambient > 880mbar)? bsf high_altitude_mode ; NO - set flag! btfss analog_o2_input bsf TRISB,3 btfss battery_gauge_available bsf TRISG,0 call ext_flash_disable_protection ; disable write protection for external flash bsf flip_screen ; flip 180° TSTOSS opt_flip_screen ; =1: Flip the screen bcf flip_screen ; normal orientation btfsc use_old_batt_flag ; =1: load old battery information after power-on reset goto use_old_batteries ; returns to "surfloop"! btfsc RCON,POR ; was this a power-on reset? goto surfloop ; jump to surface loop! bsf RCON,POR ; set bit for next detection ; Things to do after a power-on reset goto do_new_battery_select ; returns to "surfloop"! ;============================================================================= ; Setup all flags and parameters for divemode and simulator computations. ; global restart_set_modes_and_flags restart_set_modes_and_flags: ; "Call"ed from divemode, as well! call option_restore_all ; Restore everything from EEPROM ; Setup sampling rate movlw .2 movwf samplingrate TSTOSS opt_sampling_rate ; =1: 10s, =0: 2s bra restart_set_modes_and_flags1 movlw .10 movwf samplingrate restart_set_modes_and_flags1: bcf twosecupdate ; to have divemode routines in sync bcf FLAG_apnoe_mode bcf FLAG_ccr_mode ; =1: CCR mode (Fixed ppO2 or Sensor) active bcf FLAG_gauge_mode ; =1: In Gauge mode bcf FLAG_pscr_mode call disable_ir_s8 ; IR off ; Setup char_I_saturation_multiplier and char_I_desaturation_multiplier movff opt_sat_multiplier_gf,char_I_saturation_multiplier movff opt_desat_multiplier_gf,char_I_desaturation_multiplier movff char_I_deco_model,lo ; 0 = ZH-L16, 1 = ZH-L16-GF tstfsz lo bra restart_set_modes_and_flags1b movff opt_sat_multiplier_non_gf,char_I_saturation_multiplier movff opt_desat_multiplier_non_gf,char_I_desaturation_multiplier restart_set_modes_and_flags1b: movff opt_dive_mode,lo ; 0=OC, 1=CC, 2=Gauge, 3=Apnea, 4=PSCR tstfsz lo bra restart_set_modes_and_flags2 ; OC Mode return restart_set_modes_and_flags2: decfsz lo,F bra restart_set_modes_and_flags3 ; CC Mode btfsc analog_o2_input ; cR? bra restart_set_modes_and_flags2b ; Yes, skip mode check btfsc optical_input ; 3 bra restart_set_modes_and_flags2b ; Yes, skip mode check ; Make sure Sensor is not selected ; opt_ccr_mode must be <> 1 (=0: Fixed SP, =1: Sensor, =2: Auto SP (CCR only)) banksel opt_ccr_mode movlw .1 cpfseq opt_ccr_mode ; = Sensor? bra restart_set_modes_and_flags2b ; No clrf opt_ccr_mode ; Yes, reset to Fixed SP restart_set_modes_and_flags2b: banksel common bsf FLAG_ccr_mode ; =1: CCR mode (Fixed SP, Auto SP or Sensor) active call enable_ir_s8 ; Enable IR/S8-Port return restart_set_modes_and_flags3: decfsz lo,F bra restart_set_modes_and_flags4 ; Gauge Mode bsf FLAG_gauge_mode ; =1: In Gauge mode return restart_set_modes_and_flags4: decfsz lo,F bra restart_set_modes_and_flags5 ; Apnea Mode bsf FLAG_apnoe_mode return ; start in Surfacemode restart_set_modes_and_flags5: ; PSCR Mode btfsc analog_o2_input ; cR? bra restart_set_modes_and_flags5b ; Yes, skip mode check btfsc optical_input ; 3 bra restart_set_modes_and_flags5b ; Yes, skip mode check ; Make sure Sensor is not selected ; opt_ccr_mode must be <> 1 (=0: calculated ppO2, =1: Sensor, =2: Auto SP - not valid in pSCR, too) banksel opt_ccr_mode movlw .1 cpfseq opt_ccr_mode ; = Sensor? bra restart_set_modes_and_flags5b ; No clrf opt_ccr_mode ; Yes, reset to calculated ppO2 restart_set_modes_and_flags5b: banksel opt_ccr_mode bcf opt_ccr_mode,1 ; in pSCR mode only calculated or Sensor, not 2 = Auto SP allowed banksel common bsf FLAG_pscr_mode return ; start in Surfacemode ; backup the first 128bytes from flash to EEPROM backup_flash_page: ; Start address in internal flash movlw 0x00 movwf TBLPTRL movwf TBLPTRH movwf TBLPTRU movlw .128 movwf lo ; Byte counter clrf EEADR movlw .3 movwf EEADRH ; Setup backup address TBLRD*- ; Dummy read to be in 128 byte block backup_flash_loop: tblrd+* ; Table Read with Pre-Increment movff TABLAT,EEDATA ; put 1 byte call write_eeprom ; save it in EEPROM incf EEADR,F decfsz lo,F ; 128byte done? bra backup_flash_loop ; No clrf EEADRH ; Reset EEADRH return ; Done. END