;=============================================================================
;
;   File sleepmode.asm											Version 2.98
;
;   Sleepmode
;
;   Copyright (c) 2011, JD Gascuel, HeinrichsWeikamp, all right reserved.
;==============================================================================
; HISTORY
;  2011-08-12 : [mH] moving from OSTC code

#include "hwos.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"


	extern	vault_decodata_into_eeprom


	;---- Private local variables -------------------------------------------------

	CBLOCK	local1						; max size is 16 Byte !!!
		sm_temp1						; sleepmode temporary 1
		sm_temp2						; sleepmode temporary 2
		sm_timer1						; timer for pressure check every 10 seconds
		sm_timer2						; timer for 10 minutes tasks (updating of tissues)
		sm_timer3						; timer for 15 minutes tasks (updating of surface pressure)
	ENDC								; used: 5 byte, remaining: 11 byte


gui	CODE

;==============================================================================

	global	sleeploop
sleeploop:									; enter sleepmode!
	call	disable_ir_s8					; IR/S8 off
	call	mcp_sleep
	bcf		LEDg
	bcf		LEDr
	call	TFT_Display_FadeOut
	call	TFT_DisplayOff					; display off
	bcf		enable_screen_dumps				; =1: Ignore vin_usb, wait for "l" command (Screen dump)
	call	disable_rs232					; USB off
	call	vault_decodata_into_eeprom		; store deco data
	call	ext_flash_enable_protection		; enable write protection for external flash
	call	update_battery_registers		; update battery registers into EEPROM
	clrf	sm_temp1
	clrf	sm_temp2
	clrf	sm_timer1
	clrf	sm_timer2
	clrf	sm_timer3
	call	speed_normal
	bsf		no_sensor_int					; No sensor interrupt
	clrf	ADCON0							; Power-Down ADC Module

sleeploop_pre:
	bcf		deep_sleep						; Normal sleepmode
	call	I2C_sleep_accelerometer
	call	I2C_sleep_compass
	btfss	analog_switches
	bra		sleeploop_loop					; no analog switches

	bsf		power_sw1
	btfss	power_sw1
	bra		$-4
	bsf		power_sw2
	btfss	power_sw2
	bra		$-4
	movlw	.4								; Wait for button circuity
	movwf	sm_temp1			; Used as temp
	bcf	onesecupdate

sleeploop_pre1:
	rcall	sleepmode_sleep
	btfss	onesecupdate					; Wait 1 second
	bra		sleeploop_pre1
	bcf		onesecupdate
	decfsz	sm_temp1,F
	bra		sleeploop_pre1
	movlw	.32								; Wait for button circuity
	movwf	sm_temp1			; Used as temp

sleeploop_pre2:	
	call	get_analog_switches
	decfsz	sm_temp1,F
	bra		sleeploop_pre2

	bcf		PIR1,TMR1IF
	bcf		INTCON,INT0IF
	bcf		INTCON3,INT1IF
	bcf		PIR5,TMR7IF
	bcf		switch_left
	bcf		switch_right
	bcf		analog_sw2_pressed
	bcf		analog_sw1_pressed
	bsf		PIE1,0							; (Re)Start Timer 1 Interrupt
	bsf		PIE2,1							; (Re)Start Timer 2 Interrupt
	bsf		PIE5,3							; (Re)Start Timer 7 Interrupt
	bsf		INTCON,4						; (Re)Start INT0 Interrupt
	bsf		INTCON3,3						; (Re)Start INT1 Interrupt

sleeploop_loop:
	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

	btfsc	deep_sleep						; Enter deep sleep?
	bra		deepsleep						; Yes

no_deepsleep:
	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 something happens

deepsleep:
	btfss	analog_switches
	bra		no_deepsleep					; no analog switches, no deep sleep required

	bcf		PIE1,0							; Stop Timer 1 Interrupt
	bcf		PIE2,1							; Stop Timer 2 Interrupt
	bcf		PIE5,3							; Stop Timer 7 Interrupt
	bcf		INTCON,4						; Stop INT0 Interrupt
	bcf		INTCON3,3						; Stop INT1 Interrupt
	bcf		power_sw1
	bcf		power_sw2
	rcall	deepsleep_get_accel				; Read accelerometer into WREG
	movwf	sm_temp1			; Store init value

deepsleep_loop:
	btfsc	onesecupdate					; one second in sleep?
	rcall	onesec_deepsleep				; check accelerometer

	btfsc	onesecupdate					; one second in sleep?
	rcall	onesec_sleep					; check switches, check pressure sensor, etc.

	rcall	sleepmode_sleep

	btfss	deep_sleep						; Enter normal sleepmode?
	bra		sleeploop_pre					; Yes

	bra		deepsleep_loop					; do loop until something happens

