Mercurial > public > hwos_code

annotate src/sleepmode.asm @ 185:f515712d8cd6

Find changesets by keywords (author, files, the commit message), revision number or hash, or revset expression.
BUGFIX: Check min and max values after PC configuration properly
author heinrichsweikamp
date Sat, 18 Oct 2014 10:03:28 +0200
parents 4574aed5cd4c
children c511dc403d7e
Ignore whitespace changes - Everywhere: Within whitespace: At end of lines:
rev   line source
0
heinrichsweikamp
parents:
diff changeset
1 ;=============================================================================
heinrichsweikamp
parents:
diff changeset
2 ;
heinrichsweikamp
parents:
diff changeset
3 ; File sleepmode.asm
heinrichsweikamp
parents:
diff changeset
4 ;
heinrichsweikamp
parents:
diff changeset
5 ; Sleepmode
heinrichsweikamp
parents:
diff changeset
6 ;
heinrichsweikamp
parents:
diff changeset
7 ; Copyright (c) 2011, JD Gascuel, HeinrichsWeikamp, all right reserved.
heinrichsweikamp
parents:
diff changeset
8 ;=============================================================================
heinrichsweikamp
parents:
diff changeset
9 ; HISTORY
heinrichsweikamp
parents:
diff changeset
10 ; 2011-08-12 : [mH] moving from OSTC code
heinrichsweikamp
parents:
diff changeset
11
heinrichsweikamp
parents:
diff changeset
12 #include "ostc3.inc" ; Mandatory header
heinrichsweikamp
parents:
diff changeset
13 #include "shared_definitions.h" ; Mailbox from/to p2_deco.c
heinrichsweikamp
parents:
diff changeset
14 #include "surfmode.inc"
heinrichsweikamp
parents:
diff changeset
15 #include "tft.inc"
heinrichsweikamp
parents:
diff changeset
16 #include "isr.inc"
heinrichsweikamp
parents:
diff changeset
17 #include "start.inc"
heinrichsweikamp
parents:
diff changeset
18 #include "adc_lightsensor.inc"
heinrichsweikamp
parents:
diff changeset
19 #include "math.inc"
heinrichsweikamp
parents:
diff changeset
20 #include "ms5541.inc"
heinrichsweikamp
parents:
diff changeset
21 #include "wait.inc"
heinrichsweikamp
parents:
diff changeset
22 #include "eeprom_rs232.inc"
heinrichsweikamp
parents:
diff changeset
23 #include "external_flash.inc"
heinrichsweikamp
parents:
diff changeset
24 #include "ghostwriter.inc"
heinrichsweikamp
parents:
diff changeset
25 #include "i2c.inc"
28
heinrichsweikamp
parents: 0
diff changeset
26 #include "mcp.inc"
0
heinrichsweikamp
parents:
diff changeset
27
133
939f1e83c4c2 BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents: 123
diff changeset
28
939f1e83c4c2 BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents: 123
diff changeset
29 extern vault_decodata_into_eeprom
939f1e83c4c2 BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents: 123
diff changeset
30
0
heinrichsweikamp
parents:
diff changeset
31 gui CODE
heinrichsweikamp
parents:
diff changeset
32
heinrichsweikamp
parents:
diff changeset
33 global sleeploop
heinrichsweikamp
parents:
diff changeset
34 sleeploop: ; enter sleepmode!
heinrichsweikamp
parents:
diff changeset
35 call disable_ir ; IR off
28
heinrichsweikamp
parents: 0
diff changeset
36 call mcp_sleep
0
heinrichsweikamp
parents:
diff changeset
37 bcf LEDg
heinrichsweikamp
parents:
diff changeset
38 bcf LEDr
39
e4e91fe8b09d remember last customview in dive and surface mode
mh@mh-THINK.fritz.box
parents: 28
diff changeset
39 movff menupos3,customview_surfmode; save last customview
0
heinrichsweikamp
parents:
diff changeset
40 call TFT_Display_FadeOut
heinrichsweikamp
parents:
diff changeset
41 call TFT_DisplayOff ; display off
heinrichsweikamp
parents:
diff changeset
42 call disable_rs232 ; USB off
133
939f1e83c4c2 BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents: 123
diff changeset
43 call vault_decodata_into_eeprom ; store deco data
0
heinrichsweikamp
parents:
diff changeset
44 call I2C_sleep_accelerometer
heinrichsweikamp
parents:
diff changeset
45 call I2C_sleep_compass
heinrichsweikamp
parents:
diff changeset
46 call ext_flash_enable_protection ; enable write protection for external flash
heinrichsweikamp
parents:
diff changeset
47 call update_battery_registers ; update battery registers into EEPROM
heinrichsweikamp
parents:
diff changeset
48 clrf divemins+0
heinrichsweikamp
parents:
diff changeset
49 clrf divemins+1
heinrichsweikamp
parents:
diff changeset
50 call speed_normal
heinrichsweikamp
parents:
diff changeset
51 bsf no_sensor_int ; No sensor interrupt
heinrichsweikamp
parents:
diff changeset
52 bcf enable_screen_dumps ; =1: Ignore vin_usb, wait for "l" command (Screen dump)
heinrichsweikamp
parents:
diff changeset
53 clrf ADCON0 ; Power-Down ADC Module
heinrichsweikamp
parents:
diff changeset
54 sleeploop_loop:
134
4574aed5cd4c Show clock in Apnea mode, minor layout changes in Apnea mode
heinrichsweikamp
parents: 133
diff changeset
55 btfsc onesecupdate ; one second in sleep?
4574aed5cd4c Show clock in Apnea mode, minor layout changes in Apnea mode
heinrichsweikamp
parents: 133
diff changeset
56 rcall onesec_sleep ; check switches, check pressure sensor, etc.
0
heinrichsweikamp
parents:
diff changeset
57
heinrichsweikamp
parents:
diff changeset
58 btfsc oneminupdate ; one minute in sleep?
heinrichsweikamp
parents:
diff changeset
59 rcall onemin_sleep ; do oneminute tasks, e.g. calculate desaturation
heinrichsweikamp
parents:
diff changeset
60
134
4574aed5cd4c Show clock in Apnea mode, minor layout changes in Apnea mode
heinrichsweikamp
parents: 133
diff changeset
61 btfsc onehourupdate ; one hour in sleep?
4574aed5cd4c Show clock in Apnea mode, minor layout changes in Apnea mode
heinrichsweikamp
parents: 133
diff changeset
62 rcall onehour_sleep ; Yes
0
heinrichsweikamp
parents:
diff changeset
63
heinrichsweikamp
parents:
diff changeset
64 btfss sleepmode ; wake up? (This bit will be set in other routines)
heinrichsweikamp
parents:
diff changeset
65 goto restart ; yes
heinrichsweikamp
parents:
diff changeset
66
heinrichsweikamp
parents:
diff changeset
67 rcall sleepmode_sleep ; Wait at least 35ms (every 62,5ms Timer7 wakeup)
heinrichsweikamp
parents:
diff changeset
68
heinrichsweikamp
parents:
diff changeset
69 ; Any button pressed in sleep?
heinrichsweikamp
parents:
diff changeset
70 btfsc switch_left
heinrichsweikamp
parents:
diff changeset
71 rcall onesec_sleep1a
heinrichsweikamp
parents:
diff changeset
72 btfsc switch_right
heinrichsweikamp
parents:
diff changeset
73 rcall onesec_sleep1a
heinrichsweikamp
parents:
diff changeset
74
heinrichsweikamp
parents:
diff changeset
75 btfss sleepmode ; wake up? (This bit will be set in other routines)
heinrichsweikamp
parents:
diff changeset
76 goto restart ; yes
heinrichsweikamp
parents:
diff changeset
77
heinrichsweikamp
parents:
diff changeset
78 bra sleeploop_loop ; do loop until someting happens
heinrichsweikamp
parents:
diff changeset
79
134
4574aed5cd4c Show clock in Apnea mode, minor layout changes in Apnea mode
heinrichsweikamp
parents: 133
diff changeset
80 onehour_sleep:
4574aed5cd4c Show clock in Apnea mode, minor layout changes in Apnea mode
heinrichsweikamp
parents: 133
diff changeset
81 call update_battery_registers ; update battery registers into EEPROM
4574aed5cd4c Show clock in Apnea mode, minor layout changes in Apnea mode
heinrichsweikamp
parents: 133
diff changeset
82 call vault_decodata_into_eeprom ; update deco data
4574aed5cd4c Show clock in Apnea mode, minor layout changes in Apnea mode
heinrichsweikamp
parents: 133
diff changeset
83 bcf onehourupdate ; all done
4574aed5cd4c Show clock in Apnea mode, minor layout changes in Apnea mode
heinrichsweikamp
parents: 133
diff changeset
84 return
0
heinrichsweikamp
parents:
diff changeset
85
heinrichsweikamp
parents:
diff changeset
86 onemin_sleep:
heinrichsweikamp
parents:
diff changeset
87 ;---- adjust airpressure compensation any 15 minutes
heinrichsweikamp
parents:
diff changeset
88 incf divemins+1,F ; counts to 14...
heinrichsweikamp
parents:
diff changeset
89 movlw d'14'
heinrichsweikamp
parents:
diff changeset
90 cpfsgt divemins+1
heinrichsweikamp
parents:
diff changeset
91 bra onemin_sleep2 ; 15 minutes not done!
heinrichsweikamp
parents:
diff changeset
92
heinrichsweikamp
parents:
diff changeset
93 ; Tasks every 15 minutes in sleep
heinrichsweikamp
parents:
diff changeset
94 clrf divemins+1 ; reset counter
heinrichsweikamp
parents:
diff changeset
95
heinrichsweikamp
parents:
diff changeset
96 call deco_calc_CNS_decrease_15min ; compute CNS decay in sleep only
heinrichsweikamp
parents:
diff changeset
97 banksel common
heinrichsweikamp
parents:
diff changeset
98
heinrichsweikamp
parents:
diff changeset
99 SAFE_2BYTE_COPY last_surfpressure_15min, last_surfpressure_30min ; save older airpressure
heinrichsweikamp
parents:
diff changeset
100 SAFE_2BYTE_COPY amb_pressure, last_surfpressure_15min ; save new airpressure
heinrichsweikamp
parents:
diff changeset
101
heinrichsweikamp
parents:
diff changeset
102 movlw LOW max_surfpressure
heinrichsweikamp
parents:
diff changeset
103 movff WREG,sub_a+0 ; max. "allowed" airpressure in mbar
heinrichsweikamp
parents:
diff changeset
104 movlw HIGH max_surfpressure
heinrichsweikamp
parents:
diff changeset
105 movff WREG,sub_a+1 ; max. "allowed" airpressure in mbar
heinrichsweikamp
parents:
diff changeset
106 movff last_surfpressure_15min+0,sub_b+0
heinrichsweikamp
parents:
diff changeset
107 movff last_surfpressure_15min+1,sub_b+1
heinrichsweikamp
parents:
diff changeset
108 call subU16 ; sub_c = sub_a - sub_b
heinrichsweikamp
parents:
diff changeset
109 btfss neg_flag ; Is 1080mbar < amb_pressure ?
heinrichsweikamp
parents:
diff changeset
110 bra onemin_sleep2 ; NO: current airpressure is lower then "allowed" airpressure, ok!
heinrichsweikamp
parents:
diff changeset
111
heinrichsweikamp
parents:
diff changeset
112 ; not ok! Overwrite with max. "allowed" airpressure
heinrichsweikamp
parents:
diff changeset
113 movlw LOW max_surfpressure
heinrichsweikamp
parents:
diff changeset
114 movff WREG,last_surfpressure_15min+0 ; max. "allowed" airpressure in mbar
heinrichsweikamp
parents:
diff changeset
115 movlw HIGH max_surfpressure
heinrichsweikamp
parents:
diff changeset
116 movff WREG,last_surfpressure_15min+1 ; max. "allowed" airpressure in mbar
heinrichsweikamp
parents:
diff changeset
117
heinrichsweikamp
parents:
diff changeset
118 onemin_sleep2:
heinrichsweikamp
parents:
diff changeset
119 ; Tasks every minute in sleep
heinrichsweikamp
parents:
diff changeset
120 SAFE_2BYTE_COPY amb_pressure, int_I_pres_respiration ; LOW copy pressure to deco routine
heinrichsweikamp
parents:
diff changeset
121 call deco_calc_wo_deco_step_1_min ; "calc_tissue_sleep"
heinrichsweikamp
parents:
diff changeset
122 banksel common
heinrichsweikamp
parents:
diff changeset
123
heinrichsweikamp
parents:
diff changeset
124 bcf oneminupdate ; all done
heinrichsweikamp
parents:
diff changeset
125 return
heinrichsweikamp
parents:
diff changeset
126
heinrichsweikamp
parents:
diff changeset
127 onesec_sleep:
121
heinrichsweikamp
parents: 120
diff changeset
128 btfsc c3_hardware
120
e2f04bb2539c battery check in sleep
heinrichsweikamp
parents: 50
diff changeset
129 call get_battery_voltage ; Check for charger
e2f04bb2539c battery check in sleep
heinrichsweikamp
parents: 50
diff changeset
130
0
heinrichsweikamp
parents:
diff changeset
131 incf divemins+0,F ; counts to #test_pressure_in_sleep (5)
heinrichsweikamp
parents:
diff changeset
132 movlw d'5'
heinrichsweikamp
parents:
diff changeset
133 cpfsgt divemins+0 ; here: temp variable
heinrichsweikamp
parents:
diff changeset
134 bra onesec_sleep1 ; #test_pressure_in_sleep not done yet
heinrichsweikamp
parents:
diff changeset
135
heinrichsweikamp
parents:
diff changeset
136 clrf divemins+0 ; clear counter
heinrichsweikamp
parents:
diff changeset
137 rcall pressuretest_sleep_fast ; Gets pressure without averaging (faster!)
heinrichsweikamp
parents:
diff changeset
138 ; compare current ambient pressure with wake_up_from_sleep
heinrichsweikamp
parents:
diff changeset
139 movlw LOW wake_up_from_sleep
heinrichsweikamp
parents:
diff changeset
140 movwf sub_a+0 ; power on if ambient pressure is greater threshold
heinrichsweikamp
parents:
diff changeset
141 movlw HIGH wake_up_from_sleep
heinrichsweikamp
parents:
diff changeset
142 movwf sub_a+1 ; power on if ambient pressure is greater threshold
heinrichsweikamp
parents:
diff changeset
143 SAFE_2BYTE_COPY amb_pressure, sub_b
heinrichsweikamp
parents:
diff changeset
144 call subU16 ; Is (1160mbar - averaged(amb_pressure)) < 0 ?
heinrichsweikamp
parents:
diff changeset
145 btfsc neg_flag ; Wake up from Sleep?
heinrichsweikamp
parents:
diff changeset
146 bra onesec_sleep1a ; Yes, skip button checks, wake up!
heinrichsweikamp
parents:
diff changeset
147
123
d076e9c02438 add ceiling display
heinrichsweikamp
parents: 121
diff changeset
148 btfsc c3_hardware
d076e9c02438 add ceiling display
heinrichsweikamp
parents: 121
diff changeset
149 bra onesec_sleep1 ; No wake-up with c3 hardware
0
heinrichsweikamp
parents:
diff changeset
150 btfsc vusb_in ; USB plugged in?
123
d076e9c02438 add ceiling display
heinrichsweikamp
parents: 121
diff changeset
151 bra onesec_sleep1a ; Yes, skip button checks, wake up!
0
heinrichsweikamp
parents:
diff changeset
152
heinrichsweikamp
parents:
diff changeset
153 onesec_sleep1:
heinrichsweikamp
parents:
diff changeset
154 bcf onesecupdate ; all done.
heinrichsweikamp
parents:
diff changeset
155 ; Check switches
heinrichsweikamp
parents:
diff changeset
156 btfsc switch_left
heinrichsweikamp
parents:
diff changeset
157 bra onesec_sleep1a
heinrichsweikamp
parents:
diff changeset
158 btfsc switch_right
heinrichsweikamp
parents:
diff changeset
159 bra onesec_sleep1a
heinrichsweikamp
parents:
diff changeset
160 ; No button pressed
heinrichsweikamp
parents:
diff changeset
161 bcf INTCON,INT0IF ; Clear flag
heinrichsweikamp
parents:
diff changeset
162 bcf INTCON3,INT1IF ; Clear flag
heinrichsweikamp
parents:
diff changeset
163 return
heinrichsweikamp
parents:
diff changeset
164
heinrichsweikamp
parents:
diff changeset
165 onesec_sleep1a: ; At least one button pressed or amb_pressure > wake_up_from_sleep
heinrichsweikamp
parents:
diff changeset
166 bcf INTCON,INT0IF ; Clear flag
heinrichsweikamp
parents:
diff changeset
167 bcf INTCON3,INT1IF ; Clear flag
heinrichsweikamp
parents:
diff changeset
168 bcf switch_right
heinrichsweikamp
parents:
diff changeset
169 bcf switch_left
heinrichsweikamp
parents:
diff changeset
170 bcf sleepmode ; wake up!
heinrichsweikamp
parents:
diff changeset
171 SAFE_2BYTE_COPY last_surfpressure_30min, amb_pressure ; copy for compatibility
heinrichsweikamp
parents:
diff changeset
172 movlw .0
heinrichsweikamp
parents:
diff changeset
173 movff WREG,sensor_state_counter ; Reset sensor state counter
heinrichsweikamp
parents:
diff changeset
174 bcf no_sensor_int ; normal sensor interrupt mode
heinrichsweikamp
parents:
diff changeset
175 return
heinrichsweikamp
parents:
diff changeset
176
heinrichsweikamp
parents:
diff changeset
177 pressuretest_sleep_fast: ; Get pressure without averaging (Faster to save some power in sleep mode)
heinrichsweikamp
parents:
diff changeset
178 banksel isr_backup ; Back to Bank0 ISR data
heinrichsweikamp
parents:
diff changeset
179 clrf amb_pressure_avg+0 ; pressure average registers
heinrichsweikamp
parents:
diff changeset
180 clrf amb_pressure_avg+1
heinrichsweikamp
parents:
diff changeset
181 clrf temperature_avg+0
heinrichsweikamp
parents:
diff changeset
182 clrf temperature_avg+1
heinrichsweikamp
parents:
diff changeset
183 call get_temperature_start ; and start temperature integration (73,5us)
heinrichsweikamp
parents:
diff changeset
184 banksel common
heinrichsweikamp
parents:
diff changeset
185 rcall sleepmode_sleep ; Wait at least 35ms (every 62,5ms Timer7 wakeup)
heinrichsweikamp
parents:
diff changeset
186 rcall sleepmode_sleep ; Wait at least 35ms (every 62,5ms Timer7 wakeup)
heinrichsweikamp
parents:
diff changeset
187 banksel isr_backup ; Back to Bank0 ISR data
heinrichsweikamp
parents:
diff changeset
188 call get_temperature_value ; State 1: Get temperature
heinrichsweikamp
parents:
diff changeset
189 call get_pressure_start ; Start pressure integration.
heinrichsweikamp
parents:
diff changeset
190 banksel common
heinrichsweikamp
parents:
diff changeset
191 rcall sleepmode_sleep ; Wait at least 35ms (every 62,5ms Timer7 wakeup)
heinrichsweikamp
parents:
diff changeset
192 rcall sleepmode_sleep ; Wait at least 35ms (every 62,5ms Timer7 wakeup)
50
ec4d8503ec45 NEW: user-selectable color schemes
heinrichsweikamp
parents: 39
diff changeset
193 bsf LEDg ; Show some activity
0
heinrichsweikamp
parents:
diff changeset
194 banksel isr_backup ; Back to Bank0 ISR data
heinrichsweikamp
parents:
diff changeset
195 call get_pressure_value ; State2: Get pressure (51us)
heinrichsweikamp
parents:
diff changeset
196 call calculate_compensation ; calculate temperature compensated pressure (27us)
heinrichsweikamp
parents:
diff changeset
197 banksel common
heinrichsweikamp
parents:
diff changeset
198 SAFE_2BYTE_COPY amb_pressure_avg, amb_pressure ; copy for compatibility
50
ec4d8503ec45 NEW: user-selectable color schemes
heinrichsweikamp
parents: 39
diff changeset
199 bcf LEDg
0
heinrichsweikamp
parents:
diff changeset
200 return
heinrichsweikamp
parents:
diff changeset
201
heinrichsweikamp
parents:
diff changeset
202 sleepmode_sleep:
heinrichsweikamp
parents:
diff changeset
203 banksel 0xF16 ; Addresses, F16h through F5Fh, are also used by SFRs, but are not part of the Access RAM.
heinrichsweikamp
parents:
diff changeset
204 clrf T7GCON ; Reset Timer7 Gate Control register
heinrichsweikamp
parents:
diff changeset
205 movlw b'10001101' ; 1:1 Prescaler -> 2seconds@32768Hz, not synced
heinrichsweikamp
parents:
diff changeset
206 movwf T7CON
heinrichsweikamp
parents:
diff changeset
207 banksel common ; Bank1
heinrichsweikamp
parents:
diff changeset
208 sleep
heinrichsweikamp
parents:
diff changeset
209 nop
heinrichsweikamp
parents:
diff changeset
210 banksel 0xF16 ; Addresses, F16h through F5Fh, are also used by SFRs, but are not part of the Access RAM.
heinrichsweikamp
parents:
diff changeset
211 clrf T7GCON ; Reset Timer7 Gate Control register
heinrichsweikamp
parents:
diff changeset
212 movlw b'10001001' ; 1:1 Prescaler -> 2seconds@32768Hz, synced
heinrichsweikamp
parents:
diff changeset
213 movwf T7CON
heinrichsweikamp
parents:
diff changeset
214 banksel common ; Bank1
heinrichsweikamp
parents:
diff changeset
215 return
heinrichsweikamp
parents:
diff changeset
216
heinrichsweikamp
parents:
diff changeset
217 END