Mercurial > public > hwos_code

annotate src/start.asm @ 474:2880aa1264f5

Find changesets by keywords (author, files, the commit message), revision number or hash, or revset expression.
Fix new battery menu on Power-on reset
author heinrichsweikamp
date Wed, 04 Jan 2017 15:04:42 +0100
parents 4fdf6886004b
children 237afdfb4918
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
275
653a3ab08062 rename into hwOS
heinrichsweikamp
parents: 267
diff changeset
12 #include "hwos.inc" ; Mandatory header
0
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
275
653a3ab08062 rename into hwOS
heinrichsweikamp
parents: 267
diff changeset
29 extern init_ostc
0
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
275
653a3ab08062 rename into hwOS
heinrichsweikamp
parents: 267
diff changeset
53 call init_ostc
0
heinrichsweikamp
parents:
diff changeset
54
449
heinrichsweikamp
parents: 446
diff changeset
55 ; Get button type from Bootloader-Info
474
2880aa1264f5 Fix new battery menu on Power-on reset
heinrichsweikamp
parents: 472
diff changeset
56 movlw .16
2880aa1264f5 Fix new battery menu on Power-on reset
heinrichsweikamp
parents: 472
diff changeset
57 movff WREG,analog_counter ; init averaging
449
heinrichsweikamp
parents: 446
diff changeset
58 bsf analog_switches
heinrichsweikamp
parents: 446
diff changeset
59 movlw 0x7C
heinrichsweikamp
parents: 446
diff changeset
60 movwf TBLPTRL
heinrichsweikamp
parents: 446
diff changeset
61 movlw 0xF7
heinrichsweikamp
parents: 446
diff changeset
62 movwf TBLPTRH
heinrichsweikamp
parents: 446
diff changeset
63 movlw 0x01
heinrichsweikamp
parents: 446
diff changeset
64 movwf TBLPTRU
heinrichsweikamp
parents: 446
diff changeset
65 TBLRD*+ ; Reads 0x07 for analog buttons
heinrichsweikamp
parents: 446
diff changeset
66 movlw 0x07
heinrichsweikamp
parents: 446
diff changeset
67 cpfseq TABLAT
heinrichsweikamp
parents: 446
diff changeset
68 bcf analog_switches
heinrichsweikamp
parents: 446
diff changeset
69
0
heinrichsweikamp
parents:
diff changeset
70 ; Air pressure compensation after reset
heinrichsweikamp
parents:
diff changeset
71 call get_calibration_data ; Get calibration data from pressure sensor
heinrichsweikamp
parents:
diff changeset
72 banksel common ; get_calibration_data uses isr_backup
heinrichsweikamp
parents:
diff changeset
73
463
2c58631d5229 minor cleanups
heinrichsweikamp
parents: 457
diff changeset
74 call TFT_DisplayOff ; display off
2c58631d5229 minor cleanups
heinrichsweikamp
parents: 457
diff changeset
75 bsf LEDr ; Status LED
2c58631d5229 minor cleanups
heinrichsweikamp
parents: 457
diff changeset
76 bcf pressure_refresh
0
heinrichsweikamp
parents:
diff changeset
77 ; First pass will not have valid temperature!
heinrichsweikamp
parents:
diff changeset
78 btfss pressure_refresh ; Air pressure compensation
heinrichsweikamp
parents:
diff changeset
79 bra $-2
441
360acdcda0d7 +BUGFIX: Compatibility with "hwOS Config" fixed
heinrichsweikamp
parents: 429
diff changeset
80 ; Second pass
0
heinrichsweikamp
parents:
diff changeset
81 bcf pressure_refresh
heinrichsweikamp
parents:
diff changeset
82 btfss pressure_refresh ; Air pressure compensation
heinrichsweikamp
parents:
diff changeset
83 bra $-2
441
360acdcda0d7 +BUGFIX: Compatibility with "hwOS Config" fixed
heinrichsweikamp
parents: 429
diff changeset
84 bcf LEDr
360acdcda0d7 +BUGFIX: Compatibility with "hwOS Config" fixed
heinrichsweikamp
parents: 429
diff changeset
85
0
heinrichsweikamp
parents:
diff changeset
86 clrf rel_pressure+0
heinrichsweikamp
parents:
diff changeset
87 clrf rel_pressure+1
heinrichsweikamp
parents:
diff changeset
88 clrf surface_interval+0
heinrichsweikamp
parents:
diff changeset
89 clrf surface_interval+1
heinrichsweikamp
parents:
diff changeset
90
heinrichsweikamp
parents:
diff changeset
91 SAFE_2BYTE_COPY amb_pressure, last_surfpressure
heinrichsweikamp
parents:
diff changeset
92
heinrichsweikamp
parents:
diff changeset
93 movlw LOW max_surfpressure
heinrichsweikamp
parents:
diff changeset
94 movff WREG,sub_a+0 ; max. "allowed" airpressure in mbar
heinrichsweikamp
parents:
diff changeset
95 movlw HIGH max_surfpressure
heinrichsweikamp
parents:
diff changeset
96 movff WREG,sub_a+1 ; max. "allowed" airpressure in mbar
heinrichsweikamp
parents:
diff changeset
97 movff last_surfpressure+0,sub_b+0
heinrichsweikamp
parents:
diff changeset
98 movff last_surfpressure+1,sub_b+1
heinrichsweikamp
parents:
diff changeset
99 call subU16 ; sub_c = sub_a - sub_b
heinrichsweikamp
parents:
diff changeset
100 btfss neg_flag ; Is 1080mbar < amb_pressure ?
heinrichsweikamp
parents:
diff changeset
101 bra start_copy_pressure ; NO: current airpressure is lower then "allowed" airpressure, ok!
heinrichsweikamp
parents:
diff changeset
102
heinrichsweikamp
parents:
diff changeset
103 ; not ok! Overwrite with max. "allowed" airpressure
heinrichsweikamp
parents:
diff changeset
104 movlw LOW max_surfpressure
heinrichsweikamp
parents:
diff changeset
105 movff WREG,last_surfpressure+0 ; max. "allowed" airpressure in mbar
heinrichsweikamp
parents:
diff changeset
106 movlw HIGH max_surfpressure
heinrichsweikamp
parents:
diff changeset
107 movff WREG,last_surfpressure+1 ; max. "allowed" airpressure in mbar
heinrichsweikamp
parents:
diff changeset
108
heinrichsweikamp
parents:
diff changeset
109 start_copy_pressure:
heinrichsweikamp
parents:
diff changeset
110 movff last_surfpressure+0,last_surfpressure_15min+0
heinrichsweikamp
parents:
diff changeset
111 movff last_surfpressure+1,last_surfpressure_15min+1
heinrichsweikamp
parents:
diff changeset
112 movff last_surfpressure+0,last_surfpressure_30min+0
heinrichsweikamp
parents:
diff changeset
113 movff last_surfpressure+1,last_surfpressure_30min+1 ; Rests all airpressure registers
heinrichsweikamp
parents:
diff changeset
114
heinrichsweikamp
parents:
diff changeset
115 ; reset deco data for surface mode
heinrichsweikamp
parents:
diff changeset
116 movlw d'79'
heinrichsweikamp
parents:
diff changeset
117 movff WREG,char_I_N2_ratio ; 79% N2
heinrichsweikamp
parents:
diff changeset
118 SAFE_2BYTE_COPY amb_pressure,int_I_pres_respiration ; copy for deco routine
heinrichsweikamp
parents:
diff changeset
119 movff int_I_pres_respiration+0,int_I_pres_surface+0 ; copy for desat routine
heinrichsweikamp
parents:
diff changeset
120 movff int_I_pres_respiration+1,int_I_pres_surface+1
heinrichsweikamp
parents:
diff changeset
121
heinrichsweikamp
parents:
diff changeset
122 extern deco_reset
heinrichsweikamp
parents:
diff changeset
123 call deco_reset
133
939f1e83c4c2 BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents: 113
diff changeset
124
939f1e83c4c2 BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents: 113
diff changeset
125 call rtc_init ; init clock
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 movlw HIGH .512 ; =2
939f1e83c4c2 BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents: 113
diff changeset
128 movwf EEADRH
939f1e83c4c2 BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents: 113
diff changeset
129 read_int_eeprom .0
939f1e83c4c2 BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents: 113
diff changeset
130 clrf EEADRH
939f1e83c4c2 BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents: 113
diff changeset
131 movlw 0xAA
939f1e83c4c2 BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents: 113
diff changeset
132 cpfseq EEDATA ; =0xAA
939f1e83c4c2 BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents: 113
diff changeset
133 bra no_deco_restore ; No
939f1e83c4c2 BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents: 113
diff changeset
134
939f1e83c4c2 BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents: 113
diff changeset
135 extern restore_decodata_from_eeprom
939f1e83c4c2 BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents: 113
diff changeset
136 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
137
939f1e83c4c2 BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents: 113
diff changeset
138 no_deco_restore:
939f1e83c4c2 BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents: 113
diff changeset
139 call deco_calc_desaturation_time ; calculate desaturation time
939f1e83c4c2 BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents: 113
diff changeset
140 banksel common
939f1e83c4c2 BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents: 113
diff changeset
141 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
142 banksel common
0
heinrichsweikamp
parents:
diff changeset
143 bcf menubit ; clear menu flag
215
8636efc5c6c5 ignore battery menu for cr
heinrichsweikamp
parents: 207
diff changeset
144
0
heinrichsweikamp
parents:
diff changeset
145 ; Check for Power-on reset here
464
0491a84fd0b8 CHANGE: Easier to understand "New Battery" menu (OSTC model dependent)
heinrichsweikamp
parents: 463
diff changeset
146 extern use_old_prior_209
215
8636efc5c6c5 ignore battery menu for cr
heinrichsweikamp
parents: 207
diff changeset
147 ; *****************************************************************************
8636efc5c6c5 ignore battery menu for cr
heinrichsweikamp
parents: 207
diff changeset
148 ; "new_battery_menu" and "use_old_batteries" 'goto' back to "power_on_return"
8636efc5c6c5 ignore battery menu for cr
heinrichsweikamp
parents: 207
diff changeset
149 ; *****************************************************************************
0
heinrichsweikamp
parents:
diff changeset
150
457
b4417044a042 recover old battery status prior 2.09
heinrichsweikamp
parents: 449
diff changeset
151 ; Try to migrate the old battery status from firmware 2.09 or earlier..
b4417044a042 recover old battery status prior 2.09
heinrichsweikamp
parents: 449
diff changeset
152 btfsc RCON,POR ; Was this a power-on reset?
472
4fdf6886004b CHANGE: Show warnings either in Customview (If active) _or_ next to warning sign
heinrichsweikamp
parents: 464
diff changeset
153 call use_old_prior_209 ; No
464
0491a84fd0b8 CHANGE: Easier to understand "New Battery" menu (OSTC model dependent)
heinrichsweikamp
parents: 463
diff changeset
154
0491a84fd0b8 CHANGE: Easier to understand "New Battery" menu (OSTC model dependent)
heinrichsweikamp
parents: 463
diff changeset
155 bcf use_old_batt_flag
416
4389fe9673b2 NEW: Support for new logbook memory chip (minor hardware change)
heinrichsweikamp
parents: 410
diff changeset
156 btfsc RCON,POR ; Was this a power-on reset?
464
0491a84fd0b8 CHANGE: Easier to understand "New Battery" menu (OSTC model dependent)
heinrichsweikamp
parents: 463
diff changeset
157 bsf use_old_batt_flag ; No
0491a84fd0b8 CHANGE: Easier to understand "New Battery" menu (OSTC model dependent)
heinrichsweikamp
parents: 463
diff changeset
158
215
8636efc5c6c5 ignore battery menu for cr
heinrichsweikamp
parents: 207
diff changeset
159 call lt2942_get_status ; Check for gauge IC
449
heinrichsweikamp
parents: 446
diff changeset
160 btfss battery_gauge_available ; cR or 2 hardware?
416
4389fe9673b2 NEW: Support for new logbook memory chip (minor hardware change)
heinrichsweikamp
parents: 410
diff changeset
161 bra power_on_return2 ; no
215
8636efc5c6c5 ignore battery menu for cr
heinrichsweikamp
parents: 207
diff changeset
162
375
a9e35c1327aa 1.88 release, BUGFIX: Start with Sensor use from sleep (cR only), CHANGE: Apply button settings when button menu is closed, NEW: Reset button settings on a magnet reset (cR and OSTC 2)
heinrichsweikamp
parents: 359
diff changeset
163 movlw .30
a9e35c1327aa 1.88 release, BUGFIX: Start with Sensor use from sleep (cR only), CHANGE: Apply button settings when button menu is closed, NEW: Reset button settings on a magnet reset (cR and OSTC 2)
heinrichsweikamp
parents: 359
diff changeset
164 movff WREG,opt_cR_button_right
a9e35c1327aa 1.88 release, BUGFIX: Start with Sensor use from sleep (cR only), CHANGE: Apply button settings when button menu is closed, NEW: Reset button settings on a magnet reset (cR and OSTC 2)
heinrichsweikamp
parents: 359
diff changeset
165 movff WREG,opt_cR_button_left ; Reset on power-on reset
a9e35c1327aa 1.88 release, BUGFIX: Start with Sensor use from sleep (cR only), CHANGE: Apply button settings when button menu is closed, NEW: Reset button settings on a magnet reset (cR and OSTC 2)
heinrichsweikamp
parents: 359
diff changeset
166 call piezo_config ; Yes, configure buttons
416
4389fe9673b2 NEW: Support for new logbook memory chip (minor hardware change)
heinrichsweikamp
parents: 410
diff changeset
167 call piezo_config ; Yes, configure buttons (2 times)
0
heinrichsweikamp
parents:
diff changeset
168
416
4389fe9673b2 NEW: Support for new logbook memory chip (minor hardware change)
heinrichsweikamp
parents: 410
diff changeset
169 power_on_return2:
0
heinrichsweikamp
parents:
diff changeset
170 ; check firmware and reset Custom Functions after an update
heinrichsweikamp
parents:
diff changeset
171 movlw d'1'
281
eb758a5b44eb BUGFIX: Fix download issue for dives made with 1.80 firmware
heinrichsweikamp
parents: 276
diff changeset
172 movwf EEADR ; =1
eb758a5b44eb BUGFIX: Fix download issue for dives made with 1.80 firmware
heinrichsweikamp
parents: 276
diff changeset
173 movwf EEADRH ; =1
0
heinrichsweikamp
parents:
diff changeset
174 call read_eeprom ; read current version x
heinrichsweikamp
parents:
diff changeset
175 movff EEDATA,temp1
heinrichsweikamp
parents:
diff changeset
176 incf EEADR,F ; set to 0x102
heinrichsweikamp
parents:
diff changeset
177 call read_eeprom ; read current version y
heinrichsweikamp
parents:
diff changeset
178 movff EEDATA,temp2
heinrichsweikamp
parents:
diff changeset
179 clrf EEADRH ; Reset EEADRH
heinrichsweikamp
parents:
diff changeset
180
443
heinrichsweikamp
parents: 441
diff changeset
181 movlw softwareversion_x
heinrichsweikamp
parents: 441
diff changeset
182 cpfseq temp1 ; compare version x
0
heinrichsweikamp
parents:
diff changeset
183 bra check_firmware_new ; is not equal -> reset CF and store new version in EEPROM
heinrichsweikamp
parents:
diff changeset
184
heinrichsweikamp
parents:
diff changeset
185 movlw softwareversion_y
heinrichsweikamp
parents:
diff changeset
186 cpfseq temp2 ; compare version y
heinrichsweikamp
parents:
diff changeset
187 bra check_firmware_new ; is not equal -> reset CF and store new version in EEPROM
heinrichsweikamp
parents:
diff changeset
188 bra restart ; x and y are equal -> do not reset cf
heinrichsweikamp
parents:
diff changeset
189
heinrichsweikamp
parents:
diff changeset
190 check_firmware_new:
heinrichsweikamp
parents:
diff changeset
191 call TFT_boot ; Initialize TFT (includes clear screen)
heinrichsweikamp
parents:
diff changeset
192 clrf CCPR1L ; Backlight off
heinrichsweikamp
parents:
diff changeset
193 WIN_TOP .50
heinrichsweikamp
parents:
diff changeset
194 WIN_LEFT .10
heinrichsweikamp
parents:
diff changeset
195 movlw LOW 0x1E000
heinrichsweikamp
parents:
diff changeset
196 movwf TBLPTRL
heinrichsweikamp
parents:
diff changeset
197 movlw HIGH 0x1E000
heinrichsweikamp
parents:
diff changeset
198 movwf TBLPTRH
heinrichsweikamp
parents:
diff changeset
199 movlw UPPER 0x1E000
heinrichsweikamp
parents:
diff changeset
200 movwf TBLPTRU
heinrichsweikamp
parents:
diff changeset
201 extern color_image
heinrichsweikamp
parents:
diff changeset
202 call color_image ; Show logo
heinrichsweikamp
parents:
diff changeset
203 call TFT_standard_color
heinrichsweikamp
parents:
diff changeset
204 WIN_SMALL .10,.100
427
ceb1b7329dce add code for new compass chip
heinrichsweikamp
parents: 416
diff changeset
205 STRCPY_PRINT "Update successful!" ; Hard coded since language switch does not work here
0
heinrichsweikamp
parents:
diff changeset
206 WIN_SMALL .10,.140
427
ceb1b7329dce add code for new compass chip
heinrichsweikamp
parents: 416
diff changeset
207 STRCPY "New Firmware: "
0
heinrichsweikamp
parents:
diff changeset
208 movlw softwareversion_x
heinrichsweikamp
parents:
diff changeset
209 movwf lo
heinrichsweikamp
parents:
diff changeset
210 bsf leftbind
heinrichsweikamp
parents:
diff changeset
211 output_8
heinrichsweikamp
parents:
diff changeset
212 PUTC "."
heinrichsweikamp
parents:
diff changeset
213 movlw softwareversion_y
heinrichsweikamp
parents:
diff changeset
214 movwf lo
45
76dfe320e6ec 1.01 beta start
heinrichsweikamp
parents: 24
diff changeset
215 output_99x
0
heinrichsweikamp
parents:
diff changeset
216 bcf leftbind
heinrichsweikamp
parents:
diff changeset
217 STRCAT_PRINT "" ; Print second row
heinrichsweikamp
parents:
diff changeset
218 call TFT_Display_FadeIn ; Display resulting surface screen.
heinrichsweikamp
parents:
diff changeset
219
heinrichsweikamp
parents:
diff changeset
220 ; place "after-update reset" here...
93
5e1ef9bf32ec clear pressure sensor compensation upon update
heinrichsweikamp
parents: 52
diff changeset
221
5e1ef9bf32ec clear pressure sensor compensation upon update
heinrichsweikamp
parents: 52
diff changeset
222 extern oPressureAdjust, option_reset, option_save
5e1ef9bf32ec clear pressure sensor compensation upon update
heinrichsweikamp
parents: 52
diff changeset
223 lfsr FSR0,oPressureAdjust
5e1ef9bf32ec clear pressure sensor compensation upon update
heinrichsweikamp
parents: 52
diff changeset
224 call option_reset ; Reset FSR0 option to factory default.
5e1ef9bf32ec clear pressure sensor compensation upon update
heinrichsweikamp
parents: 52
diff changeset
225 lfsr FSR0,oPressureAdjust
5e1ef9bf32ec clear pressure sensor compensation upon update
heinrichsweikamp
parents: 52
diff changeset
226 call option_save ; Save in EEPROM
5e1ef9bf32ec clear pressure sensor compensation upon update
heinrichsweikamp
parents: 52
diff changeset
227
281
eb758a5b44eb BUGFIX: Fix download issue for dives made with 1.80 firmware
heinrichsweikamp
parents: 276
diff changeset
228 call fix_180_dives ; fix dives made with the 1.80
eb758a5b44eb BUGFIX: Fix download issue for dives made with 1.80 firmware
heinrichsweikamp
parents: 276
diff changeset
229
410
d3087a8ed7e1 BUGFIX: Fix rare issue after battery change (OSTC3 did not start properly)
heinrichsweikamp
parents: 375
diff changeset
230 rcall backup_flash_page ; backup the first 128bytes from flash to EEPROM
d3087a8ed7e1 BUGFIX: Fix rare issue after battery change (OSTC3 did not start properly)
heinrichsweikamp
parents: 375
diff changeset
231
0
heinrichsweikamp
parents:
diff changeset
232 movlw d'1' ; store current version in EEPROM
281
eb758a5b44eb BUGFIX: Fix download issue for dives made with 1.80 firmware
heinrichsweikamp
parents: 276
diff changeset
233 movwf EEADR ; =1
eb758a5b44eb BUGFIX: Fix download issue for dives made with 1.80 firmware
heinrichsweikamp
parents: 276
diff changeset
234 movwf EEADRH ; =1
0
heinrichsweikamp
parents:
diff changeset
235 movlw softwareversion_x
heinrichsweikamp
parents:
diff changeset
236 movwf EEDATA
heinrichsweikamp
parents:
diff changeset
237 call write_eeprom ; write version x
heinrichsweikamp
parents:
diff changeset
238 incf EEADR,F ; set to 0x102
heinrichsweikamp
parents:
diff changeset
239 movlw softwareversion_y
heinrichsweikamp
parents:
diff changeset
240 movwf EEDATA
heinrichsweikamp
parents:
diff changeset
241 call write_eeprom ; write version y
heinrichsweikamp
parents:
diff changeset
242 clrf EEADRH ; Reset EEADRH
heinrichsweikamp
parents:
diff changeset
243
heinrichsweikamp
parents:
diff changeset
244 movlw .7
heinrichsweikamp
parents:
diff changeset
245 movwf lo
heinrichsweikamp
parents:
diff changeset
246 check_firmware_new2:
heinrichsweikamp
parents:
diff changeset
247 ; Wait 1 second
heinrichsweikamp
parents:
diff changeset
248 bcf onesecupdate
heinrichsweikamp
parents:
diff changeset
249 btfss onesecupdate
heinrichsweikamp
parents:
diff changeset
250 bra $-2
heinrichsweikamp
parents:
diff changeset
251 decfsz lo,F ; Wait 10 seconds...
heinrichsweikamp
parents:
diff changeset
252 bra check_firmware_new2
heinrichsweikamp
parents:
diff changeset
253
heinrichsweikamp
parents:
diff changeset
254 global restart
heinrichsweikamp
parents:
diff changeset
255 restart:
heinrichsweikamp
parents:
diff changeset
256 clrf STKPTR ; Never return from here
276
e4cb495aed3d Increase byte timeout in PC download mode, faster response to "Exit" in main menu
heinrichsweikamp
parents: 275
diff changeset
257 clrf CCP1CON ; stop PWM
e4cb495aed3d Increase byte timeout in PC download mode, faster response to "Exit" in main menu
heinrichsweikamp
parents: 275
diff changeset
258 bcf PORTC,2 ; Pull PWM out to GND
e4cb495aed3d Increase byte timeout in PC download mode, faster response to "Exit" in main menu
heinrichsweikamp
parents: 275
diff changeset
259
21
79b2084fd75a Reset options to default if they are not within the allowed min/max values
heinrichsweikamp
parents: 16
diff changeset
260 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
261
0
heinrichsweikamp
parents:
diff changeset
262 btfsc menubit ; Return from Menu/COMM mode or timeout?
heinrichsweikamp
parents:
diff changeset
263 call option_save_all ; Yes, save all settings into EEPROM
heinrichsweikamp
parents:
diff changeset
264
429
4b93354b7738 hardware_flag handling
heinrichsweikamp
parents: 427
diff changeset
265 call option_restore_all ; Restore everything from EEPROM into RAM
23
e402813343b6 new option to switch samplingrate between 10s and 2s
heinrichsweikamp
parents: 21
diff changeset
266 call option_check_all ; Check all options (and reset if not within their min/max boundaries)
429
4b93354b7738 hardware_flag handling
heinrichsweikamp
parents: 427
diff changeset
267 call option_save_all ; Save all settings into EEPROM after they have been checked
23
e402813343b6 new option to switch samplingrate between 10s and 2s
heinrichsweikamp
parents: 21
diff changeset
268
429
4b93354b7738 hardware_flag handling
heinrichsweikamp
parents: 427
diff changeset
269 clrf flag1 ; clear all flags
4b93354b7738 hardware_flag handling
heinrichsweikamp
parents: 427
diff changeset
270 clrf flag2
4b93354b7738 hardware_flag handling
heinrichsweikamp
parents: 427
diff changeset
271 clrf flag3
4b93354b7738 hardware_flag handling
heinrichsweikamp
parents: 427
diff changeset
272 clrf flag4
4b93354b7738 hardware_flag handling
heinrichsweikamp
parents: 427
diff changeset
273 clrf flag5
4b93354b7738 hardware_flag handling
heinrichsweikamp
parents: 427
diff changeset
274 clrf flag6
0
heinrichsweikamp
parents:
diff changeset
275 clrf flag7
heinrichsweikamp
parents:
diff changeset
276 clrf flag8
429
4b93354b7738 hardware_flag handling
heinrichsweikamp
parents: 427
diff changeset
277 clrf flag9
4b93354b7738 hardware_flag handling
heinrichsweikamp
parents: 427
diff changeset
278 clrf flag10
267
f64afa14ef07 BUGFIX: Analog sensors were ignored in 1.76
heinrichsweikamp
parents: 255
diff changeset
279 ; Do not clear flag11 (Sensor calibration and charger status)
255
ad62dff7739a add bearing option to compass
heinrichsweikamp
parents: 249
diff changeset
280 clrf flag12
449
heinrichsweikamp
parents: 446
diff changeset
281 ; ; Do not clear flag13 (Important hardware flags)
235
23311219dacc under construction: new hardware_flag to configure different hardware versions
heinrichsweikamp
parents: 224
diff changeset
282 clrf hardware_flag ; hardware descriptor flag
449
heinrichsweikamp
parents: 446
diff changeset
283 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
284
236
e2ea74646127 configure hardware_flag byte
heinrichsweikamp
parents: 235
diff changeset
285 ; configure hardware_flag byte
e2ea74646127 configure hardware_flag byte
heinrichsweikamp
parents: 235
diff changeset
286
429
4b93354b7738 hardware_flag handling
heinrichsweikamp
parents: 427
diff changeset
287 bsf ambient_sensor ; Set flag
4b93354b7738 hardware_flag handling
heinrichsweikamp
parents: 427
diff changeset
288 bsf optical_input ; Set flag
236
e2ea74646127 configure hardware_flag byte
heinrichsweikamp
parents: 235
diff changeset
289
113
heinrichsweikamp
parents: 93
diff changeset
290 call lt2942_get_status ; Check for gauge IC
449
heinrichsweikamp
parents: 446
diff changeset
291 btfss battery_gauge_available ; cR/2 hardware?
236
e2ea74646127 configure hardware_flag byte
heinrichsweikamp
parents: 235
diff changeset
292 bra restart2 ; No
e2ea74646127 configure hardware_flag byte
heinrichsweikamp
parents: 235
diff changeset
293
113
heinrichsweikamp
parents: 93
diff changeset
294 call lt2942_init ; Yes, init battery gauge IC
429
4b93354b7738 hardware_flag handling
heinrichsweikamp
parents: 427
diff changeset
295 bcf optical_input ; Clear flag
4b93354b7738 hardware_flag handling
heinrichsweikamp
parents: 427
diff changeset
296
441
360acdcda0d7 +BUGFIX: Compatibility with "hwOS Config" fixed
heinrichsweikamp
parents: 429
diff changeset
297 banksel 0xF16
429
4b93354b7738 hardware_flag handling
heinrichsweikamp
parents: 427
diff changeset
298 bcf ANCON0,7 ; AN7 Digital input
441
360acdcda0d7 +BUGFIX: Compatibility with "hwOS Config" fixed
heinrichsweikamp
parents: 429
diff changeset
299 banksel common
429
4b93354b7738 hardware_flag handling
heinrichsweikamp
parents: 427
diff changeset
300 bcf lightsen_power ; Power-down ambient light sensor
236
e2ea74646127 configure hardware_flag byte
heinrichsweikamp
parents: 235
diff changeset
301 bcf ambient_sensor ; Clear flag
441
360acdcda0d7 +BUGFIX: Compatibility with "hwOS Config" fixed
heinrichsweikamp
parents: 429
diff changeset
302 nop
429
4b93354b7738 hardware_flag handling
heinrichsweikamp
parents: 427
diff changeset
303 btfss PORTF,2 ; Light sensor available?
4b93354b7738 hardware_flag handling
heinrichsweikamp
parents: 427
diff changeset
304 bsf ambient_sensor ; Yes.
441
360acdcda0d7 +BUGFIX: Compatibility with "hwOS Config" fixed
heinrichsweikamp
parents: 429
diff changeset
305 banksel 0xF16
429
4b93354b7738 hardware_flag handling
heinrichsweikamp
parents: 427
diff changeset
306 bsf ANCON0,7 ; AN7 Analog again
441
360acdcda0d7 +BUGFIX: Compatibility with "hwOS Config" fixed
heinrichsweikamp
parents: 429
diff changeset
307 banksel common
360acdcda0d7 +BUGFIX: Compatibility with "hwOS Config" fixed
heinrichsweikamp
parents: 429
diff changeset
308 bsf lightsen_power ; Power-up ambient light sensor again
429
4b93354b7738 hardware_flag handling
heinrichsweikamp
parents: 427
diff changeset
309
243
ee81f46714cb auto-select correct settings menu
heinrichsweikamp
parents: 236
diff changeset
310 restart2:
ee81f46714cb auto-select correct settings menu
heinrichsweikamp
parents: 236
diff changeset
311 btfsc vusb_in
ee81f46714cb auto-select correct settings menu
heinrichsweikamp
parents: 236
diff changeset
312 bra restart3 ; USB (and powered on)
ee81f46714cb auto-select correct settings menu
heinrichsweikamp
parents: 236
diff changeset
313 bcf PORTE,0 ; Start comms
ee81f46714cb auto-select correct settings menu
heinrichsweikamp
parents: 236
diff changeset
314 WAITMS d'1'
ee81f46714cb auto-select correct settings menu
heinrichsweikamp
parents: 236
diff changeset
315 btfss vusb_in
ee81f46714cb auto-select correct settings menu
heinrichsweikamp
parents: 236
diff changeset
316 bra restart3 ; USB (and powered off)
ee81f46714cb auto-select correct settings menu
heinrichsweikamp
parents: 236
diff changeset
317 bsf ble_available ; ble available
ee81f46714cb auto-select correct settings menu
heinrichsweikamp
parents: 236
diff changeset
318 restart3:
ee81f46714cb auto-select correct settings menu
heinrichsweikamp
parents: 236
diff changeset
319 bsf PORTE,0 ; Stop comms
248
afe73e1a0181 support hardware_flag for all possible hardware combinations
heinrichsweikamp
parents: 243
diff changeset
320 btfsc ble_available ; ble available?
afe73e1a0181 support hardware_flag for all possible hardware combinations
heinrichsweikamp
parents: 243
diff changeset
321 bra restart4 ; Yes, can't be a cR
449
heinrichsweikamp
parents: 446
diff changeset
322 btfss battery_gauge_available ; Rechargeable
248
afe73e1a0181 support hardware_flag for all possible hardware combinations
heinrichsweikamp
parents: 243
diff changeset
323 bra restart4 ; No, can't be a cR
afe73e1a0181 support hardware_flag for all possible hardware combinations
heinrichsweikamp
parents: 243
diff changeset
324 bsf analog_o2_input ; Set flag for analog
249
94bf757690cf ignore sensor for non-sensor hardware
heinrichsweikamp
parents: 248
diff changeset
325 restart4:
94bf757690cf ignore sensor for non-sensor hardware
heinrichsweikamp
parents: 248
diff changeset
326 ; The hardware_flag is now:
94bf757690cf ignore sensor for non-sensor hardware
heinrichsweikamp
parents: 248
diff changeset
327 ; 3: 0x0A
94bf757690cf ignore sensor for non-sensor hardware
heinrichsweikamp
parents: 248
diff changeset
328 ; cR: 0x05
94bf757690cf ignore sensor for non-sensor hardware
heinrichsweikamp
parents: 248
diff changeset
329 ; 2 with BLE: 0x11
94bf757690cf ignore sensor for non-sensor hardware
heinrichsweikamp
parents: 248
diff changeset
330 ; 3 with BLE: 0x1A
429
4b93354b7738 hardware_flag handling
heinrichsweikamp
parents: 427
diff changeset
331 ; 2 with ambient: 0x13
113
heinrichsweikamp
parents: 93
diff changeset
332
0
heinrichsweikamp
parents:
diff changeset
333 ; Select high altitude (Fly) mode?
heinrichsweikamp
parents:
diff changeset
334 movff last_surfpressure_30min+0,sub_b+0
heinrichsweikamp
parents:
diff changeset
335 movff last_surfpressure_30min+1,sub_b+1
heinrichsweikamp
parents:
diff changeset
336 movlw HIGH high_altitude_threshold
heinrichsweikamp
parents:
diff changeset
337 movwf sub_a+1
heinrichsweikamp
parents:
diff changeset
338 movlw LOW high_altitude_threshold ; Hard-wired 880mbar
heinrichsweikamp
parents:
diff changeset
339 movwf sub_a+0
heinrichsweikamp
parents:
diff changeset
340 call subU16 ; sub_c = sub_a - sub_b
heinrichsweikamp
parents:
diff changeset
341 btfss neg_flag ; Result negative (Ambient>880mbar)?
heinrichsweikamp
parents:
diff changeset
342 bsf high_altitude_mode ; No, Set Flag!
heinrichsweikamp
parents:
diff changeset
343
236
e2ea74646127 configure hardware_flag byte
heinrichsweikamp
parents: 235
diff changeset
344 btfss analog_o2_input
165
9b82239fa062 testing consumption
heinrichsweikamp
parents: 155
diff changeset
345 bsf TRISB,3
449
heinrichsweikamp
parents: 446
diff changeset
346 btfss battery_gauge_available
165
9b82239fa062 testing consumption
heinrichsweikamp
parents: 155
diff changeset
347 bsf TRISG,0
0
heinrichsweikamp
parents:
diff changeset
348 call ext_flash_disable_protection ; Disable write protection for external flash
heinrichsweikamp
parents:
diff changeset
349
155
5f71e31bd5b3 CHANGE: Re-arranged Settings Menu, add 180? rotate to menu
heinrichsweikamp
parents: 154
diff changeset
350 bsf flip_screen ; Flip 180°
5f71e31bd5b3 CHANGE: Re-arranged Settings Menu, add 180? rotate to menu
heinrichsweikamp
parents: 154
diff changeset
351 TSTOSS opt_flip_screen ; =1: Flip the screen
5f71e31bd5b3 CHANGE: Re-arranged Settings Menu, add 180? rotate to menu
heinrichsweikamp
parents: 154
diff changeset
352 bcf flip_screen ; Normal orientation
151
5cb177f0948a work on flip screen...
heinrichsweikamp
parents: 147
diff changeset
353
464
0491a84fd0b8 CHANGE: Easier to understand "New Battery" menu (OSTC model dependent)
heinrichsweikamp
parents: 463
diff changeset
354 btfsc use_old_batt_flag ; =1: load old battery information after power-on reset
0491a84fd0b8 CHANGE: Easier to understand "New Battery" menu (OSTC model dependent)
heinrichsweikamp
parents: 463
diff changeset
355 goto use_old_batteries ; Returns to "surfloop"!
0491a84fd0b8 CHANGE: Easier to understand "New Battery" menu (OSTC model dependent)
heinrichsweikamp
parents: 463
diff changeset
356
0491a84fd0b8 CHANGE: Easier to understand "New Battery" menu (OSTC model dependent)
heinrichsweikamp
parents: 463
diff changeset
357 btfsc RCON,POR ; Was this a power-on reset?
0491a84fd0b8 CHANGE: Easier to understand "New Battery" menu (OSTC model dependent)
heinrichsweikamp
parents: 463
diff changeset
358 goto surfloop ; Jump to Surfaceloop!
0491a84fd0b8 CHANGE: Easier to understand "New Battery" menu (OSTC model dependent)
heinrichsweikamp
parents: 463
diff changeset
359 bsf RCON,POR ; Set bit for next detection
0491a84fd0b8 CHANGE: Easier to understand "New Battery" menu (OSTC model dependent)
heinrichsweikamp
parents: 463
diff changeset
360 ; Things to do after a power-on reset
0491a84fd0b8 CHANGE: Easier to understand "New Battery" menu (OSTC model dependent)
heinrichsweikamp
parents: 463
diff changeset
361 extern new_battery_menu,use_old_batteries
0491a84fd0b8 CHANGE: Easier to understand "New Battery" menu (OSTC model dependent)
heinrichsweikamp
parents: 463
diff changeset
362 goto new_battery_menu ; Returns to "surfloop"!
0
heinrichsweikamp
parents:
diff changeset
363
heinrichsweikamp
parents:
diff changeset
364 ;=============================================================================
heinrichsweikamp
parents:
diff changeset
365 ; Setup all flags and parameters for divemode and simulator computations.
heinrichsweikamp
parents:
diff changeset
366 ;
heinrichsweikamp
parents:
diff changeset
367 global restart_set_modes_and_flags
heinrichsweikamp
parents:
diff changeset
368 restart_set_modes_and_flags: ; "Call"ed from divemode, as well!
heinrichsweikamp
parents:
diff changeset
369 call option_restore_all ; Restore everything from EEPROM
24
f51caad821b4 save logbook recording interval
heinrichsweikamp
parents: 23
diff changeset
370
f51caad821b4 save logbook recording interval
heinrichsweikamp
parents: 23
diff changeset
371 ; Setup sampling rate
f51caad821b4 save logbook recording interval
heinrichsweikamp
parents: 23
diff changeset
372 movlw .2
f51caad821b4 save logbook recording interval
heinrichsweikamp
parents: 23
diff changeset
373 movwf samplingrate
f51caad821b4 save logbook recording interval
heinrichsweikamp
parents: 23
diff changeset
374 TSTOSS opt_sampling_rate ; =1: 10s, =0: 2s
f51caad821b4 save logbook recording interval
heinrichsweikamp
parents: 23
diff changeset
375 bra restart_set_modes_and_flags1
f51caad821b4 save logbook recording interval
heinrichsweikamp
parents: 23
diff changeset
376 movlw .10
f51caad821b4 save logbook recording interval
heinrichsweikamp
parents: 23
diff changeset
377 movwf samplingrate
f51caad821b4 save logbook recording interval
heinrichsweikamp
parents: 23
diff changeset
378 restart_set_modes_and_flags1:
0
heinrichsweikamp
parents:
diff changeset
379 movff opt_dive_mode,lo ; 0=OC, 1=CC, 2=Gauge, 3=Apnea
heinrichsweikamp
parents:
diff changeset
380
heinrichsweikamp
parents:
diff changeset
381 bcf FLAG_apnoe_mode
heinrichsweikamp
parents:
diff changeset
382 bcf FLAG_ccr_mode ; =1: CCR mode (Fixed ppO2 or Sensor) active
heinrichsweikamp
parents:
diff changeset
383 bcf FLAG_gauge_mode ; =1: In Gauge mode
224
5a4801918be9 temporally disable "Copy disable flags from digital input" routine
heinrichsweikamp
parents: 220
diff changeset
384 call disable_ir_s8 ; IR off
0
heinrichsweikamp
parents:
diff changeset
385
heinrichsweikamp
parents:
diff changeset
386 tstfsz lo
heinrichsweikamp
parents:
diff changeset
387 bra restart_set_modes_and_flags2
heinrichsweikamp
parents:
diff changeset
388 ; OC Mode
heinrichsweikamp
parents:
diff changeset
389 return
heinrichsweikamp
parents:
diff changeset
390
heinrichsweikamp
parents:
diff changeset
391 restart_set_modes_and_flags2:
heinrichsweikamp
parents:
diff changeset
392 decfsz lo,F
heinrichsweikamp
parents:
diff changeset
393 bra restart_set_modes_and_flags3
heinrichsweikamp
parents:
diff changeset
394 ; CC Mode
359
2be48ccfa9de make AUTO SP available on OSTC2 hardware
heinrichsweikamp
parents: 338
diff changeset
395 btfsc analog_o2_input ; cR?
2be48ccfa9de make AUTO SP available on OSTC2 hardware
heinrichsweikamp
parents: 338
diff changeset
396 bra restart_set_modes_and_flags2b ; Yes, skip mode check
2be48ccfa9de make AUTO SP available on OSTC2 hardware
heinrichsweikamp
parents: 338
diff changeset
397 btfsc optical_input ; 3
2be48ccfa9de make AUTO SP available on OSTC2 hardware
heinrichsweikamp
parents: 338
diff changeset
398 bra restart_set_modes_and_flags2b ; Yes, skip mode check
2be48ccfa9de make AUTO SP available on OSTC2 hardware
heinrichsweikamp
parents: 338
diff changeset
399 ; Make sure Sensor is not selected
2be48ccfa9de make AUTO SP available on OSTC2 hardware
heinrichsweikamp
parents: 338
diff changeset
400 ; opt_ccr_mode must be <> 1 (=0: Fixed SP, =1: Sensor, =2: Auto SP)
2be48ccfa9de make AUTO SP available on OSTC2 hardware
heinrichsweikamp
parents: 338
diff changeset
401 banksel opt_ccr_mode
2be48ccfa9de make AUTO SP available on OSTC2 hardware
heinrichsweikamp
parents: 338
diff changeset
402 movlw .1
2be48ccfa9de make AUTO SP available on OSTC2 hardware
heinrichsweikamp
parents: 338
diff changeset
403 cpfseq opt_ccr_mode ; = Sensor?
2be48ccfa9de make AUTO SP available on OSTC2 hardware
heinrichsweikamp
parents: 338
diff changeset
404 bra restart_set_modes_and_flags2b ; No
2be48ccfa9de make AUTO SP available on OSTC2 hardware
heinrichsweikamp
parents: 338
diff changeset
405 clrf opt_ccr_mode ; Yes, reset to Fixed SP
2be48ccfa9de make AUTO SP available on OSTC2 hardware
heinrichsweikamp
parents: 338
diff changeset
406 restart_set_modes_and_flags2b:
2be48ccfa9de make AUTO SP available on OSTC2 hardware
heinrichsweikamp
parents: 338
diff changeset
407 banksel common
338
2811932b4e99 NEW: Mode Auto SP: Automatically switches the SP during descent (CC Mode)
heinrichsweikamp
parents: 319
diff changeset
408 bsf FLAG_ccr_mode ; =1: CCR mode (Fixed SP, Auto SP or Sensor) active
187
669b5d00706d CHANGE: Longer timeout (4 min) for calibration menu
heinrichsweikamp
parents: 165
diff changeset
409 call enable_ir_s8 ; Enable IR/S8-Port
0
heinrichsweikamp
parents:
diff changeset
410 return
heinrichsweikamp
parents:
diff changeset
411
heinrichsweikamp
parents:
diff changeset
412 restart_set_modes_and_flags3:
heinrichsweikamp
parents:
diff changeset
413 decfsz lo,F
heinrichsweikamp
parents:
diff changeset
414 bra restart_set_modes_and_flags4
heinrichsweikamp
parents:
diff changeset
415 ; Gauge Mode
heinrichsweikamp
parents:
diff changeset
416 bsf FLAG_gauge_mode ; =1: In Gauge mode
heinrichsweikamp
parents:
diff changeset
417 return
heinrichsweikamp
parents:
diff changeset
418
heinrichsweikamp
parents:
diff changeset
419 restart_set_modes_and_flags4:
heinrichsweikamp
parents:
diff changeset
420 ; Apnea Mode
heinrichsweikamp
parents:
diff changeset
421 bsf FLAG_apnoe_mode
heinrichsweikamp
parents:
diff changeset
422 return ; start in Surfacemode
heinrichsweikamp
parents:
diff changeset
423
410
d3087a8ed7e1 BUGFIX: Fix rare issue after battery change (OSTC3 did not start properly)
heinrichsweikamp
parents: 375
diff changeset
424 backup_flash_page: ; backup the first 128bytes from flash to EEPROM
d3087a8ed7e1 BUGFIX: Fix rare issue after battery change (OSTC3 did not start properly)
heinrichsweikamp
parents: 375
diff changeset
425 ; Start address in internal flash
d3087a8ed7e1 BUGFIX: Fix rare issue after battery change (OSTC3 did not start properly)
heinrichsweikamp
parents: 375
diff changeset
426 movlw 0x00
d3087a8ed7e1 BUGFIX: Fix rare issue after battery change (OSTC3 did not start properly)
heinrichsweikamp
parents: 375
diff changeset
427 movwf TBLPTRL
d3087a8ed7e1 BUGFIX: Fix rare issue after battery change (OSTC3 did not start properly)
heinrichsweikamp
parents: 375
diff changeset
428 movwf TBLPTRH
d3087a8ed7e1 BUGFIX: Fix rare issue after battery change (OSTC3 did not start properly)
heinrichsweikamp
parents: 375
diff changeset
429 movwf TBLPTRU
d3087a8ed7e1 BUGFIX: Fix rare issue after battery change (OSTC3 did not start properly)
heinrichsweikamp
parents: 375
diff changeset
430
d3087a8ed7e1 BUGFIX: Fix rare issue after battery change (OSTC3 did not start properly)
heinrichsweikamp
parents: 375
diff changeset
431 movlw .128
d3087a8ed7e1 BUGFIX: Fix rare issue after battery change (OSTC3 did not start properly)
heinrichsweikamp
parents: 375
diff changeset
432 movwf lo ; Byte counter
d3087a8ed7e1 BUGFIX: Fix rare issue after battery change (OSTC3 did not start properly)
heinrichsweikamp
parents: 375
diff changeset
433 clrf EEADR
d3087a8ed7e1 BUGFIX: Fix rare issue after battery change (OSTC3 did not start properly)
heinrichsweikamp
parents: 375
diff changeset
434 movlw .3
d3087a8ed7e1 BUGFIX: Fix rare issue after battery change (OSTC3 did not start properly)
heinrichsweikamp
parents: 375
diff changeset
435 movwf EEADRH ; Setup backup address
d3087a8ed7e1 BUGFIX: Fix rare issue after battery change (OSTC3 did not start properly)
heinrichsweikamp
parents: 375
diff changeset
436
d3087a8ed7e1 BUGFIX: Fix rare issue after battery change (OSTC3 did not start properly)
heinrichsweikamp
parents: 375
diff changeset
437 TBLRD*- ; Dummy read to be in 128 byte block
d3087a8ed7e1 BUGFIX: Fix rare issue after battery change (OSTC3 did not start properly)
heinrichsweikamp
parents: 375
diff changeset
438 backup_flash_loop:
d3087a8ed7e1 BUGFIX: Fix rare issue after battery change (OSTC3 did not start properly)
heinrichsweikamp
parents: 375
diff changeset
439 tblrd+* ; Table Read with Pre-Increment
d3087a8ed7e1 BUGFIX: Fix rare issue after battery change (OSTC3 did not start properly)
heinrichsweikamp
parents: 375
diff changeset
440 movff TABLAT,EEDATA ; put 1 byte
d3087a8ed7e1 BUGFIX: Fix rare issue after battery change (OSTC3 did not start properly)
heinrichsweikamp
parents: 375
diff changeset
441 call write_eeprom ; save it in EEPROM
d3087a8ed7e1 BUGFIX: Fix rare issue after battery change (OSTC3 did not start properly)
heinrichsweikamp
parents: 375
diff changeset
442 incf EEADR,F
d3087a8ed7e1 BUGFIX: Fix rare issue after battery change (OSTC3 did not start properly)
heinrichsweikamp
parents: 375
diff changeset
443 decfsz lo,F ; 128byte done?
d3087a8ed7e1 BUGFIX: Fix rare issue after battery change (OSTC3 did not start properly)
heinrichsweikamp
parents: 375
diff changeset
444 bra backup_flash_loop ; No
d3087a8ed7e1 BUGFIX: Fix rare issue after battery change (OSTC3 did not start properly)
heinrichsweikamp
parents: 375
diff changeset
445 clrf EEADRH ; Reset EEADRH
d3087a8ed7e1 BUGFIX: Fix rare issue after battery change (OSTC3 did not start properly)
heinrichsweikamp
parents: 375
diff changeset
446 return ; Done.
d3087a8ed7e1 BUGFIX: Fix rare issue after battery change (OSTC3 did not start properly)
heinrichsweikamp
parents: 375
diff changeset
447
0
heinrichsweikamp
parents:
diff changeset
448 END