onesec_deepsleep:
	rcall	deepsleep_get_accel				; Read accelerometer into WREG
	subwf	sm_temp1,W			; sm_temp1 - accel_DZ+0 -> WREG
	btfsc	STATUS,N						; Result negative?
	negf	WREG							; Yes, negate it
	movwf	sm_temp2			; change of acceleration in Z-axis
	movlw	.50								; Threshold (mg)
	cpfslt	sm_temp2			; bigger then the threshold?
	bcf		deep_sleep						; Yes!

;	extern	piezo_config_tx
;	movff	sm_temp1,WREG
;	call	piezo_config_tx
;	movff	accel_DZ+0,WREG
;	call	piezo_config_tx
;	movff	sm_temp2,WREG
;	call	piezo_config_tx

	return

deepsleep_get_accel:
	call	I2C_init_compass				; required for compass1
	call	I2C_init_accelerometer			; required for compass2
	call	I2C_RX_accelerometer			; read Accelerometer
	call	I2C_sleep_compass				; required for compass1
	call	I2C_sleep_accelerometer			; required for compass2
	movff	accel_DZ+0,WREG
	return

onehour_sleep:
	call	update_battery_registers		; update battery registers into EEPROM
	call	vault_decodata_into_eeprom		; update deco data
	bcf		onehourupdate					; all done
	return

onemin_sleep:
	btfsc	onehourupdate					; one hour in sleep?
	rcall	onehour_sleep					; Yes

	btfsc	battery_gauge_available
	call	get_battery_voltage				; Check for charger

	;---- update tissues and CNS every 10 minutes when gradient factor is 0 (no supersaturation in any tissue any more)
	movff	int_O_gradient_factor+0,WREG	; get gradient factor, only the lower byte is used for the value
	tstfsz	WREG							; gradient factor = 0?
	bra		onemin_sleep1					; NO - continue with air pressure compensation
	incf	sm_timer2,F						; count-up...
	movlw	d'9'							; ...to 9
	cpfsgt	sm_timer2						; 10 minutes over?
	bra		onemin_sleep1					; NO - continue with air pressure compensation
	clrf	sm_timer2						; reset counter
	SAFE_2BYTE_COPY amb_pressure, int_I_pres_respiration ; copy pressure to deco routine
	call	deco_calc_dive_interval_10min	; calculate 10 minutes under surface conditions
	banksel	common

onemin_sleep1:
	;---- adjust air pressure compensation any 15 minutes
	incf	sm_timer3,F						; count-up...
	movlw	d'14'							; ...to 14
	cpfsgt	sm_timer3						; 15 minutes over?
	bra		onemin_sleep2					; NO - continue with every-minute-tasks

	; Tasks every 15 minutes in sleep
	bsf		deep_sleep						; enter deep-sleep mode
	clrf	sm_timer3						; reset counter

	SAFE_2BYTE_COPY last_surfpressure_15min, last_surfpressure_30min	; save older air pressure
	SAFE_2BYTE_COPY amb_pressure,            last_surfpressure_15min	; save new   air pressure

	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_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 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_15min+0	; max. "allowed" air pressure in mbar
	movlw	HIGH max_surfpressure
	movff	WREG,last_surfpressure_15min+1	; max. "allowed" air pressure in mbar

onemin_sleep2:
	; Tasks every minute in sleep

	;---- update tissues and CNS every minute when gradient factor is >0 (supersaturation in at least one tissue)
	movff	int_O_gradient_factor+0,WREG	; get gradient factor, only the lower byte is used for the value
	tstfsz	WREG							; gradient factor = 0?
	bra		onemin_sleep3					; NO  - do tissue update on 1 minute schedule
	bra		onemin_sleep4					; YES - tissue update is done on 10 minutes schedule

onemin_sleep3:
	SAFE_2BYTE_COPY amb_pressure, int_I_pres_respiration ; copy pressure to deco routine
	call	deco_calc_dive_interval_1min	; calculate 1 minute under surface conditions
	banksel	common

onemin_sleep4:
	bcf		oneminupdate					; all done
	return

onesec_sleep:
	btfsc	oneminupdate					; one minute in sleep?
	rcall	onemin_sleep					; do one-minute tasks, e.g. calculate desaturation

	btfsc	battery_gauge_available
	call	get_battery_voltage				; Check for charger

	incf	sm_timer1,F						; counts to #test_pressure_in_sleep (10)
	movlw	d'10'
	cpfsgt	sm_timer1						; here: temp variable
	bra		onesec_sleep1					; #test_pressure_in_sleep not done yet

	clrf	sm_timer1						; 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	battery_gauge_available
	bra		onesec_sleep1					; No wake-up with cR hardware
	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		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)
	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
	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
	sleep
	sleep
	clrf	T7GCON							; Reset Timer7 Gate Control register
	movlw	b'10001001'						; 1:1 Prescaler -> 2seconds@32768Hz, synced
	movwf	T7CON
	banksel	common							; Bank1
	return

 END