Mercurial > public > hwos_code
annotate src/sleepmode.asm @ 594:b891cd260d1b
2.97 SP1 release
author | heinrichsweikamp |
---|---|
date | Thu, 17 May 2018 20:46:33 +0200 |
parents | b455b31ce022 |
children | ca4556fb60b9 |
rev | line source |
---|---|
0 | 1 ;============================================================================= |
2 ; | |
582 | 3 ; File sleepmode.asm Version 2.98 |
0 | 4 ; |
5 ; Sleepmode | |
6 ; | |
7 ; Copyright (c) 2011, JD Gascuel, HeinrichsWeikamp, all right reserved. | |
582 | 8 ;============================================================================== |
0 | 9 ; HISTORY |
10 ; 2011-08-12 : [mH] moving from OSTC code | |
11 | |
582 | 12 #include "hwos.inc" ; Mandatory header |
13 #include "shared_definitions.h" ; Mailbox from/to p2_deco.c | |
14 #include "surfmode.inc" | |
15 #include "tft.inc" | |
16 #include "isr.inc" | |
17 #include "start.inc" | |
18 #include "adc_lightsensor.inc" | |
19 #include "math.inc" | |
20 #include "ms5541.inc" | |
21 #include "wait.inc" | |
22 #include "eeprom_rs232.inc" | |
23 #include "external_flash.inc" | |
24 #include "ghostwriter.inc" | |
25 #include "i2c.inc" | |
26 #include "mcp.inc" | |
0 | 27 |
133
939f1e83c4c2
BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents:
123
diff
changeset
|
28 |
582 | 29 extern vault_decodata_into_eeprom |
30 | |
31 | |
32 ;---- Private local variables ------------------------------------------------- | |
133
939f1e83c4c2
BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents:
123
diff
changeset
|
33 |
582 | 34 CBLOCK local1 ; max size is 16 Byte !!! |
35 sm_temp1 ; sleepmode temporary 1 | |
36 sm_temp2 ; sleepmode temporary 2 | |
37 sm_timer1 ; timer for pressure check every 10 seconds | |
38 sm_timer2 ; timer for 10 minutes tasks (updating of tissues) | |
39 sm_timer3 ; timer for 15 minutes tasks (updating of surface pressure) | |
40 ENDC ; used: 5 byte, remaining: 11 byte | |
41 | |
42 | |
43 gui CODE | |
44 | |
45 ;============================================================================== | |
0 | 46 |
47 global sleeploop | |
582 | 48 sleeploop: ; enter sleepmode! |
49 call disable_ir_s8 ; IR/S8 off | |
50 call mcp_sleep | |
51 bcf LEDg | |
52 bcf LEDr | |
0 | 53 call TFT_Display_FadeOut |
582 | 54 call TFT_DisplayOff ; display off |
55 bcf enable_screen_dumps ; =1: Ignore vin_usb, wait for "l" command (Screen dump) | |
56 call disable_rs232 ; USB off | |
57 call vault_decodata_into_eeprom ; store deco data | |
58 call ext_flash_enable_protection ; enable write protection for external flash | |
59 call update_battery_registers ; update battery registers into EEPROM | |
60 clrf sm_temp1 | |
61 clrf sm_temp2 | |
62 clrf sm_timer1 | |
63 clrf sm_timer2 | |
64 clrf sm_timer3 | |
0 | 65 call speed_normal |
582 | 66 bsf no_sensor_int ; No sensor interrupt |
67 clrf ADCON0 ; Power-Down ADC Module | |
68 | |
490
8dfb93e80338
NEW: Deep Sleep mode for OSTC Plus and OSTC 2 (2017) (Entered automatically)
heinrichsweikamp
parents:
448
diff
changeset
|
69 sleeploop_pre: |
582 | 70 bcf deep_sleep ; Normal sleepmode |
71 call I2C_sleep_accelerometer | |
72 call I2C_sleep_compass | |
73 btfss analog_switches | |
74 bra sleeploop_loop ; no analog switches | |
490
8dfb93e80338
NEW: Deep Sleep mode for OSTC Plus and OSTC 2 (2017) (Entered automatically)
heinrichsweikamp
parents:
448
diff
changeset
|
75 |
582 | 76 bsf power_sw1 |
77 btfss power_sw1 | |
78 bra $-4 | |
79 bsf power_sw2 | |
80 btfss power_sw2 | |
81 bra $-4 | |
82 movlw .4 ; Wait for button circuity | |
83 movwf sm_temp1 ; Used as temp | |
490
8dfb93e80338
NEW: Deep Sleep mode for OSTC Plus and OSTC 2 (2017) (Entered automatically)
heinrichsweikamp
parents:
448
diff
changeset
|
84 bcf onesecupdate |
582 | 85 |
490
8dfb93e80338
NEW: Deep Sleep mode for OSTC Plus and OSTC 2 (2017) (Entered automatically)
heinrichsweikamp
parents:
448
diff
changeset
|
86 sleeploop_pre1: |
491 | 87 rcall sleepmode_sleep |
582 | 88 btfss onesecupdate ; Wait 1 second |
89 bra sleeploop_pre1 | |
90 bcf onesecupdate | |
91 decfsz sm_temp1,F | |
92 bra sleeploop_pre1 | |
93 movlw .32 ; Wait for button circuity | |
94 movwf sm_temp1 ; Used as temp | |
490
8dfb93e80338
NEW: Deep Sleep mode for OSTC Plus and OSTC 2 (2017) (Entered automatically)
heinrichsweikamp
parents:
448
diff
changeset
|
95 |
8dfb93e80338
NEW: Deep Sleep mode for OSTC Plus and OSTC 2 (2017) (Entered automatically)
heinrichsweikamp
parents:
448
diff
changeset
|
96 sleeploop_pre2: |
8dfb93e80338
NEW: Deep Sleep mode for OSTC Plus and OSTC 2 (2017) (Entered automatically)
heinrichsweikamp
parents:
448
diff
changeset
|
97 call get_analog_switches |
582 | 98 decfsz sm_temp1,F |
99 bra sleeploop_pre2 | |
100 | |
101 bcf PIR1,TMR1IF | |
102 bcf INTCON,INT0IF | |
103 bcf INTCON3,INT1IF | |
104 bcf PIR5,TMR7IF | |
105 bcf switch_left | |
106 bcf switch_right | |
107 bcf analog_sw2_pressed | |
108 bcf analog_sw1_pressed | |
109 bsf PIE1,0 ; (Re)Start Timer 1 Interrupt | |
110 bsf PIE2,1 ; (Re)Start Timer 2 Interrupt | |
111 bsf PIE5,3 ; (Re)Start Timer 7 Interrupt | |
112 bsf INTCON,4 ; (Re)Start INT0 Interrupt | |
113 bsf INTCON3,3 ; (Re)Start INT1 Interrupt | |
490
8dfb93e80338
NEW: Deep Sleep mode for OSTC Plus and OSTC 2 (2017) (Entered automatically)
heinrichsweikamp
parents:
448
diff
changeset
|
114 |
0 | 115 sleeploop_loop: |
582 | 116 btfsc onesecupdate ; one second in sleep? |
117 rcall onesec_sleep ; check switches, check pressure sensor, etc. | |
118 | |
119 btfss sleepmode ; wake up? (This bit will be set in other routines) | |
120 goto restart ; yes | |
0 | 121 |
582 | 122 btfsc deep_sleep ; Enter deep sleep? |
123 bra deepsleep ; Yes | |
124 | |
491 | 125 no_deepsleep: |
582 | 126 rcall sleepmode_sleep ; Wait at least 35ms (every 62,5ms Timer7 wakeup) |
0 | 127 |
128 ; Any button pressed in sleep? | |
490
8dfb93e80338
NEW: Deep Sleep mode for OSTC Plus and OSTC 2 (2017) (Entered automatically)
heinrichsweikamp
parents:
448
diff
changeset
|
129 ; btfsc switch_left |
8dfb93e80338
NEW: Deep Sleep mode for OSTC Plus and OSTC 2 (2017) (Entered automatically)
heinrichsweikamp
parents:
448
diff
changeset
|
130 ; rcall onesec_sleep1a |
8dfb93e80338
NEW: Deep Sleep mode for OSTC Plus and OSTC 2 (2017) (Entered automatically)
heinrichsweikamp
parents:
448
diff
changeset
|
131 ; btfsc switch_right |
8dfb93e80338
NEW: Deep Sleep mode for OSTC Plus and OSTC 2 (2017) (Entered automatically)
heinrichsweikamp
parents:
448
diff
changeset
|
132 ; rcall onesec_sleep1a |
8dfb93e80338
NEW: Deep Sleep mode for OSTC Plus and OSTC 2 (2017) (Entered automatically)
heinrichsweikamp
parents:
448
diff
changeset
|
133 ; |
582 | 134 ; btfss sleepmode ; wake up? (This bit will be set in other routines) |
135 ; goto restart ; yes | |
0 | 136 |
582 | 137 bra sleeploop_loop ; do loop until something happens |
0 | 138 |
490
8dfb93e80338
NEW: Deep Sleep mode for OSTC Plus and OSTC 2 (2017) (Entered automatically)
heinrichsweikamp
parents:
448
diff
changeset
|
139 deepsleep: |
582 | 140 btfss analog_switches |
141 bra no_deepsleep ; no analog switches, no deep sleep required | |
490
8dfb93e80338
NEW: Deep Sleep mode for OSTC Plus and OSTC 2 (2017) (Entered automatically)
heinrichsweikamp
parents:
448
diff
changeset
|
142 |
582 | 143 bcf PIE1,0 ; Stop Timer 1 Interrupt |
144 bcf PIE2,1 ; Stop Timer 2 Interrupt | |
145 bcf PIE5,3 ; Stop Timer 7 Interrupt | |
146 bcf INTCON,4 ; Stop INT0 Interrupt | |
147 bcf INTCON3,3 ; Stop INT1 Interrupt | |
148 bcf power_sw1 | |
149 bcf power_sw2 | |
150 rcall deepsleep_get_accel ; Read accelerometer into WREG | |
151 movwf sm_temp1 ; Store init value | |
490
8dfb93e80338
NEW: Deep Sleep mode for OSTC Plus and OSTC 2 (2017) (Entered automatically)
heinrichsweikamp
parents:
448
diff
changeset
|
152 |
582 | 153 deepsleep_loop: |
154 btfsc onesecupdate ; one second in sleep? | |
155 rcall onesec_deepsleep ; check accelerometer | |
156 | |
157 btfsc onesecupdate ; one second in sleep? | |
158 rcall onesec_sleep ; check switches, check pressure sensor, etc. | |
490
8dfb93e80338
NEW: Deep Sleep mode for OSTC Plus and OSTC 2 (2017) (Entered automatically)
heinrichsweikamp
parents:
448
diff
changeset
|
159 |
491 | 160 rcall sleepmode_sleep |
490
8dfb93e80338
NEW: Deep Sleep mode for OSTC Plus and OSTC 2 (2017) (Entered automatically)
heinrichsweikamp
parents:
448
diff
changeset
|
161 |
582 | 162 btfss deep_sleep ; Enter normal sleepmode? |
163 bra sleeploop_pre ; Yes | |
164 | |
165 bra deepsleep_loop ; do loop until something happens | |
490
8dfb93e80338
NEW: Deep Sleep mode for OSTC Plus and OSTC 2 (2017) (Entered automatically)
heinrichsweikamp
parents:
448
diff
changeset
|
166 |
8dfb93e80338
NEW: Deep Sleep mode for OSTC Plus and OSTC 2 (2017) (Entered automatically)
heinrichsweikamp
parents:
448
diff
changeset
|
167 onesec_deepsleep: |
582 | 168 rcall deepsleep_get_accel ; Read accelerometer into WREG |
169 subwf sm_temp1,W ; sm_temp1 - accel_DZ+0 -> WREG | |
170 btfsc STATUS,N ; Result negative? | |
171 negf WREG ; Yes, negate it | |
172 movwf sm_temp2 ; change of acceleration in Z-axis | |
173 movlw .50 ; Threshold (mg) | |
174 cpfslt sm_temp2 ; bigger then the threshold? | |
175 bcf deep_sleep ; Yes! | |
490
8dfb93e80338
NEW: Deep Sleep mode for OSTC Plus and OSTC 2 (2017) (Entered automatically)
heinrichsweikamp
parents:
448
diff
changeset
|
176 |
8dfb93e80338
NEW: Deep Sleep mode for OSTC Plus and OSTC 2 (2017) (Entered automatically)
heinrichsweikamp
parents:
448
diff
changeset
|
177 ; extern piezo_config_tx |
582 | 178 ; movff sm_temp1,WREG |
490
8dfb93e80338
NEW: Deep Sleep mode for OSTC Plus and OSTC 2 (2017) (Entered automatically)
heinrichsweikamp
parents:
448
diff
changeset
|
179 ; call piezo_config_tx |
8dfb93e80338
NEW: Deep Sleep mode for OSTC Plus and OSTC 2 (2017) (Entered automatically)
heinrichsweikamp
parents:
448
diff
changeset
|
180 ; movff accel_DZ+0,WREG |
8dfb93e80338
NEW: Deep Sleep mode for OSTC Plus and OSTC 2 (2017) (Entered automatically)
heinrichsweikamp
parents:
448
diff
changeset
|
181 ; call piezo_config_tx |
582 | 182 ; movff sm_temp2,WREG |
490
8dfb93e80338
NEW: Deep Sleep mode for OSTC Plus and OSTC 2 (2017) (Entered automatically)
heinrichsweikamp
parents:
448
diff
changeset
|
183 ; call piezo_config_tx |
582 | 184 |
490
8dfb93e80338
NEW: Deep Sleep mode for OSTC Plus and OSTC 2 (2017) (Entered automatically)
heinrichsweikamp
parents:
448
diff
changeset
|
185 return |
582 | 186 |
490
8dfb93e80338
NEW: Deep Sleep mode for OSTC Plus and OSTC 2 (2017) (Entered automatically)
heinrichsweikamp
parents:
448
diff
changeset
|
187 deepsleep_get_accel: |
582 | 188 call I2C_init_compass ; required for compass1 |
189 call I2C_init_accelerometer ; required for compass2 | |
190 call I2C_RX_accelerometer ; read Accelerometer | |
191 call I2C_sleep_compass ; required for compass1 | |
192 call I2C_sleep_accelerometer ; required for compass2 | |
490
8dfb93e80338
NEW: Deep Sleep mode for OSTC Plus and OSTC 2 (2017) (Entered automatically)
heinrichsweikamp
parents:
448
diff
changeset
|
193 movff accel_DZ+0,WREG |
8dfb93e80338
NEW: Deep Sleep mode for OSTC Plus and OSTC 2 (2017) (Entered automatically)
heinrichsweikamp
parents:
448
diff
changeset
|
194 return |
582 | 195 |
134
4574aed5cd4c
Show clock in Apnea mode, minor layout changes in Apnea mode
heinrichsweikamp
parents:
133
diff
changeset
|
196 onehour_sleep: |
582 | 197 call update_battery_registers ; update battery registers into EEPROM |
198 call vault_decodata_into_eeprom ; update deco data | |
199 bcf onehourupdate ; all done | |
200 return | |
0 | 201 |
202 onemin_sleep: | |
582 | 203 btfsc onehourupdate ; one hour in sleep? |
204 rcall onehour_sleep ; Yes | |
205 | |
206 btfsc battery_gauge_available | |
207 call get_battery_voltage ; Check for charger | |
198
c511dc403d7e
(Slightly) reduce current consumption in Eco and sleep mode
heinrichsweikamp
parents:
134
diff
changeset
|
208 |
582 | 209 ;---- update tissues and CNS every 10 minutes when gradient factor is 0 (no supersaturation in any tissue any more) |
210 movff int_O_gradient_factor+0,WREG ; get gradient factor, only the lower byte is used for the value | |
211 tstfsz WREG ; gradient factor = 0? | |
212 bra onemin_sleep1 ; NO - continue with air pressure compensation | |
213 incf sm_timer2,F ; count-up... | |
214 movlw d'9' ; ...to 9 | |
215 cpfsgt sm_timer2 ; 10 minutes over? | |
216 bra onemin_sleep1 ; NO - continue with air pressure compensation | |
217 clrf sm_timer2 ; reset counter | |
218 SAFE_2BYTE_COPY amb_pressure, int_I_pres_respiration ; copy pressure to deco routine | |
219 call deco_calc_dive_interval_10min ; calculate 10 minutes under surface conditions | |
0 | 220 banksel common |
221 | |
582 | 222 onemin_sleep1: |
223 ;---- adjust air pressure compensation any 15 minutes | |
224 incf sm_timer3,F ; count-up... | |
225 movlw d'14' ; ...to 14 | |
226 cpfsgt sm_timer3 ; 15 minutes over? | |
227 bra onemin_sleep2 ; NO - continue with every-minute-tasks | |
0 | 228 |
582 | 229 ; Tasks every 15 minutes in sleep |
230 bsf deep_sleep ; enter deep-sleep mode | |
231 clrf sm_timer3 ; reset counter | |
232 | |
233 SAFE_2BYTE_COPY last_surfpressure_15min, last_surfpressure_30min ; save older air pressure | |
234 SAFE_2BYTE_COPY amb_pressure, last_surfpressure_15min ; save new air pressure | |
235 | |
236 movlw LOW max_surfpressure | |
237 movff WREG,sub_a+0 ; max. "allowed" air pressure in mbar | |
238 movlw HIGH max_surfpressure | |
239 movff WREG,sub_a+1 ; max. "allowed" air pressure in mbar | |
0 | 240 movff last_surfpressure_15min+0,sub_b+0 |
241 movff last_surfpressure_15min+1,sub_b+1 | |
582 | 242 call subU16 ; sub_c = sub_a - sub_b |
243 btfss neg_flag ; Is 1080mbar < amb_pressure ? | |
244 bra onemin_sleep2 ; NO: current air pressure is lower then "allowed" air pressure, ok! | |
0 | 245 |
582 | 246 ; not ok! Overwrite with max. "allowed" air pressure |
247 movlw LOW max_surfpressure | |
248 movff WREG,last_surfpressure_15min+0 ; max. "allowed" air pressure in mbar | |
249 movlw HIGH max_surfpressure | |
250 movff WREG,last_surfpressure_15min+1 ; max. "allowed" air pressure in mbar | |
0 | 251 |
252 onemin_sleep2: | |
582 | 253 ; Tasks every minute in sleep |
254 | |
255 ;---- update tissues and CNS every minute when gradient factor is >0 (supersaturation in at least one tissue) | |
256 movff int_O_gradient_factor+0,WREG ; get gradient factor, only the lower byte is used for the value | |
257 tstfsz WREG ; gradient factor = 0? | |
258 bra onemin_sleep3 ; NO - do tissue update on 1 minute schedule | |
259 bra onemin_sleep4 ; YES - tissue update is done on 10 minutes schedule | |
0 | 260 |
582 | 261 onemin_sleep3: |
262 SAFE_2BYTE_COPY amb_pressure, int_I_pres_respiration ; copy pressure to deco routine | |
263 call deco_calc_dive_interval_1min ; calculate 1 minute under surface conditions | |
264 banksel common | |
265 | |
266 onemin_sleep4: | |
267 bcf oneminupdate ; all done | |
0 | 268 return |
269 | |
270 onesec_sleep: | |
582 | 271 btfsc oneminupdate ; one minute in sleep? |
272 rcall onemin_sleep ; do one-minute tasks, e.g. calculate desaturation | |
198
c511dc403d7e
(Slightly) reduce current consumption in Eco and sleep mode
heinrichsweikamp
parents:
134
diff
changeset
|
273 |
582 | 274 btfsc battery_gauge_available |
275 call get_battery_voltage ; Check for charger | |
120 | 276 |
582 | 277 incf sm_timer1,F ; counts to #test_pressure_in_sleep (10) |
490
8dfb93e80338
NEW: Deep Sleep mode for OSTC Plus and OSTC 2 (2017) (Entered automatically)
heinrichsweikamp
parents:
448
diff
changeset
|
278 movlw d'10' |
582 | 279 cpfsgt sm_timer1 ; here: temp variable |
280 bra onesec_sleep1 ; #test_pressure_in_sleep not done yet | |
0 | 281 |
582 | 282 clrf sm_timer1 ; clear counter |
283 rcall pressuretest_sleep_fast ; Gets pressure without averaging (faster!) | |
284 ; compare current ambient pressure with wake_up_from_sleep | |
285 movlw LOW wake_up_from_sleep | |
286 movwf sub_a+0 ; power on if ambient pressure is greater threshold | |
287 movlw HIGH wake_up_from_sleep | |
288 movwf sub_a+1 ; power on if ambient pressure is greater threshold | |
0 | 289 SAFE_2BYTE_COPY amb_pressure, sub_b |
582 | 290 call subU16 ; Is (1160mbar - averaged(amb_pressure)) < 0 ? |
291 btfsc neg_flag ; Wake up from Sleep? | |
292 bra onesec_sleep1a ; Yes, skip button checks, wake up! | |
0 | 293 |
582 | 294 btfsc battery_gauge_available |
295 bra onesec_sleep1 ; No wake-up with cR hardware | |
296 btfsc vusb_in ; USB plugged in? | |
297 bra onesec_sleep1a ; Yes, skip button checks, wake up! | |
0 | 298 |
299 onesec_sleep1: | |
582 | 300 bcf onesecupdate ; all done. |
301 ; Check switches | |
0 | 302 btfsc switch_left |
582 | 303 bra onesec_sleep1a |
0 | 304 btfsc switch_right |
582 | 305 bra onesec_sleep1a |
306 | |
0 | 307 ; No button pressed |
582 | 308 ; bcf INTCON,INT0IF ; Clear flag |
309 ; bcf INTCON3,INT1IF ; Clear flag | |
310 | |
0 | 311 return |
312 | |
582 | 313 onesec_sleep1a: ; At least one button pressed or amb_pressure > wake_up_from_sleep |
314 ; bcf INTCON,INT0IF ; Clear flag | |
315 ; bcf INTCON3,INT1IF ; Clear flag | |
316 bcf sleepmode ; wake up! | |
0 | 317 SAFE_2BYTE_COPY last_surfpressure_30min, amb_pressure ; copy for compatibility |
318 movlw .0 | |
582 | 319 movff WREG,sensor_state_counter ; Reset sensor state counter |
320 bcf no_sensor_int ; normal sensor interrupt mode | |
0 | 321 return |
582 | 322 |
323 pressuretest_sleep_fast: ; Get pressure without averaging (Faster to save some power in sleep mode) | |
324 banksel isr_backup ; Back to Bank0 ISR data | |
325 clrf amb_pressure_avg+0 ; pressure average registers | |
326 clrf amb_pressure_avg+1 | |
327 clrf temperature_avg+0 | |
328 clrf temperature_avg+1 | |
329 call get_temperature_start ; and start temperature integration (73,5us) | |
330 banksel common | |
331 rcall sleepmode_sleep ; Wait at least 35ms (every 62,5ms Timer7 wakeup) | |
332 rcall sleepmode_sleep ; Wait at least 35ms (every 62,5ms Timer7 wakeup) | |
333 banksel isr_backup ; Back to Bank0 ISR data | |
334 call get_temperature_value ; State 1: Get temperature | |
335 call get_pressure_start ; Start pressure integration. | |
336 banksel common | |
337 rcall sleepmode_sleep ; Wait at least 35ms (every 62,5ms Timer7 wakeup) | |
338 rcall sleepmode_sleep ; Wait at least 35ms (every 62,5ms Timer7 wakeup) | |
339 banksel isr_backup ; Back to Bank0 ISR data | |
340 call get_pressure_value ; State2: Get pressure (51us) | |
341 call calculate_compensation ; calculate temperature compensated pressure (27us) | |
342 banksel common | |
343 SAFE_2BYTE_COPY amb_pressure_avg, amb_pressure ; copy for compatibility | |
0 | 344 return |
345 | |
346 sleepmode_sleep: | |
582 | 347 banksel 0xF16 ; Addresses, F16h through F5Fh, are also used by SFRs, but are not part of the Access RAM. |
348 clrf T7GCON ; Reset Timer7 Gate Control register | |
349 movlw b'10001101' ; 1:1 Prescaler -> 2seconds@32768Hz, not synced | |
350 movwf T7CON | |
0 | 351 sleep |
198
c511dc403d7e
(Slightly) reduce current consumption in Eco and sleep mode
heinrichsweikamp
parents:
134
diff
changeset
|
352 sleep |
582 | 353 clrf T7GCON ; Reset Timer7 Gate Control register |
354 movlw b'10001001' ; 1:1 Prescaler -> 2seconds@32768Hz, synced | |
355 movwf T7CON | |
356 banksel common ; Bank1 | |
0 | 357 return |
358 | |
359 END |