Mercurial > public > hwos_code

annotate src/start.asm @ 204:93085f540746

Find changesets by keywords (author, files, the commit message), revision number or hash, or revset expression.
minor
author heinrichsweikamp
date Sun, 23 Nov 2014 22:33:41 +0100
parents dcd513840c6c
children f5d909e03f52
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 start.asm
heinrichsweikamp
parents:
diff changeset
4 ;
heinrichsweikamp
parents:
diff changeset
5 ; Startup subroutines
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-06 : [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 "ms5541.inc"
heinrichsweikamp
parents:
diff changeset
14 #include "isr.inc"
heinrichsweikamp
parents:
diff changeset
15 #include "shared_definitions.h" ; Mailbox from/to p2_deco.c
heinrichsweikamp
parents:
diff changeset
16 #include "eeprom_rs232.inc"
heinrichsweikamp
parents:
diff changeset
17 #include "math.inc"
heinrichsweikamp
parents:
diff changeset
18 #include "tft.inc"
heinrichsweikamp
parents:
diff changeset
19 #include "surfmode.inc"
heinrichsweikamp
parents:
diff changeset
20 #include "wait.inc"
heinrichsweikamp
parents:
diff changeset
21 #include "rtc.inc"
heinrichsweikamp
parents:
diff changeset
22 #include "external_flash.inc"
heinrichsweikamp
parents:
diff changeset
23 #include "convert.inc"
heinrichsweikamp
parents:
diff changeset
24 #include "strings.inc"
heinrichsweikamp
parents:
diff changeset
25 #include "tft_outputs.inc"
113
heinrichsweikamp
parents: 93
diff changeset
26 #include "adc_lightsensor.inc"
heinrichsweikamp
parents: 93
diff changeset
27 #include "i2c.inc"
0
heinrichsweikamp
parents:
diff changeset
28
heinrichsweikamp
parents:
diff changeset
29 extern init_ostc3
heinrichsweikamp
parents:
diff changeset
30 extern option_restore_all
heinrichsweikamp
parents:
diff changeset
31
heinrichsweikamp
parents:
diff changeset
32 ;=============================================================================
heinrichsweikamp
parents:
diff changeset
33 ; Reset vector: What to do on device wake-up and hard reset.
heinrichsweikamp
parents:
diff changeset
34 ;
heinrichsweikamp
parents:
diff changeset
35 reset_v code 0x00000
heinrichsweikamp
parents:
diff changeset
36 ; goto start
heinrichsweikamp
parents:
diff changeset
37 goto 0x1FF00 ; Bootloader
heinrichsweikamp
parents:
diff changeset
38
heinrichsweikamp
parents:
diff changeset
39 ORG 0x00004 ; Needed for second-level bootloader
heinrichsweikamp
parents:
diff changeset
40 goto start
heinrichsweikamp
parents:
diff changeset
41 ;=============================================================================
heinrichsweikamp
parents:
diff changeset
42 boot CODE
heinrichsweikamp
parents:
diff changeset
43 global start
heinrichsweikamp
parents:
diff changeset
44
heinrichsweikamp
parents:
diff changeset
45 start:
heinrichsweikamp
parents:
diff changeset
46 lfsr FSR0,0x000 ; Clear rambank 0-14
heinrichsweikamp
parents:
diff changeset
47 clear_rambank:
heinrichsweikamp
parents:
diff changeset
48 clrf POSTINC0
heinrichsweikamp
parents:
diff changeset
49 movlw 0x0F
heinrichsweikamp
parents:
diff changeset
50 cpfseq FSR0H ; Bank 14 done?
heinrichsweikamp
parents:
diff changeset
51 bra clear_rambank ; clear...
heinrichsweikamp
parents:
diff changeset
52
heinrichsweikamp
parents:
diff changeset
53 call init_ostc3
heinrichsweikamp
parents:
diff changeset
54 bsf no_sensor_int ; disable sensor interrupt
heinrichsweikamp
parents:
diff changeset
55
heinrichsweikamp
parents:
diff changeset
56 ; Air pressure compensation after reset
heinrichsweikamp
parents:
diff changeset
57 call get_calibration_data ; Get calibration data from pressure sensor
heinrichsweikamp
parents:
diff changeset
58 banksel common ; get_calibration_data uses isr_backup
heinrichsweikamp
parents:
diff changeset
59 bcf no_sensor_int ; normal sensor interrupt mode
heinrichsweikamp
parents:
diff changeset
60
113
heinrichsweikamp
parents: 93
diff changeset
61 call piezo_config
10
55dfc8f6093f sensor status on power-on reset
heinrichsweikamp
parents: 0
diff changeset
62 call TFT_DisplayOff ; display off
55dfc8f6093f sensor status on power-on reset
heinrichsweikamp
parents: 0
diff changeset
63 bsf LEDr ; Status LED
0
heinrichsweikamp
parents:
diff changeset
64 bcf pressure_refresh
heinrichsweikamp
parents:
diff changeset
65 ; First pass will not have valid temperature!
heinrichsweikamp
parents:
diff changeset
66 btfss pressure_refresh ; Air pressure compensation
heinrichsweikamp
parents:
diff changeset
67 bra $-2
50
ec4d8503ec45 NEW: user-selectable color schemes
heinrichsweikamp
parents: 45
diff changeset
68 bcf LEDr
0
heinrichsweikamp
parents:
diff changeset
69 ; Second pass
heinrichsweikamp
parents:
diff changeset
70 bcf pressure_refresh
heinrichsweikamp
parents:
diff changeset
71 btfss pressure_refresh ; Air pressure compensation
heinrichsweikamp
parents:
diff changeset
72 bra $-2
heinrichsweikamp
parents:
diff changeset
73
heinrichsweikamp
parents:
diff changeset
74 clrf rel_pressure+0
heinrichsweikamp
parents:
diff changeset
75 clrf rel_pressure+1
heinrichsweikamp
parents:
diff changeset
76 clrf surface_interval+0
heinrichsweikamp
parents:
diff changeset
77 clrf surface_interval+1
heinrichsweikamp
parents:
diff changeset
78
heinrichsweikamp
parents:
diff changeset
79 SAFE_2BYTE_COPY amb_pressure, last_surfpressure
heinrichsweikamp
parents:
diff changeset
80
heinrichsweikamp
parents:
diff changeset
81 movlw LOW max_surfpressure
heinrichsweikamp
parents:
diff changeset
82 movff WREG,sub_a+0 ; max. "allowed" airpressure in mbar
heinrichsweikamp
parents:
diff changeset
83 movlw HIGH max_surfpressure
heinrichsweikamp
parents:
diff changeset
84 movff WREG,sub_a+1 ; max. "allowed" airpressure in mbar
heinrichsweikamp
parents:
diff changeset
85 movff last_surfpressure+0,sub_b+0
heinrichsweikamp
parents:
diff changeset
86 movff last_surfpressure+1,sub_b+1
heinrichsweikamp
parents:
diff changeset
87 call subU16 ; sub_c = sub_a - sub_b
heinrichsweikamp
parents:
diff changeset
88 btfss neg_flag ; Is 1080mbar < amb_pressure ?
heinrichsweikamp
parents:
diff changeset
89 bra start_copy_pressure ; NO: current airpressure is lower then "allowed" airpressure, ok!
heinrichsweikamp
parents:
diff changeset
90
heinrichsweikamp
parents:
diff changeset
91 ; not ok! Overwrite with max. "allowed" airpressure
heinrichsweikamp
parents:
diff changeset
92 movlw LOW max_surfpressure
heinrichsweikamp
parents:
diff changeset
93 movff WREG,last_surfpressure+0 ; max. "allowed" airpressure in mbar
heinrichsweikamp
parents:
diff changeset
94 movlw HIGH max_surfpressure
heinrichsweikamp
parents:
diff changeset
95 movff WREG,last_surfpressure+1 ; max. "allowed" airpressure in mbar
heinrichsweikamp
parents:
diff changeset
96
heinrichsweikamp
parents:
diff changeset
97 start_copy_pressure:
heinrichsweikamp
parents:
diff changeset
98 movff last_surfpressure+0,last_surfpressure_15min+0
heinrichsweikamp
parents:
diff changeset
99 movff last_surfpressure+1,last_surfpressure_15min+1
heinrichsweikamp
parents:
diff changeset
100 movff last_surfpressure+0,last_surfpressure_30min+0
heinrichsweikamp
parents:
diff changeset
101 movff last_surfpressure+1,last_surfpressure_30min+1 ; Rests all airpressure registers
heinrichsweikamp
parents:
diff changeset
102
heinrichsweikamp
parents:
diff changeset
103 ; reset deco data for surface mode
heinrichsweikamp
parents:
diff changeset
104 movlw d'79'
heinrichsweikamp
parents:
diff changeset
105 movff WREG,char_I_N2_ratio ; 79% N2
heinrichsweikamp
parents:
diff changeset
106 SAFE_2BYTE_COPY amb_pressure,int_I_pres_respiration ; copy for deco routine
heinrichsweikamp
parents:
diff changeset
107 movff int_I_pres_respiration+0,int_I_pres_surface+0 ; copy for desat routine
heinrichsweikamp
parents:
diff changeset
108 movff int_I_pres_respiration+1,int_I_pres_surface+1
heinrichsweikamp
parents:
diff changeset
109
heinrichsweikamp
parents:
diff changeset
110 extern deco_reset
heinrichsweikamp
parents:
diff changeset
111 call deco_reset
heinrichsweikamp
parents:
diff changeset
112 clrf nofly_time+0 ; Reset NoFly
heinrichsweikamp
parents:
diff changeset
113 clrf nofly_time+1
heinrichsweikamp
parents:
diff changeset
114 clrf desaturation_time+0 ; Reset Desat
heinrichsweikamp
parents:
diff changeset
115 clrf desaturation_time+1
133
939f1e83c4c2 BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents: 113
diff changeset
116
939f1e83c4c2 BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents: 113
diff changeset
117 call rtc_init ; init clock
939f1e83c4c2 BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents: 113
diff changeset
118
939f1e83c4c2 BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents: 113
diff changeset
119 movlw HIGH .512 ; =2
939f1e83c4c2 BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents: 113
diff changeset
120 movwf EEADRH
939f1e83c4c2 BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents: 113
diff changeset
121 read_int_eeprom .0
939f1e83c4c2 BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents: 113
diff changeset
122 clrf EEADRH
939f1e83c4c2 BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents: 113
diff changeset
123 movlw 0xAA
939f1e83c4c2 BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents: 113
diff changeset
124 cpfseq EEDATA ; =0xAA
939f1e83c4c2 BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents: 113
diff changeset
125 bra no_deco_restore ; No
939f1e83c4c2 BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents: 113
diff changeset
126
939f1e83c4c2 BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents: 113
diff changeset
127 extern restore_decodata_from_eeprom
939f1e83c4c2 BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents: 113
diff changeset
128 call restore_decodata_from_eeprom ; Reload deco data and date/time from eeprom
939f1e83c4c2 BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents: 113
diff changeset
129
939f1e83c4c2 BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents: 113
diff changeset
130 no_deco_restore:
939f1e83c4c2 BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents: 113
diff changeset
131 call deco_calc_desaturation_time ; calculate desaturation time
939f1e83c4c2 BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents: 113
diff changeset
132 banksel common
939f1e83c4c2 BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents: 113
diff changeset
133 call deco_calc_wo_deco_step_1_min ; calculate deco in surface mode
939f1e83c4c2 BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents: 113
diff changeset
134 banksel common
0
heinrichsweikamp
parents:
diff changeset
135 bcf menubit ; clear menu flag
heinrichsweikamp
parents:
diff changeset
136 ; Check for Power-on reset here
heinrichsweikamp
parents:
diff changeset
137 extern new_battery_menu
heinrichsweikamp
parents:
diff changeset
138 extern use_old_batteries
heinrichsweikamp
parents:
diff changeset
139
heinrichsweikamp
parents:
diff changeset
140 btfsc RCON,POR ; Was this a power-on reset?
heinrichsweikamp
parents:
diff changeset
141 goto use_old_batteries ; No, load last stored battery values
heinrichsweikamp
parents:
diff changeset
142 ; "new_battery_menu" and "use_old_batteries" 'goto' back to "power_on_return"
heinrichsweikamp
parents:
diff changeset
143
heinrichsweikamp
parents:
diff changeset
144 ; Yes
heinrichsweikamp
parents:
diff changeset
145 goto new_battery_menu ; show "New battery dialog"
heinrichsweikamp
parents:
diff changeset
146 ; "new_battery_menu" and "use_old_batteries" 'goto' back to "power_on_return"
heinrichsweikamp
parents:
diff changeset
147
heinrichsweikamp
parents:
diff changeset
148 global power_on_return
heinrichsweikamp
parents:
diff changeset
149 power_on_return:
heinrichsweikamp
parents:
diff changeset
150 bsf RCON,POR ; Set bit for next detection
heinrichsweikamp
parents:
diff changeset
151
heinrichsweikamp
parents:
diff changeset
152 ; check firmware and reset Custom Functions after an update
heinrichsweikamp
parents:
diff changeset
153 movlw d'1'
heinrichsweikamp
parents:
diff changeset
154 movwf EEADR
heinrichsweikamp
parents:
diff changeset
155 movlw d'1'
heinrichsweikamp
parents:
diff changeset
156 movwf EEADRH
heinrichsweikamp
parents:
diff changeset
157 call read_eeprom ; read current version x
heinrichsweikamp
parents:
diff changeset
158 movff EEDATA,temp1
heinrichsweikamp
parents:
diff changeset
159 incf EEADR,F ; set to 0x102
heinrichsweikamp
parents:
diff changeset
160 call read_eeprom ; read current version y
heinrichsweikamp
parents:
diff changeset
161 movff EEDATA,temp2
heinrichsweikamp
parents:
diff changeset
162 clrf EEADRH ; Reset EEADRH
heinrichsweikamp
parents:
diff changeset
163
heinrichsweikamp
parents:
diff changeset
164 movlw softwareversion_x
heinrichsweikamp
parents:
diff changeset
165 cpfseq temp1 ; compare version x
heinrichsweikamp
parents:
diff changeset
166 bra check_firmware_new ; is not equal -> reset CF and store new version in EEPROM
heinrichsweikamp
parents:
diff changeset
167
heinrichsweikamp
parents:
diff changeset
168 movlw softwareversion_y
heinrichsweikamp
parents:
diff changeset
169 cpfseq temp2 ; compare version y
heinrichsweikamp
parents:
diff changeset
170 bra check_firmware_new ; is not equal -> reset CF and store new version in EEPROM
heinrichsweikamp
parents:
diff changeset
171 bra restart ; x and y are equal -> do not reset cf
heinrichsweikamp
parents:
diff changeset
172
heinrichsweikamp
parents:
diff changeset
173 check_firmware_new:
heinrichsweikamp
parents:
diff changeset
174 call TFT_boot ; Initialize TFT (includes clear screen)
heinrichsweikamp
parents:
diff changeset
175 clrf CCPR1L ; Backlight off
heinrichsweikamp
parents:
diff changeset
176 WIN_TOP .50
heinrichsweikamp
parents:
diff changeset
177 WIN_LEFT .10
heinrichsweikamp
parents:
diff changeset
178 movlw LOW 0x1E000
heinrichsweikamp
parents:
diff changeset
179 movwf TBLPTRL
heinrichsweikamp
parents:
diff changeset
180 movlw HIGH 0x1E000
heinrichsweikamp
parents:
diff changeset
181 movwf TBLPTRH
heinrichsweikamp
parents:
diff changeset
182 movlw UPPER 0x1E000
heinrichsweikamp
parents:
diff changeset
183 movwf TBLPTRU
heinrichsweikamp
parents:
diff changeset
184 extern color_image
heinrichsweikamp
parents:
diff changeset
185 call color_image ; Show logo
heinrichsweikamp
parents:
diff changeset
186 call TFT_standard_color
heinrichsweikamp
parents:
diff changeset
187 WIN_SMALL .10,.100
52
0fae975af741 english correction
heinrichsweikamp
parents: 50
diff changeset
188 STRCPY_TEXT_PRINT tNewFirmware1 ; "Update successfull!"
0
heinrichsweikamp
parents:
diff changeset
189 WIN_SMALL .10,.140
heinrichsweikamp
parents:
diff changeset
190 STRCPY_TEXT tNewFirmware2 ; "New Firmware: "
heinrichsweikamp
parents:
diff changeset
191 movlw softwareversion_x
heinrichsweikamp
parents:
diff changeset
192 movwf lo
heinrichsweikamp
parents:
diff changeset
193 bsf leftbind
heinrichsweikamp
parents:
diff changeset
194 output_8
heinrichsweikamp
parents:
diff changeset
195 PUTC "."
heinrichsweikamp
parents:
diff changeset
196 movlw softwareversion_y
heinrichsweikamp
parents:
diff changeset
197 movwf lo
45
76dfe320e6ec 1.01 beta start
heinrichsweikamp
parents: 24
diff changeset
198 output_99x
0
heinrichsweikamp
parents:
diff changeset
199 bcf leftbind
heinrichsweikamp
parents:
diff changeset
200 STRCAT_PRINT "" ; Print second row
heinrichsweikamp
parents:
diff changeset
201 call TFT_Display_FadeIn ; Display resulting surface screen.
heinrichsweikamp
parents:
diff changeset
202
heinrichsweikamp
parents:
diff changeset
203 ; place "after-update reset" here...
93
5e1ef9bf32ec clear pressure sensor compensation upon update
heinrichsweikamp
parents: 52
diff changeset
204
5e1ef9bf32ec clear pressure sensor compensation upon update
heinrichsweikamp
parents: 52
diff changeset
205 extern oPressureAdjust, option_reset, option_save
5e1ef9bf32ec clear pressure sensor compensation upon update
heinrichsweikamp
parents: 52
diff changeset
206 lfsr FSR0,oPressureAdjust
5e1ef9bf32ec clear pressure sensor compensation upon update
heinrichsweikamp
parents: 52
diff changeset
207 call option_reset ; Reset FSR0 option to factory default.
5e1ef9bf32ec clear pressure sensor compensation upon update
heinrichsweikamp
parents: 52
diff changeset
208 lfsr FSR0,oPressureAdjust
5e1ef9bf32ec clear pressure sensor compensation upon update
heinrichsweikamp
parents: 52
diff changeset
209 call option_save ; Save in EEPROM
5e1ef9bf32ec clear pressure sensor compensation upon update
heinrichsweikamp
parents: 52
diff changeset
210
0
heinrichsweikamp
parents:
diff changeset
211 movlw d'1' ; store current version in EEPROM
heinrichsweikamp
parents:
diff changeset
212 movwf EEADR
heinrichsweikamp
parents:
diff changeset
213 movlw d'1'
heinrichsweikamp
parents:
diff changeset
214 movwf EEADRH
heinrichsweikamp
parents:
diff changeset
215 movlw softwareversion_x
heinrichsweikamp
parents:
diff changeset
216 movwf EEDATA
heinrichsweikamp
parents:
diff changeset
217 call write_eeprom ; write version x
heinrichsweikamp
parents:
diff changeset
218 incf EEADR,F ; set to 0x102
heinrichsweikamp
parents:
diff changeset
219 movlw softwareversion_y
heinrichsweikamp
parents:
diff changeset
220 movwf EEDATA
heinrichsweikamp
parents:
diff changeset
221 call write_eeprom ; write version y
heinrichsweikamp
parents:
diff changeset
222 clrf EEADRH ; Reset EEADRH
heinrichsweikamp
parents:
diff changeset
223
heinrichsweikamp
parents:
diff changeset
224 movlw .7
heinrichsweikamp
parents:
diff changeset
225 movwf lo
heinrichsweikamp
parents:
diff changeset
226 check_firmware_new2:
heinrichsweikamp
parents:
diff changeset
227 ; Wait 1 second
heinrichsweikamp
parents:
diff changeset
228 bcf onesecupdate
heinrichsweikamp
parents:
diff changeset
229 btfss onesecupdate
heinrichsweikamp
parents:
diff changeset
230 bra $-2
heinrichsweikamp
parents:
diff changeset
231 decfsz lo,F ; Wait 10 seconds...
heinrichsweikamp
parents:
diff changeset
232 bra check_firmware_new2
heinrichsweikamp
parents:
diff changeset
233
heinrichsweikamp
parents:
diff changeset
234 global restart
heinrichsweikamp
parents:
diff changeset
235 restart:
heinrichsweikamp
parents:
diff changeset
236 clrf STKPTR ; Never return from here
21
79b2084fd75a Reset options to default if they are not within the allowed min/max values
heinrichsweikamp
parents: 16
diff changeset
237 extern option_save_all, option_check_all
79b2084fd75a Reset options to default if they are not within the allowed min/max values
heinrichsweikamp
parents: 16
diff changeset
238
0
heinrichsweikamp
parents:
diff changeset
239 btfsc menubit ; Return from Menu/COMM mode or timeout?
heinrichsweikamp
parents:
diff changeset
240 call option_save_all ; Yes, save all settings into EEPROM
heinrichsweikamp
parents:
diff changeset
241
23
e402813343b6 new option to switch samplingrate between 10s and 2s
heinrichsweikamp
parents: 21
diff changeset
242 call option_check_all ; Check all options (and reset if not within their min/max boundaries)
e402813343b6 new option to switch samplingrate between 10s and 2s
heinrichsweikamp
parents: 21
diff changeset
243
0
heinrichsweikamp
parents:
diff changeset
244 clrf flag1 ; clear all flags
heinrichsweikamp
parents:
diff changeset
245 clrf flag2
heinrichsweikamp
parents:
diff changeset
246 clrf flag3
heinrichsweikamp
parents:
diff changeset
247 clrf flag4
heinrichsweikamp
parents:
diff changeset
248 clrf flag5
heinrichsweikamp
parents:
diff changeset
249 clrf flag6
heinrichsweikamp
parents:
diff changeset
250 clrf flag7
heinrichsweikamp
parents:
diff changeset
251 clrf flag8
16
7b06f20881be calm compass reading for minor heading changes
heinrichsweikamp
parents: 10
diff changeset
252 clrf flag9
113
heinrichsweikamp
parents: 93
diff changeset
253 clrf flag10
0
heinrichsweikamp
parents:
diff changeset
254 bsf tft_is_dimming ; TFT is dimming up (soon), ignore ambient sensor!
23
e402813343b6 new option to switch samplingrate between 10s and 2s
heinrichsweikamp
parents: 21
diff changeset
255
113
heinrichsweikamp
parents: 93
diff changeset
256 call lt2942_get_status ; Check for gauge IC
200
dcd513840c6c cleanup
heinrichsweikamp
parents: 187
diff changeset
257 btfsc cr_hardware ; cR hardware?
113
heinrichsweikamp
parents: 93
diff changeset
258 call lt2942_init ; Yes, init battery gauge IC
heinrichsweikamp
parents: 93
diff changeset
259
0
heinrichsweikamp
parents:
diff changeset
260 ; Select high altitude (Fly) mode?
heinrichsweikamp
parents:
diff changeset
261 movff last_surfpressure_30min+0,sub_b+0
heinrichsweikamp
parents:
diff changeset
262 movff last_surfpressure_30min+1,sub_b+1
heinrichsweikamp
parents:
diff changeset
263 movlw HIGH high_altitude_threshold
heinrichsweikamp
parents:
diff changeset
264 movwf sub_a+1
heinrichsweikamp
parents:
diff changeset
265 movlw LOW high_altitude_threshold ; Hard-wired 880mbar
heinrichsweikamp
parents:
diff changeset
266 movwf sub_a+0
heinrichsweikamp
parents:
diff changeset
267 call subU16 ; sub_c = sub_a - sub_b
heinrichsweikamp
parents:
diff changeset
268 btfss neg_flag ; Result negative (Ambient>880mbar)?
heinrichsweikamp
parents:
diff changeset
269 bsf high_altitude_mode ; No, Set Flag!
heinrichsweikamp
parents:
diff changeset
270
200
dcd513840c6c cleanup
heinrichsweikamp
parents: 187
diff changeset
271 btfss cr_hardware
165
9b82239fa062 testing consumption
heinrichsweikamp
parents: 155
diff changeset
272 bsf TRISB,3
200
dcd513840c6c cleanup
heinrichsweikamp
parents: 187
diff changeset
273 btfss cr_hardware
165
9b82239fa062 testing consumption
heinrichsweikamp
parents: 155
diff changeset
274 bsf TRISG,0
0
heinrichsweikamp
parents:
diff changeset
275 call ext_flash_disable_protection ; Disable write protection for external flash
heinrichsweikamp
parents:
diff changeset
276
155
5f71e31bd5b3 CHANGE: Re-arranged Settings Menu, add 180? rotate to menu
heinrichsweikamp
parents: 154
diff changeset
277 bsf flip_screen ; Flip 180°
5f71e31bd5b3 CHANGE: Re-arranged Settings Menu, add 180? rotate to menu
heinrichsweikamp
parents: 154
diff changeset
278 TSTOSS opt_flip_screen ; =1: Flip the screen
5f71e31bd5b3 CHANGE: Re-arranged Settings Menu, add 180? rotate to menu
heinrichsweikamp
parents: 154
diff changeset
279 bcf flip_screen ; Normal orientation
151
5cb177f0948a work on flip screen...
heinrichsweikamp
parents: 147
diff changeset
280
0
heinrichsweikamp
parents:
diff changeset
281 goto surfloop ; Jump to Surfaceloop!
heinrichsweikamp
parents:
diff changeset
282
heinrichsweikamp
parents:
diff changeset
283 ;=============================================================================
heinrichsweikamp
parents:
diff changeset
284 ; Setup all flags and parameters for divemode and simulator computations.
heinrichsweikamp
parents:
diff changeset
285 ;
heinrichsweikamp
parents:
diff changeset
286 global restart_set_modes_and_flags
heinrichsweikamp
parents:
diff changeset
287 restart_set_modes_and_flags: ; "Call"ed from divemode, as well!
heinrichsweikamp
parents:
diff changeset
288 call option_restore_all ; Restore everything from EEPROM
24
f51caad821b4 save logbook recording interval
heinrichsweikamp
parents: 23
diff changeset
289
f51caad821b4 save logbook recording interval
heinrichsweikamp
parents: 23
diff changeset
290 ; Setup sampling rate
f51caad821b4 save logbook recording interval
heinrichsweikamp
parents: 23
diff changeset
291 movlw .2
f51caad821b4 save logbook recording interval
heinrichsweikamp
parents: 23
diff changeset
292 movwf samplingrate
f51caad821b4 save logbook recording interval
heinrichsweikamp
parents: 23
diff changeset
293 TSTOSS opt_sampling_rate ; =1: 10s, =0: 2s
f51caad821b4 save logbook recording interval
heinrichsweikamp
parents: 23
diff changeset
294 bra restart_set_modes_and_flags1
f51caad821b4 save logbook recording interval
heinrichsweikamp
parents: 23
diff changeset
295 movlw .10
f51caad821b4 save logbook recording interval
heinrichsweikamp
parents: 23
diff changeset
296 movwf samplingrate
f51caad821b4 save logbook recording interval
heinrichsweikamp
parents: 23
diff changeset
297 restart_set_modes_and_flags1:
0
heinrichsweikamp
parents:
diff changeset
298 movff opt_dive_mode,lo ; 0=OC, 1=CC, 2=Gauge, 3=Apnea
heinrichsweikamp
parents:
diff changeset
299
heinrichsweikamp
parents:
diff changeset
300 bcf FLAG_apnoe_mode
heinrichsweikamp
parents:
diff changeset
301 bcf FLAG_ccr_mode ; =1: CCR mode (Fixed ppO2 or Sensor) active
heinrichsweikamp
parents:
diff changeset
302 bcf FLAG_gauge_mode ; =1: In Gauge mode
heinrichsweikamp
parents:
diff changeset
303 call disable_ir ; IR off
heinrichsweikamp
parents:
diff changeset
304
heinrichsweikamp
parents:
diff changeset
305 tstfsz lo
heinrichsweikamp
parents:
diff changeset
306 bra restart_set_modes_and_flags2
heinrichsweikamp
parents:
diff changeset
307 ; OC Mode
heinrichsweikamp
parents:
diff changeset
308 return
heinrichsweikamp
parents:
diff changeset
309
heinrichsweikamp
parents:
diff changeset
310 restart_set_modes_and_flags2:
heinrichsweikamp
parents:
diff changeset
311 decfsz lo,F
heinrichsweikamp
parents:
diff changeset
312 bra restart_set_modes_and_flags3
heinrichsweikamp
parents:
diff changeset
313 ; CC Mode
heinrichsweikamp
parents:
diff changeset
314 bsf FLAG_ccr_mode ; =1: CCR mode (Fixed ppO2 or Sensor) active
187
669b5d00706d CHANGE: Longer timeout (4 min) for calibration menu
heinrichsweikamp
parents: 165
diff changeset
315 call enable_ir_s8 ; Enable IR/S8-Port
0
heinrichsweikamp
parents:
diff changeset
316 return
heinrichsweikamp
parents:
diff changeset
317
heinrichsweikamp
parents:
diff changeset
318 restart_set_modes_and_flags3:
heinrichsweikamp
parents:
diff changeset
319 decfsz lo,F
heinrichsweikamp
parents:
diff changeset
320 bra restart_set_modes_and_flags4
heinrichsweikamp
parents:
diff changeset
321 ; Gauge Mode
heinrichsweikamp
parents:
diff changeset
322 bsf FLAG_gauge_mode ; =1: In Gauge mode
heinrichsweikamp
parents:
diff changeset
323 return
heinrichsweikamp
parents:
diff changeset
324
heinrichsweikamp
parents:
diff changeset
325 restart_set_modes_and_flags4:
heinrichsweikamp
parents:
diff changeset
326 ; Apnea Mode
heinrichsweikamp
parents:
diff changeset
327 bsf FLAG_apnoe_mode
heinrichsweikamp
parents:
diff changeset
328 return ; start in Surfacemode
heinrichsweikamp
parents:
diff changeset
329
heinrichsweikamp
parents:
diff changeset
330 END