Mercurial > public > hwos_code

annotate src/sleepmode.asm @ 276:e4cb495aed3d

Find changesets by keywords (author, files, the commit message), revision number or hash, or revset expression.
Increase byte timeout in PC download mode, faster response to "Exit" in main menu
author heinrichsweikamp
date Tue, 12 May 2015 14:24:46 +0200
parents 653a3ab08062
children 4389fe9673b2
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
275
653a3ab08062 rename into hwOS
heinrichsweikamp
parents: 235
diff changeset
12 #include "hwos.inc" ; Mandatory header
0
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!
224
5a4801918be9 temporally disable "Copy disable flags from digital input" routine
heinrichsweikamp
parents: 205
diff changeset
35 call disable_ir_s8 ; IR/S8 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 btfss sleepmode ; wake up? (This bit will be set in other routines)
heinrichsweikamp
parents:
diff changeset
59 goto restart ; yes
heinrichsweikamp
parents:
diff changeset
60
heinrichsweikamp
parents:
diff changeset
61 rcall sleepmode_sleep ; Wait at least 35ms (every 62,5ms Timer7 wakeup)
heinrichsweikamp
parents:
diff changeset
62
heinrichsweikamp
parents:
diff changeset
63 ; Any button pressed in sleep?
heinrichsweikamp
parents:
diff changeset
64 btfsc switch_left
heinrichsweikamp
parents:
diff changeset
65 rcall onesec_sleep1a
heinrichsweikamp
parents:
diff changeset
66 btfsc switch_right
heinrichsweikamp
parents:
diff changeset
67 rcall onesec_sleep1a
heinrichsweikamp
parents:
diff changeset
68
heinrichsweikamp
parents:
diff changeset
69 btfss sleepmode ; wake up? (This bit will be set in other routines)
heinrichsweikamp
parents:
diff changeset
70 goto restart ; yes
heinrichsweikamp
parents:
diff changeset
71
heinrichsweikamp
parents:
diff changeset
72 bra sleeploop_loop ; do loop until someting happens
heinrichsweikamp
parents:
diff changeset
73
134
4574aed5cd4c Show clock in Apnea mode, minor layout changes in Apnea mode
heinrichsweikamp
parents: 133
diff changeset
74 onehour_sleep:
4574aed5cd4c Show clock in Apnea mode, minor layout changes in Apnea mode
heinrichsweikamp
parents: 133
diff changeset
75 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
76 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
77 bcf onehourupdate ; all done
4574aed5cd4c Show clock in Apnea mode, minor layout changes in Apnea mode
heinrichsweikamp
parents: 133
diff changeset
78 return
0
heinrichsweikamp
parents:
diff changeset
79
heinrichsweikamp
parents:
diff changeset
80 onemin_sleep:
198
c511dc403d7e (Slightly) reduce current consumption in Eco and sleep mode
heinrichsweikamp
parents: 134
diff changeset
81 btfsc onehourupdate ; one hour in sleep?
c511dc403d7e (Slightly) reduce current consumption in Eco and sleep mode
heinrichsweikamp
parents: 134
diff changeset
82 rcall onehour_sleep ; Yes
c511dc403d7e (Slightly) reduce current consumption in Eco and sleep mode
heinrichsweikamp
parents: 134
diff changeset
83
0
heinrichsweikamp
parents:
diff changeset
84 ;---- adjust airpressure compensation any 15 minutes
heinrichsweikamp
parents:
diff changeset
85 incf divemins+1,F ; counts to 14...
heinrichsweikamp
parents:
diff changeset
86 movlw d'14'
heinrichsweikamp
parents:
diff changeset
87 cpfsgt divemins+1
heinrichsweikamp
parents:
diff changeset
88 bra onemin_sleep2 ; 15 minutes not done!
heinrichsweikamp
parents:
diff changeset
89
heinrichsweikamp
parents:
diff changeset
90 ; Tasks every 15 minutes in sleep
heinrichsweikamp
parents:
diff changeset
91 clrf divemins+1 ; reset counter
heinrichsweikamp
parents:
diff changeset
92
heinrichsweikamp
parents:
diff changeset
93 call deco_calc_CNS_decrease_15min ; compute CNS decay in sleep only
heinrichsweikamp
parents:
diff changeset
94 banksel common
heinrichsweikamp
parents:
diff changeset
95
heinrichsweikamp
parents:
diff changeset
96 SAFE_2BYTE_COPY last_surfpressure_15min, last_surfpressure_30min ; save older airpressure
heinrichsweikamp
parents:
diff changeset
97 SAFE_2BYTE_COPY amb_pressure, last_surfpressure_15min ; save new airpressure
heinrichsweikamp
parents:
diff changeset
98
heinrichsweikamp
parents:
diff changeset
99 movlw LOW max_surfpressure
heinrichsweikamp
parents:
diff changeset
100 movff WREG,sub_a+0 ; max. "allowed" airpressure in mbar
heinrichsweikamp
parents:
diff changeset
101 movlw HIGH max_surfpressure
heinrichsweikamp
parents:
diff changeset
102 movff WREG,sub_a+1 ; max. "allowed" airpressure in mbar
heinrichsweikamp
parents:
diff changeset
103 movff last_surfpressure_15min+0,sub_b+0
heinrichsweikamp
parents:
diff changeset
104 movff last_surfpressure_15min+1,sub_b+1
heinrichsweikamp
parents:
diff changeset
105 call subU16 ; sub_c = sub_a - sub_b
heinrichsweikamp
parents:
diff changeset
106 btfss neg_flag ; Is 1080mbar < amb_pressure ?
heinrichsweikamp
parents:
diff changeset
107 bra onemin_sleep2 ; NO: current airpressure is lower then "allowed" airpressure, ok!
heinrichsweikamp
parents:
diff changeset
108
heinrichsweikamp
parents:
diff changeset
109 ; not ok! Overwrite with max. "allowed" airpressure
heinrichsweikamp
parents:
diff changeset
110 movlw LOW max_surfpressure
heinrichsweikamp
parents:
diff changeset
111 movff WREG,last_surfpressure_15min+0 ; max. "allowed" airpressure in mbar
heinrichsweikamp
parents:
diff changeset
112 movlw HIGH max_surfpressure
heinrichsweikamp
parents:
diff changeset
113 movff WREG,last_surfpressure_15min+1 ; max. "allowed" airpressure in mbar
heinrichsweikamp
parents:
diff changeset
114
heinrichsweikamp
parents:
diff changeset
115 onemin_sleep2:
heinrichsweikamp
parents:
diff changeset
116 ; Tasks every minute in sleep
heinrichsweikamp
parents:
diff changeset
117 SAFE_2BYTE_COPY amb_pressure, int_I_pres_respiration ; LOW copy pressure to deco routine
heinrichsweikamp
parents:
diff changeset
118 call deco_calc_wo_deco_step_1_min ; "calc_tissue_sleep"
heinrichsweikamp
parents:
diff changeset
119 banksel common
heinrichsweikamp
parents:
diff changeset
120
heinrichsweikamp
parents:
diff changeset
121 bcf oneminupdate ; all done
heinrichsweikamp
parents:
diff changeset
122 return
heinrichsweikamp
parents:
diff changeset
123
heinrichsweikamp
parents:
diff changeset
124 onesec_sleep:
198
c511dc403d7e (Slightly) reduce current consumption in Eco and sleep mode
heinrichsweikamp
parents: 134
diff changeset
125 btfsc oneminupdate ; one minute in sleep?
c511dc403d7e (Slightly) reduce current consumption in Eco and sleep mode
heinrichsweikamp
parents: 134
diff changeset
126 rcall onemin_sleep ; do oneminute tasks, e.g. calculate desaturation
c511dc403d7e (Slightly) reduce current consumption in Eco and sleep mode
heinrichsweikamp
parents: 134
diff changeset
127
235
23311219dacc under construction: new hardware_flag to configure different hardware versions
heinrichsweikamp
parents: 224
diff changeset
128 btfsc rechargeable
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
235
23311219dacc under construction: new hardware_flag to configure different hardware versions
heinrichsweikamp
parents: 224
diff changeset
148 btfsc rechargeable
200
dcd513840c6c cleanup
heinrichsweikamp
parents: 198
diff changeset
149 bra onesec_sleep1 ; No wake-up with cR 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 sleepmode ; wake up!
heinrichsweikamp
parents:
diff changeset
169 SAFE_2BYTE_COPY last_surfpressure_30min, amb_pressure ; copy for compatibility
heinrichsweikamp
parents:
diff changeset
170 movlw .0
heinrichsweikamp
parents:
diff changeset
171 movff WREG,sensor_state_counter ; Reset sensor state counter
heinrichsweikamp
parents:
diff changeset
172 bcf no_sensor_int ; normal sensor interrupt mode
heinrichsweikamp
parents:
diff changeset
173 return
heinrichsweikamp
parents:
diff changeset
174
heinrichsweikamp
parents:
diff changeset
175 pressuretest_sleep_fast: ; Get pressure without averaging (Faster to save some power in sleep mode)
heinrichsweikamp
parents:
diff changeset
176 banksel isr_backup ; Back to Bank0 ISR data
heinrichsweikamp
parents:
diff changeset
177 clrf amb_pressure_avg+0 ; pressure average registers
heinrichsweikamp
parents:
diff changeset
178 clrf amb_pressure_avg+1
heinrichsweikamp
parents:
diff changeset
179 clrf temperature_avg+0
heinrichsweikamp
parents:
diff changeset
180 clrf temperature_avg+1
heinrichsweikamp
parents:
diff changeset
181 call get_temperature_start ; and start temperature integration (73,5us)
heinrichsweikamp
parents:
diff changeset
182 banksel common
heinrichsweikamp
parents:
diff changeset
183 rcall sleepmode_sleep ; Wait at least 35ms (every 62,5ms Timer7 wakeup)
heinrichsweikamp
parents:
diff changeset
184 rcall sleepmode_sleep ; Wait at least 35ms (every 62,5ms Timer7 wakeup)
heinrichsweikamp
parents:
diff changeset
185 banksel isr_backup ; Back to Bank0 ISR data
heinrichsweikamp
parents:
diff changeset
186 call get_temperature_value ; State 1: Get temperature
heinrichsweikamp
parents:
diff changeset
187 call get_pressure_start ; Start pressure integration.
heinrichsweikamp
parents:
diff changeset
188 banksel common
heinrichsweikamp
parents:
diff changeset
189 rcall sleepmode_sleep ; Wait at least 35ms (every 62,5ms Timer7 wakeup)
heinrichsweikamp
parents:
diff changeset
190 rcall sleepmode_sleep ; Wait at least 35ms (every 62,5ms Timer7 wakeup)
50
ec4d8503ec45 NEW: user-selectable color schemes
heinrichsweikamp
parents: 39
diff changeset
191 bsf LEDg ; Show some activity
0
heinrichsweikamp
parents:
diff changeset
192 banksel isr_backup ; Back to Bank0 ISR data
heinrichsweikamp
parents:
diff changeset
193 call get_pressure_value ; State2: Get pressure (51us)
heinrichsweikamp
parents:
diff changeset
194 call calculate_compensation ; calculate temperature compensated pressure (27us)
heinrichsweikamp
parents:
diff changeset
195 banksel common
heinrichsweikamp
parents:
diff changeset
196 SAFE_2BYTE_COPY amb_pressure_avg, amb_pressure ; copy for compatibility
50
ec4d8503ec45 NEW: user-selectable color schemes
heinrichsweikamp
parents: 39
diff changeset
197 bcf LEDg
0
heinrichsweikamp
parents:
diff changeset
198 return
heinrichsweikamp
parents:
diff changeset
199
heinrichsweikamp
parents:
diff changeset
200 sleepmode_sleep:
heinrichsweikamp
parents:
diff changeset
201 banksel 0xF16 ; Addresses, F16h through F5Fh, are also used by SFRs, but are not part of the Access RAM.
heinrichsweikamp
parents:
diff changeset
202 clrf T7GCON ; Reset Timer7 Gate Control register
heinrichsweikamp
parents:
diff changeset
203 movlw b'10001101' ; 1:1 Prescaler -> 2seconds@32768Hz, not synced
heinrichsweikamp
parents:
diff changeset
204 movwf T7CON
heinrichsweikamp
parents:
diff changeset
205 sleep
198
c511dc403d7e (Slightly) reduce current consumption in Eco and sleep mode
heinrichsweikamp
parents: 134
diff changeset
206 sleep
0
heinrichsweikamp
parents:
diff changeset
207 clrf T7GCON ; Reset Timer7 Gate Control register
heinrichsweikamp
parents:
diff changeset
208 movlw b'10001001' ; 1:1 Prescaler -> 2seconds@32768Hz, synced
heinrichsweikamp
parents:
diff changeset
209 movwf T7CON
heinrichsweikamp
parents:
diff changeset
210 banksel common ; Bank1
heinrichsweikamp
parents:
diff changeset
211 return
heinrichsweikamp
parents:
diff changeset
212
heinrichsweikamp
parents:
diff changeset
213 END