Mercurial > public > mk2
annotate code_part1/OSTC_code_asm_part1/start.asm @ 520:acf4776eec08
BUGFIX bank1 error, deco_calc_wo_deco done twice in start routine.
author | JeanDo |
---|---|
date | Fri, 09 Dec 2011 20:43:35 +0100 |
parents | c9f19a546e64 |
children | 33abbc08f01e |
rev | line source |
---|---|
0 | 1 ; OSTC - diving computer code |
2 ; Copyright (C) 2008 HeinrichsWeikamp GbR | |
3 | |
4 ; This program is free software: you can redistribute it and/or modify | |
5 ; it under the terms of the GNU General Public License as published by | |
6 ; the Free Software Foundation, either version 3 of the License, or | |
7 ; (at your option) any later version. | |
8 | |
9 ; This program is distributed in the hope that it will be useful, | |
10 ; but WITHOUT ANY WARRANTY; without even the implied warranty of | |
11 ; MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
12 ; GNU General Public License for more details. | |
13 | |
14 ; You should have received a copy of the GNU General Public License | |
15 ; along with this program. If not, see <http://www.gnu.org/licenses/>. | |
16 | |
17 | |
18 ; Start and init | |
19 ; written by: Matthias Heinrichs, info@heinrichsweikamp.com | |
20 ; written: 10/13/04 | |
21 ; last updated: 06/24/08 | |
22 ; known bugs: | |
23 ; ToDo: | |
24 | |
25 start: | |
26 movlb b'00000001' ; ram bank 1 selected | |
119 | 27 movff STKPTR,temp10 |
235 | 28 clrf temp10+1 |
0 | 29 call init |
30 btfsc divemode ; Reset from Divemode? | |
31 call PLED_resetdebugger ; Yes! Something went wrong, show reset informations | |
306 | 32 start3: |
0 | 33 clrf STKPTR ; Clear Stackpointer |
359 | 34 lfsr FSR0,year+1 ; Clear rambank 1-9, do not delete RTC registers |
0 | 35 clear_rambank: |
36 clrf POSTINC0 | |
37 movlw 0x0A | |
38 cpfseq FSR0H ; Bank 9 done? | |
39 bra clear_rambank ; clear... | |
40 | |
41 ; Defaults for RTC | |
42 call disable_rs232 ; disable UART module | |
43 call RTCinit ; reset RTC | |
44 | |
45 ; Air pressure compensation after reset | |
46 call get_calibration_data ; Get calibration data from pressure sensor | |
47 | |
48 bcf pressure_refresh | |
49 wait_start_pressure: | |
50 btfss pressure_refresh ; Air pressure compensation | |
51 bra wait_start_pressure | |
52 | |
53 clrf rel_pressure+0 | |
54 clrf rel_pressure+1 | |
55 clrf surface_interval+0 | |
56 clrf surface_interval+1 | |
57 | |
58 bsf sleepmode ; Routine only works in sleepmode... | |
59 call pressuretest_sleep_fast ; Gets pressure without averaging (faster!) | |
60 bcf sleepmode ; Normal mode again | |
233 | 61 |
507 | 62 Ifdef TESTING |
63 movlw LOW(.1000) | |
64 movwf amb_pressure+0 | |
65 movlw HIGH(.1000) | |
66 movwf amb_pressure+1 | |
67 Else | |
68 SAFE_2BYTE_COPY amb_pressure_avg, amb_pressure ; copy for compatibility | |
69 Endif | |
70 | |
71 movff amb_pressure+0,last_surfpressure+0 | |
72 movff amb_pressure+1,last_surfpressure+1 | |
341
2144f19fa1eb
BUGFIX protect against ISR changing pressure/temperature while reading it.
JeanDo
parents:
327
diff
changeset
|
73 movff last_surfpressure+0,last_surfpressure_15min+0 |
2144f19fa1eb
BUGFIX protect against ISR changing pressure/temperature while reading it.
JeanDo
parents:
327
diff
changeset
|
74 movff last_surfpressure+1,last_surfpressure_15min+1 |
2144f19fa1eb
BUGFIX protect against ISR changing pressure/temperature while reading it.
JeanDo
parents:
327
diff
changeset
|
75 movff last_surfpressure+0,last_surfpressure_30min+0 |
2144f19fa1eb
BUGFIX protect against ISR changing pressure/temperature while reading it.
JeanDo
parents:
327
diff
changeset
|
76 movff last_surfpressure+1,last_surfpressure_30min+1 ; Rests all airpressure registers |
0 | 77 |
78 ; reset deco data | |
236 | 79 ostc_debug '0' ; Sends debug-information to screen if debugmode active |
80 | |
0 | 81 movlw d'79' ; 79% N2 |
197 | 82 movff WREG,char_I_N2_ratio ; No He at the Surface |
236 | 83 clrf WREG ; Use as buffer |
84 movff WREG,char_I_He_ratio ; No He at the Surface | |
85 movff WREG,char_I_step_is_1min ; 2 second deco mode | |
86 GETCUSTOM8 d'11' ; Saturation multiplier % | |
87 movff WREG,char_I_saturation_multiplier | |
88 GETCUSTOM8 d'12' ; Desaturation multiplier % | |
89 movff WREG,char_I_desaturation_multiplier | |
507 | 90 movff amb_pressure+0,int_I_pres_respiration+0 ; copy for deco routine |
91 movff amb_pressure+1,int_I_pres_respiration+1 | |
92 movff int_I_pres_respiration+0,int_I_pres_surface+0 ; copy for desat routine | |
341
2144f19fa1eb
BUGFIX protect against ISR changing pressure/temperature while reading it.
JeanDo
parents:
327
diff
changeset
|
93 movff int_I_pres_respiration+1,int_I_pres_surface+1 |
0 | 94 |
507 | 95 ; Extra power-up reset (JeanDo) |
96 ifdef TESTING | |
97 call reset_gases | |
98 call reset_all_cf | |
99 endif | |
100 | |
513 | 101 call deco_clear_tissue |
102 movlb b'00000001' ; select ram bank 1 | |
103 | |
508
b595569e4bcc
BUGFIX char_I_(N2_ratio/He_ratio) array not inited at boot time
JeanDo
parents:
507
diff
changeset
|
104 call divemode_check_decogases ; Setup N2/He ratio array |
520
acf4776eec08
BUGFIX bank1 error, deco_calc_wo_deco done twice in start routine.
JeanDo
parents:
513
diff
changeset
|
105 |
acf4776eec08
BUGFIX bank1 error, deco_calc_wo_deco done twice in start routine.
JeanDo
parents:
513
diff
changeset
|
106 call calc_deko_surfmode ; calculate desaturation for one minute |
acf4776eec08
BUGFIX bank1 error, deco_calc_wo_deco done twice in start routine.
JeanDo
parents:
513
diff
changeset
|
107 |
116 | 108 call deco_calc_desaturation_time ; calculate desaturation time |
109 call deco_clear_CNS_fraction ; clear CNS | |
520
acf4776eec08
BUGFIX bank1 error, deco_calc_wo_deco done twice in start routine.
JeanDo
parents:
513
diff
changeset
|
110 movlb b'00000001' ; select ram bank 1 |
acf4776eec08
BUGFIX bank1 error, deco_calc_wo_deco done twice in start routine.
JeanDo
parents:
513
diff
changeset
|
111 |
412 | 112 clrf nofly_time+0 ; Reset NoFly |
113 clrf nofly_time+1 ; Reset NoFly | |
114 bcf nofly_active ; Clear flag | |
0 | 115 |
116 ; check firmware and reset Custom Functions after an update | |
384
904863f96582
Work-Around for "Reset all" overwriting 0x00 to 0x04 in EEPROM Bank1
heinrichsweikamp
parents:
380
diff
changeset
|
117 movlw d'1' |
0 | 118 movwf EEADR |
384
904863f96582
Work-Around for "Reset all" overwriting 0x00 to 0x04 in EEPROM Bank1
heinrichsweikamp
parents:
380
diff
changeset
|
119 movlw d'1' |
0 | 120 movwf EEADRH |
121 call read_eeprom ; read current version x | |
122 movff EEDATA,temp1 | |
123 incf EEADR,F ; set to 0x102 | |
124 call read_eeprom ; read current version y | |
125 movff EEDATA,temp2 | |
126 clrf EEADRH ; Reset EEADRH | |
127 | |
128 movlw softwareversion_x | |
129 cpfseq temp1 ; compare version x | |
130 bra check_firmware_new ; is not equal -> reset CF and store new version in EEPROM | |
131 | |
132 movlw softwareversion_y | |
133 cpfseq temp2 ; compare version y | |
134 bra check_firmware_new ; is not equal -> reset CF and store new version in EEPROM | |
135 bra restart ; x and y are equal -> do not reset cf | |
136 | |
137 check_firmware_new: | |
384
904863f96582
Work-Around for "Reset all" overwriting 0x00 to 0x04 in EEPROM Bank1
heinrichsweikamp
parents:
380
diff
changeset
|
138 movlw d'1' ; store current version in EEPROM |
0 | 139 movwf EEADR |
384
904863f96582
Work-Around for "Reset all" overwriting 0x00 to 0x04 in EEPROM Bank1
heinrichsweikamp
parents:
380
diff
changeset
|
140 movlw d'1' |
0 | 141 movwf EEADRH |
142 movlw softwareversion_x | |
143 movwf EEDATA | |
144 call write_eeprom ; write version x | |
145 incf EEADR,F ; set to 0x102 | |
146 movlw softwareversion_y | |
147 movwf EEDATA | |
148 call write_eeprom ; write version y | |
149 clrf EEADRH ; Reset EEADRH | |
392 | 150 |
500 | 151 ; After update resets |
152 ; Reset brightness to ECO | |
153 movlw LOW 0x104 | |
154 movwf EEADR | |
155 movlw HIGH 0x104 | |
156 movwf EEADRH ; OLED brightness (=0: Eco, =1: High) | |
157 movlw .0 | |
158 movwf EEDATA | |
159 call write_eeprom ; write byte | |
160 clrf EEADRH ; Reset EEADRH | |
0 | 161 |
162 restart: | |
390 | 163 movlw b'00000011' |
164 movwf T3CON ; Timer3 with 32768Hz clock running | |
165 clrf TMR3L | |
166 clrf TMR3H | |
21 | 167 bcf LED_red |
168 bcf LED_blue ; all LEDs off | |
43 | 169 GETCUSTOM8 d'48' ; time correction value |
170 movff WREG, time_correction_value ; store in Bank0 register | |
15 | 171 |
172 clrf flag1 ; clear all flags | |
173 clrf flag2 | |
174 clrf flag3 | |
175 clrf flag4 | |
176 clrf flag5 | |
177 clrf flag6 | |
178 clrf flag7 | |
179 clrf flag8 | |
180 clrf flag9 | |
181 clrf flag10 | |
182 clrf flag11 | |
183 clrf flag12 | |
184 clrf flag13 | |
185 clrf flag14 | |
186 clrf flag15 | |
153 | 187 |
169
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
167
diff
changeset
|
188 ; Should we set win_flip_screen ? |
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
167
diff
changeset
|
189 bsf flag1,0 ; Precondition to yes |
153 | 190 clrf EEADRH ; Reset EEADRH |
191 read_int_eeprom d'1' | |
192 movlw .7 | |
169
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
167
diff
changeset
|
193 cpfsgt EEDATA ; serial > 2048 (Mk2n hardware) ? |
153 | 194 bcf flag1,0 |
169
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
167
diff
changeset
|
195 incf EEDATA,W ; serial == 65535 (emulation) ? |
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
167
diff
changeset
|
196 btfsc STATUS,Z |
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
167
diff
changeset
|
197 bcf flag1,0 |
153 | 198 movff flag1,win_flags ; store in Bank0 register |
199 clrf flag1 ; Clear flag1 (again) | |
239 | 200 |
201 ; Select high altitude (Fly) mode? | |
202 movff last_surfpressure_30min+0,sub_b+0 | |
203 movff last_surfpressure_30min+1,sub_b+1 | |
204 movlw HIGH d'880' | |
205 movwf sub_a+1 | |
206 movlw LOW d'880' ; Hard-wired 880mBar | |
207 movwf sub_a+0 | |
208 call sub16 ; sub_c = sub_a - sub_b | |
209 btfss neg_flag ; Result negative (Ambient>880mBar)? | |
210 bsf high_altitude_mode ; No, Set Flag! | |
169
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
167
diff
changeset
|
211 |
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
167
diff
changeset
|
212 ; Should we disable sleep (hardware emulator) |
507 | 213 Ifndef TESTING |
390 | 214 restart_loop: |
215 btfss 0xF81,0,A | |
216 bra restart_loop | |
217 btfss 0xF81,1,A | |
218 bra restart_loop | |
219 movlw 0x80 | |
220 cpfslt 0xFB3,A | |
167 | 221 bsf nsm ; NO-SLEEP-MODE : for hardware debugging |
507 | 222 Endif |
153 | 223 |
142 | 224 call gassetup_sort_gaslist ; Sorts Gaslist according to change depth |
0 | 225 WIN_TOP .0 |
226 WIN_LEFT .0 | |
227 WIN_FONT FT_SMALL | |
228 WIN_INVERT .0 ; Init new Wordprocessor | |
83
3e351e25f5d1
adding anti-aliased fonts frame and merging some patches from Jeando
heinrichsweikamp
parents:
62
diff
changeset
|
229 setf WREG |
3e351e25f5d1
adding anti-aliased fonts frame and merging some patches from Jeando
heinrichsweikamp
parents:
62
diff
changeset
|
230 movff WREG,win_color1 ; Beware: win_color1 is bank0, and we are bank1 currently |
3e351e25f5d1
adding anti-aliased fonts frame and merging some patches from Jeando
heinrichsweikamp
parents:
62
diff
changeset
|
231 movff WREG,win_color2 |
0 | 232 call I2CReset ; Just in Case any I2C device blocks the Bus |
233 movff last_surfpressure_30min+0,last_surfpressure+0 ; Use 30min old airpressure | |
234 movff last_surfpressure_30min+1,last_surfpressure+1 ; Use 30min old airpressure | |
235 | |
236 ; Check if new CF were added in the last firmware version | |
237 clrf EEADRH | |
238 read_int_eeprom d'92' ; Read number of CF used in this firmware | |
239 movlw max_custom_number ; Defined in definitions.asm | |
240 cpfseq EEDATA ; Compare with last version | |
241 bra restart_01 ; New CF, show warning and store new number | |
242 bra restart_1 ; No new CF, continue with boot | |
243 restart_01: | |
244 ; Save new number of current CF count | |
411
e6e1b89b7c3e
BUGFIX: CNS was not cleared with a "Reset Deco"
heinrichsweikamp
parents:
393
diff
changeset
|
245 call PLED_boot ; PLED boot (Incl. Clear Screen!) |
0 | 246 rcall display_new_cf_installed; Show warning |
247 movlw max_custom_number ; Defined in definitions.asm | |
248 movwf EEDATA | |
249 write_int_eeprom d'92' ; Store number of CF used in this firmware | |
250 | |
251 restart_1: | |
252 | |
253 ; Set Debug mode? | |
254 read_int_eeprom d'39' | |
255 bsf debug_mode | |
256 movlw d'1' | |
257 cpfseq EEDATA | |
258 bcf debug_mode ; clear flag if <> 1 | |
259 | |
362
64da813d4726
Logbook converter (Needs ~8Minutes and is called one time). Backup your dives before use!!
Heinrichsweikamp
parents:
359
diff
changeset
|
260 ; Check if logbook has been converted already (Internal EEPROM 0x100=0xAA) |
64da813d4726
Logbook converter (Needs ~8Minutes and is called one time). Backup your dives before use!!
Heinrichsweikamp
parents:
359
diff
changeset
|
261 movlw LOW 0x100 |
64da813d4726
Logbook converter (Needs ~8Minutes and is called one time). Backup your dives before use!!
Heinrichsweikamp
parents:
359
diff
changeset
|
262 movwf EEADR |
64da813d4726
Logbook converter (Needs ~8Minutes and is called one time). Backup your dives before use!!
Heinrichsweikamp
parents:
359
diff
changeset
|
263 movlw HIGH 0x100 |
64da813d4726
Logbook converter (Needs ~8Minutes and is called one time). Backup your dives before use!!
Heinrichsweikamp
parents:
359
diff
changeset
|
264 movwf EEADRH |
64da813d4726
Logbook converter (Needs ~8Minutes and is called one time). Backup your dives before use!!
Heinrichsweikamp
parents:
359
diff
changeset
|
265 call read_eeprom ; read byte |
64da813d4726
Logbook converter (Needs ~8Minutes and is called one time). Backup your dives before use!!
Heinrichsweikamp
parents:
359
diff
changeset
|
266 movlw 0xAA |
64da813d4726
Logbook converter (Needs ~8Minutes and is called one time). Backup your dives before use!!
Heinrichsweikamp
parents:
359
diff
changeset
|
267 cpfseq EEDATA ; is 0xAA already? |
64da813d4726
Logbook converter (Needs ~8Minutes and is called one time). Backup your dives before use!!
Heinrichsweikamp
parents:
359
diff
changeset
|
268 call logbook_convert_64k ; No, convert now (And write 0xAA to internal EEPROM 0x100) |
64da813d4726
Logbook converter (Needs ~8Minutes and is called one time). Backup your dives before use!!
Heinrichsweikamp
parents:
359
diff
changeset
|
269 |
499
2ac77db9c150
Added OLED brightness setting, texts 280, 312 and 313 need update
heinrichsweikamp
parents:
493
diff
changeset
|
270 ; Set OLED brightness flag |
2ac77db9c150
Added OLED brightness setting, texts 280, 312 and 313 need update
heinrichsweikamp
parents:
493
diff
changeset
|
271 movlw LOW 0x104 |
2ac77db9c150
Added OLED brightness setting, texts 280, 312 and 313 need update
heinrichsweikamp
parents:
493
diff
changeset
|
272 movwf EEADR |
2ac77db9c150
Added OLED brightness setting, texts 280, 312 and 313 need update
heinrichsweikamp
parents:
493
diff
changeset
|
273 movlw HIGH 0x104 |
2ac77db9c150
Added OLED brightness setting, texts 280, 312 and 313 need update
heinrichsweikamp
parents:
493
diff
changeset
|
274 movwf EEADRH ; OLED brightness (=0: Eco, =1: High) |
2ac77db9c150
Added OLED brightness setting, texts 280, 312 and 313 need update
heinrichsweikamp
parents:
493
diff
changeset
|
275 call read_eeprom ; read byte |
2ac77db9c150
Added OLED brightness setting, texts 280, 312 and 313 need update
heinrichsweikamp
parents:
493
diff
changeset
|
276 bcf oled_brightness_high ; Eco mode |
2ac77db9c150
Added OLED brightness setting, texts 280, 312 and 313 need update
heinrichsweikamp
parents:
493
diff
changeset
|
277 movlw .0 |
2ac77db9c150
Added OLED brightness setting, texts 280, 312 and 313 need update
heinrichsweikamp
parents:
493
diff
changeset
|
278 cpfseq EEDATA ; High? |
2ac77db9c150
Added OLED brightness setting, texts 280, 312 and 313 need update
heinrichsweikamp
parents:
493
diff
changeset
|
279 bsf oled_brightness_high ; Yes! |
2ac77db9c150
Added OLED brightness setting, texts 280, 312 and 313 need update
heinrichsweikamp
parents:
493
diff
changeset
|
280 |
2ac77db9c150
Added OLED brightness setting, texts 280, 312 and 313 need update
heinrichsweikamp
parents:
493
diff
changeset
|
281 clrf EEADRH ; Reset EEADRH |
0 | 282 goto surfloop ; Jump to Surfaceloop! |
283 | |
284 | |
285 display_new_cf_installed: | |
286 call PLED_new_cf_warning ; Display new CF warning screen | |
287 movlw d'20' ; timeout for warning screen | |
288 bra startup_screen3a ; Will RETURN after timeout or button press | |
197 | 289 |
290 ;============================================================================= | |
291 ; Setup all flags and parameters for divemode and simulator computations. | |
292 ; | |
293 restart_set_modes_and_flags: ; "Call"ed from divemode, as well! | |
0 | 294 bcf gauge_mode |
295 bcf FLAG_const_ppO2_mode | |
296 bcf FLAG_apnoe_mode | |
45 | 297 |
298 ; Pre-load modes for OC, GF 90/90 and no Aponoe or Gauge. | |
197 | 299 bcf no_deco_customviews ; Clear no-deco-mode-flag |
45 | 300 movlw d'0' |
469 | 301 movff WREG,char_I_deco_model ; ZH-L16 |
45 | 302 ; Load GF values into RAM |
303 movlw d'90' | |
197 | 304 movff WREG,char_I_GF_Low_percentage |
305 movff WREG,char_I_GF_High_percentage ; Set to 90/90... | |
0 | 306 clrf EEADRH |
197 | 307 read_int_eeprom d'34' ; Read deco data |
308 movlw d'1' ; Gauge mode | |
0 | 309 cpfseq EEDATA |
197 | 310 bra restart_3_test_ppO2_mode ; check for ppO2 mode |
311 bsf gauge_mode ; Set flag for gauge mode | |
312 bsf no_deco_customviews ; Set no-deco-mode-flag | |
313 return ; start in Surfacemode | |
0 | 314 restart_3_test_ppO2_mode: |
197 | 315 movlw d'2' ; const ppO2 mode |
0 | 316 cpfseq EEDATA |
197 | 317 bra restart_3_test_apnoe_mode; check for apnoe mode |
318 bsf FLAG_const_ppO2_mode ; Set flag for ppO2 mode | |
319 return ; start in Surfacemode | |
0 | 320 restart_3_test_apnoe_mode: |
197 | 321 movlw d'3' ; Apnoe mode |
0 | 322 cpfseq EEDATA |
197 | 323 bra restart_4_test_gf_mode ; check for GF OC mode |
324 bsf FLAG_apnoe_mode ; Set flag for Apnoe Mode | |
325 bsf no_deco_customviews ; Set no-deco-mode-flag | |
326 return ; start in Surfacemode | |
0 | 327 restart_4_test_gf_mode: |
197 | 328 movlw d'4' ; GF OC mode |
0 | 329 cpfseq EEDATA |
197 | 330 bra restart_5_test_gfO2_mode ; check for GF CC mode |
0 | 331 movlw d'1' |
197 | 332 movff WREG,char_I_deco_model ; Set Flagbyte for GF method |
45 | 333 ; Load GF values into RAM |
197 | 334 GETCUSTOM8 d'32' ; GF low |
335 movff EEDATA,char_I_GF_Low_percentage | |
336 GETCUSTOM8 d'33' ; GF high | |
337 movff EEDATA,char_I_GF_High_percentage | |
338 return ; start in Surfacemode | |
0 | 339 restart_5_test_gfO2_mode: |
197 | 340 movlw d'5' ; GF CC mode |
0 | 341 cpfseq EEDATA |
197 | 342 return ; Start in Surfacemode |
343 bsf FLAG_const_ppO2_mode ; Set flag for ppO2 mode | |
0 | 344 movlw d'1' |
197 | 345 movff WREG,char_I_deco_model ; Set Flagbyte for GF method |
137 | 346 ; Load GF values into RAM |
197 | 347 GETCUSTOM8 d'32' ; GF low |
163 | 348 movff EEDATA,char_I_GF_Low_percentage |
197 | 349 GETCUSTOM8 d'33' ; GF high |
163 | 350 movff EEDATA,char_I_GF_High_percentage |
197 | 351 return ; start in Surfacemode |
352 | |
353 ;============================================================================= | |
0 | 354 |
355 startup_screen1: | |
356 call PLED_ClearScreen | |
357 call PLED_startupscreen1 ; show startup sreen | |
358 startup_screen1_2: | |
359 movlw d'10' ; timeout for startup screen | |
360 movwf temp1 | |
361 WAITMS d'200' | |
362 bcf switch_left | |
363 bcf switch_right | |
364 screen1_loop: | |
337 | 365 btfsc uart_dump_screen ; Asked to dump screen contains ? |
366 call dump_screen ; Yes! | |
367 | |
0 | 368 btfsc onesecupdate ; do every second tasks? |
369 call set_dive_modes ; tests if depth>threshold | |
370 btfsc onesecupdate ; do every second tasks? | |
371 decf temp1,F | |
372 bcf onesecupdate ; every second tasks done | |
373 | |
374 tstfsz temp1 ; timout occured? | |
375 bra screen1_loop2 ; no | |
376 return | |
377 | |
378 screen1_loop2: | |
379 btfsc divemode ; Divemode active? | |
380 return | |
381 btfsc switch_left ; Ack? | |
382 return | |
383 btfsc switch_right ; Ack? | |
384 return | |
385 bra screen1_loop ; loop screen | |
386 | |
387 startup_screen2: | |
388 call PLED_ClearScreen ; Page 1 | |
389 call PLED_startupscreen2 ; show startup sreen | |
390 bra startup_screen1_2 | |
391 | |
392 startup_screen3a:; WARNING: Also used for decodescriptions and CF Warning screen! | |
393 movwf temp1 | |
394 WAITMS d'200' | |
395 bcf switch_left | |
396 bcf switch_right | |
397 screen3_loop: | |
337 | 398 btfsc uart_dump_screen ; Asked to dump screen contains ? |
399 call dump_screen ; Yes! | |
400 | |
0 | 401 btfsc onesecupdate ; do every second tasks? |
402 call set_dive_modes ; tests if depth>threshold | |
403 | |
404 btfsc onesecupdate ; do every second tasks? | |
405 decf temp1,F | |
406 bcf onesecupdate ; every second tasks done | |
407 | |
408 tstfsz temp1 ; timout occured? | |
409 bra screen3_loop2 ; no | |
410 return | |
411 screen3_loop2: | |
412 btfsc switch_left ; Ack? | |
413 return | |
414 btfsc switch_right ; Ack? | |
415 return | |
416 bra screen3_loop ; loop screen | |
417 | |
337 | 418 ;============================================================================= |
419 | |
306 | 420 first_start: |
421 movlw max_custom_number ; Defined in definitions.asm | |
422 movwf EEDATA | |
423 write_int_eeprom d'92' ; Store number of CF used in this firmware | |
424 bra start3 ; continue with normal start | |
425 | |
0 | 426 init: |
466 | 427 movlw OSCCON_VALUE |
0 | 428 movwf OSCCON |
429 | |
430 movlw b'00010001' ; I/O Ports | |
431 movwf TRISA | |
432 clrf PORTA | |
433 movlw b'00000011' | |
434 movwf TRISB | |
435 clrf PORTB | |
436 movlw b'11011101' ; UART | |
437 movwf TRISC | |
438 clrf PORTC | |
439 movlw b'00000000' | |
440 movwf TRISE | |
441 clrf PORTE | |
442 movlw b'00000000' | |
443 movwf TRISD | |
444 clrf PORTD | |
445 | |
446 movlw b'01000000' ; Bit6: PPL enable | |
447 movwf OSCTUNE | |
448 | |
466 | 449 movlw T0CON_VALUE ; Timer0 |
0 | 450 movwf T0CON |
451 | |
452 movlw b'00000111' ; Timer1 | |
453 movwf T1CON | |
454 | |
455 movlw b'11010000' ; Interrups | |
456 movwf INTCON | |
457 movlw b'00000101' | |
458 movwf INTCON2 | |
459 movlw b'00001000' | |
460 movwf INTCON3 | |
461 movlw b'00100001' | |
462 movwf PIE1 | |
463 movlw b'00000000' | |
464 movwf PIE2 | |
465 clrf RCON | |
466 | |
467 movlw b'00000000' ; A/D Converter | |
468 movwf ADCON0 | |
469 movlw b'00001110' | |
470 movwf ADCON1 | |
471 movlw b'10001010' ; Right justified | |
472 movwf ADCON2 | |
473 | |
474 clrf SSPCON1 ; Set I²C Mode | |
475 movlw b'00000000' | |
476 movwf SSPSTAT | |
477 movlw b'00101000' | |
478 movwf SSPCON1 | |
479 movlw b'00000000' | |
480 movwf SSPCON2 | |
466 | 481 movlw SSPADD_VALUE ; I²C Speed |
0 | 482 movwf SSPADD |
483 | |
484 clrf CCP1CON ; PWM Module off | |
485 clrf ECCP1CON ; PWM Module off | |
486 | |
487 movlw b'00000111' ; Comperator Module off | |
488 movwf CMCON | |
489 | |
490 movlw b'00100000' | |
491 movwf CANCON ; ECAN Module OFF | |
492 | |
493 movlw b'00100100' ; UART | |
494 movwf TXSTA | |
495 movlw b'10010000' | |
496 movwf RCSTA | |
497 movlw b'00001000' | |
498 movwf BAUDCON | |
499 clrf SPBRGH | |
466 | 500 movlw SPBRG_VALUE |
0 | 501 movwf SPBRG |
502 clrf RCREG | |
503 clrf PIR1 | |
504 return |