Mercurial > public > hwos_code
view src/sleepmode.asm @ 50:ec4d8503ec45
NEW: user-selectable color schemes
author | heinrichsweikamp |
---|---|
date | Fri, 27 Sep 2013 23:45:57 +0200 (2013-09-27) |
parents | e4e91fe8b09d |
children | e2f04bb2539c |
line wrap: on
line source
;============================================================================= ; ; File sleepmode.asm ; ; Sleepmode ; ; Copyright (c) 2011, JD Gascuel, HeinrichsWeikamp, all right reserved. ;============================================================================= ; HISTORY ; 2011-08-12 : [mH] moving from OSTC code #include "ostc3.inc" ; Mandatory header #include "shared_definitions.h" ; Mailbox from/to p2_deco.c #include "surfmode.inc" #include "tft.inc" #include "isr.inc" #include "start.inc" #include "adc_lightsensor.inc" #include "math.inc" #include "ms5541.inc" #include "wait.inc" #include "eeprom_rs232.inc" #include "external_flash.inc" #include "ghostwriter.inc" #include "i2c.inc" #include "mcp.inc" gui CODE global sleeploop sleeploop: ; enter sleepmode! call disable_ir ; IR off call mcp_sleep bcf LEDg bcf LEDr movff menupos3,customview_surfmode; save last customview call TFT_Display_FadeOut call TFT_DisplayOff ; display off call disable_rs232 ; USB off call I2C_sleep_accelerometer call I2C_sleep_compass call ext_flash_enable_protection ; enable write protection for external flash call update_battery_registers ; update battery registers into EEPROM clrf divemins+0 clrf divemins+1 call speed_normal bsf no_sensor_int ; No sensor interrupt bcf enable_screen_dumps ; =1: Ignore vin_usb, wait for "l" command (Screen dump) clrf ADCON0 ; Power-Down ADC Module sleeploop_loop: btfsc onehourupdate ; one hour in sleep? call update_battery_registers;update battery registers into EEPROM btfsc oneminupdate ; one minute in sleep? rcall onemin_sleep ; do oneminute tasks, e.g. calculate desaturation btfsc onesecupdate ; one second in sleep? rcall onesec_sleep ; check switches, check pressure sensor, etc. btfss sleepmode ; wake up? (This bit will be set in other routines) goto restart ; yes rcall sleepmode_sleep ; Wait at least 35ms (every 62,5ms Timer7 wakeup) ; Any button pressed in sleep? btfsc switch_left rcall onesec_sleep1a btfsc switch_right rcall onesec_sleep1a btfss sleepmode ; wake up? (This bit will be set in other routines) goto restart ; yes bra sleeploop_loop ; do loop until someting happens onemin_sleep: ;---- adjust airpressure compensation any 15 minutes incf divemins+1,F ; counts to 14... movlw d'14' cpfsgt divemins+1 bra onemin_sleep2 ; 15 minutes not done! ; Tasks every 15 minutes in sleep clrf divemins+1 ; reset counter call deco_calc_CNS_decrease_15min ; compute CNS decay in sleep only banksel common SAFE_2BYTE_COPY last_surfpressure_15min, last_surfpressure_30min ; save older airpressure SAFE_2BYTE_COPY amb_pressure, last_surfpressure_15min ; save new airpressure movlw LOW max_surfpressure movff WREG,sub_a+0 ; max. "allowed" airpressure in mbar movlw HIGH max_surfpressure movff WREG,sub_a+1 ; max. "allowed" airpressure in mbar movff last_surfpressure_15min+0,sub_b+0 movff last_surfpressure_15min+1,sub_b+1 call subU16 ; sub_c = sub_a - sub_b btfss neg_flag ; Is 1080mbar < amb_pressure ? bra onemin_sleep2 ; NO: current airpressure is lower then "allowed" airpressure, ok! ; not ok! Overwrite with max. "allowed" airpressure movlw LOW max_surfpressure movff WREG,last_surfpressure_15min+0 ; max. "allowed" airpressure in mbar movlw HIGH max_surfpressure movff WREG,last_surfpressure_15min+1 ; max. "allowed" airpressure in mbar onemin_sleep2: ; Tasks every minute in sleep SAFE_2BYTE_COPY amb_pressure, int_I_pres_respiration ; LOW copy pressure to deco routine call deco_calc_wo_deco_step_1_min ; "calc_tissue_sleep" banksel common bcf oneminupdate ; all done return onesec_sleep: incf divemins+0,F ; counts to #test_pressure_in_sleep (5) movlw d'5' cpfsgt divemins+0 ; here: temp variable bra onesec_sleep1 ; #test_pressure_in_sleep not done yet clrf divemins+0 ; clear counter rcall pressuretest_sleep_fast ; Gets pressure without averaging (faster!) ; compare current ambient pressure with wake_up_from_sleep movlw LOW wake_up_from_sleep movwf sub_a+0 ; power on if ambient pressure is greater threshold movlw HIGH wake_up_from_sleep movwf sub_a+1 ; power on if ambient pressure is greater threshold SAFE_2BYTE_COPY amb_pressure, sub_b call subU16 ; Is (1160mbar - averaged(amb_pressure)) < 0 ? btfsc neg_flag ; Wake up from Sleep? bra onesec_sleep1a ; Yes, skip button checks, wake up! btfsc vusb_in ; USB plugged in? bra onesec_sleep1a ; Yes, skip button checks, wake up! onesec_sleep1: bcf onesecupdate ; all done. ; Check switches btfsc switch_left bra onesec_sleep1a btfsc switch_right bra onesec_sleep1a ; No button pressed bcf INTCON,INT0IF ; Clear flag bcf INTCON3,INT1IF ; Clear flag return onesec_sleep1a: ; At least one button pressed or amb_pressure > wake_up_from_sleep bcf INTCON,INT0IF ; Clear flag bcf INTCON3,INT1IF ; Clear flag bcf switch_right bcf switch_left bcf sleepmode ; wake up! SAFE_2BYTE_COPY last_surfpressure_30min, amb_pressure ; copy for compatibility movlw .0 movff WREG,sensor_state_counter ; Reset sensor state counter bcf no_sensor_int ; normal sensor interrupt mode return pressuretest_sleep_fast: ; Get pressure without averaging (Faster to save some power in sleep mode) banksel isr_backup ; Back to Bank0 ISR data clrf amb_pressure_avg+0 ; pressure average registers clrf amb_pressure_avg+1 clrf temperature_avg+0 clrf temperature_avg+1 call get_temperature_start ; and start temperature integration (73,5us) banksel common rcall sleepmode_sleep ; Wait at least 35ms (every 62,5ms Timer7 wakeup) rcall sleepmode_sleep ; Wait at least 35ms (every 62,5ms Timer7 wakeup) banksel isr_backup ; Back to Bank0 ISR data call get_temperature_value ; State 1: Get temperature call get_pressure_start ; Start pressure integration. banksel common rcall sleepmode_sleep ; Wait at least 35ms (every 62,5ms Timer7 wakeup) rcall sleepmode_sleep ; Wait at least 35ms (every 62,5ms Timer7 wakeup) bsf LEDg ; Show some activity banksel isr_backup ; Back to Bank0 ISR data call get_pressure_value ; State2: Get pressure (51us) call calculate_compensation ; calculate temperature compensated pressure (27us) banksel common SAFE_2BYTE_COPY amb_pressure_avg, amb_pressure ; copy for compatibility bcf LEDg return sleepmode_sleep: banksel 0xF16 ; Addresses, F16h through F5Fh, are also used by SFRs, but are not part of the Access RAM. clrf T7GCON ; Reset Timer7 Gate Control register movlw b'10001101' ; 1:1 Prescaler -> 2seconds@32768Hz, not synced movwf T7CON banksel common ; Bank1 sleep nop banksel 0xF16 ; Addresses, F16h through F5Fh, are also used by SFRs, but are not part of the Access RAM. clrf T7GCON ; Reset Timer7 Gate Control register movlw b'10001001' ; 1:1 Prescaler -> 2seconds@32768Hz, synced movwf T7CON banksel common ; Bank1 return END