Mercurial > public > mk2
annotate code_part1/OSTC_code_asm_part1/start.asm @ 342:06299199dfb9
Fix bad max depth value (fix sub16 to avoid trashing sub_b).
author | JeanDo |
---|---|
date | Fri, 20 May 2011 01:34:59 +0200 |
parents | 2144f19fa1eb |
children | 797e2ac42d24 |
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 |
29 | |
0 | 30 call init |
306 | 31 |
32 read_int_eeprom d'92' ; Read number of CF used in this firmware | |
33 movlw 0xFF ; First start value | |
34 cpfseq EEDATA ; Compare | |
35 bra start2 ; Normal power-on/hard reset boot | |
36 bra first_start ; Reset and jump to surfmode | |
37 start2: | |
0 | 38 btfsc divemode ; Reset from Divemode? |
39 call PLED_resetdebugger ; Yes! Something went wrong, show reset informations | |
306 | 40 start3: |
0 | 41 clrf STKPTR ; Clear Stackpointer |
98
6f8e3a08011e
1.73beta rc1 (Added new customview for divemode)
heinrichsweikamp
parents:
97
diff
changeset
|
42 lfsr FSR0, 10Bh ; Clear rambank 1-9, do not delete RTC registers |
0 | 43 clear_rambank: |
44 clrf POSTINC0 | |
45 movlw 0x0A | |
46 cpfseq FSR0H ; Bank 9 done? | |
47 bra clear_rambank ; clear... | |
48 | |
49 ; Defaults for RTC | |
50 call disable_rs232 ; disable UART module | |
51 call RTCinit ; reset RTC | |
52 | |
53 ; Air pressure compensation after reset | |
54 call get_calibration_data ; Get calibration data from pressure sensor | |
55 | |
56 bcf pressure_refresh | |
57 wait_start_pressure: | |
58 btfss pressure_refresh ; Air pressure compensation | |
59 bra wait_start_pressure | |
60 | |
61 clrf rel_pressure+0 | |
62 clrf rel_pressure+1 | |
63 clrf surface_interval+0 | |
64 clrf surface_interval+1 | |
65 | |
66 bsf sleepmode ; Routine only works in sleepmode... | |
67 call pressuretest_sleep_fast ; Gets pressure without averaging (faster!) | |
68 bcf sleepmode ; Normal mode again | |
233 | 69 |
341
2144f19fa1eb
BUGFIX protect against ISR changing pressure/temperature while reading it.
JeanDo
parents:
327
diff
changeset
|
70 SAFE_2BYTE_COPY amb_pressure, last_surfpressure |
2144f19fa1eb
BUGFIX protect against ISR changing pressure/temperature while reading it.
JeanDo
parents:
327
diff
changeset
|
71 movff last_surfpressure+0,last_surfpressure_15min+0 |
2144f19fa1eb
BUGFIX protect against ISR changing pressure/temperature while reading it.
JeanDo
parents:
327
diff
changeset
|
72 movff last_surfpressure+1,last_surfpressure_15min+1 |
2144f19fa1eb
BUGFIX protect against ISR changing pressure/temperature while reading it.
JeanDo
parents:
327
diff
changeset
|
73 movff last_surfpressure+0,last_surfpressure_30min+0 |
2144f19fa1eb
BUGFIX protect against ISR changing pressure/temperature while reading it.
JeanDo
parents:
327
diff
changeset
|
74 movff last_surfpressure+1,last_surfpressure_30min+1 ; Rests all airpressure registers |
0 | 75 |
233 | 76 ; Extra power-up reset (JeanDo) |
77 ifdef TESTING | |
78 call do_menu_reset_all2 | |
79 endif | |
80 | |
0 | 81 ; reset deco data |
236 | 82 ostc_debug '0' ; Sends debug-information to screen if debugmode active |
83 | |
0 | 84 movlw d'79' ; 79% N2 |
197 | 85 movff WREG,char_I_N2_ratio ; No He at the Surface |
236 | 86 clrf WREG ; Use as buffer |
87 movff WREG,char_I_He_ratio ; No He at the Surface | |
88 movff WREG,char_I_step_is_1min ; 2 second deco mode | |
89 GETCUSTOM8 d'11' ; Saturation multiplier % | |
90 movff WREG,char_I_saturation_multiplier | |
91 GETCUSTOM8 d'12' ; Desaturation multiplier % | |
92 movff WREG,char_I_desaturation_multiplier | |
341
2144f19fa1eb
BUGFIX protect against ISR changing pressure/temperature while reading it.
JeanDo
parents:
327
diff
changeset
|
93 SAFE_2BYTE_COPY amb_pressure,int_I_pres_respiration ; copy for deco routine |
2144f19fa1eb
BUGFIX protect against ISR changing pressure/temperature while reading it.
JeanDo
parents:
327
diff
changeset
|
94 movff int_I_pres_respiration+0,int_I_pres_surface+0 ; copy for desat routine |
2144f19fa1eb
BUGFIX protect against ISR changing pressure/temperature while reading it.
JeanDo
parents:
327
diff
changeset
|
95 movff int_I_pres_respiration+1,int_I_pres_surface+1 |
0 | 96 |
116 | 97 call deco_clear_tissue ; |
98 call deco_calc_desaturation_time ; calculate desaturation time | |
99 call deco_clear_CNS_fraction ; clear CNS | |
0 | 100 call calc_deko_surfmode ; calculate desaturation every minute |
116 | 101 call deco_calc_wo_deco_step_1_min ; calculate deco in surface mode |
0 | 102 movlb b'00000001' ; select ram bank 1 |
103 | |
104 ; check firmware and reset Custom Functions after an update | |
105 movlw LOW 0x101 | |
106 movwf EEADR | |
107 movlw HIGH 0x101 | |
108 movwf EEADRH | |
109 call read_eeprom ; read current version x | |
110 movff EEDATA,temp1 | |
111 incf EEADR,F ; set to 0x102 | |
112 call read_eeprom ; read current version y | |
113 movff EEDATA,temp2 | |
114 clrf EEADRH ; Reset EEADRH | |
115 | |
116 movlw softwareversion_x | |
117 cpfseq temp1 ; compare version x | |
118 bra check_firmware_new ; is not equal -> reset CF and store new version in EEPROM | |
119 | |
120 movlw softwareversion_y | |
121 cpfseq temp2 ; compare version y | |
122 bra check_firmware_new ; is not equal -> reset CF and store new version in EEPROM | |
123 bra restart ; x and y are equal -> do not reset cf | |
124 | |
125 check_firmware_new: | |
126 movlw LOW 0x101 ; store current version in EEPROM | |
127 movwf EEADR | |
128 movlw HIGH 0x101 | |
129 movwf EEADRH | |
130 movlw softwareversion_x | |
131 movwf EEDATA | |
132 call write_eeprom ; write version x | |
133 incf EEADR,F ; set to 0x102 | |
134 movlw softwareversion_y | |
135 movwf EEDATA | |
136 call write_eeprom ; write version y | |
137 clrf EEADRH ; Reset EEADRH | |
327
6544f79e298c
Preparations for stable release (CF reset)
heinrichsweikamp
parents:
308
diff
changeset
|
138 goto reset_all_cf ; resets all custom functions bank0 and bank1 and jumps to "restart" |
0 | 139 |
140 restart: | |
21 | 141 bcf LED_red |
142 bcf LED_blue ; all LEDs off | |
43 | 143 GETCUSTOM8 d'48' ; time correction value |
144 movff WREG, time_correction_value ; store in Bank0 register | |
15 | 145 |
146 clrf flag1 ; clear all flags | |
147 clrf flag2 | |
148 clrf flag3 | |
149 clrf flag4 | |
150 clrf flag5 | |
151 clrf flag6 | |
152 clrf flag7 | |
153 clrf flag8 | |
154 clrf flag9 | |
155 clrf flag10 | |
156 clrf flag11 | |
157 clrf flag12 | |
158 clrf flag13 | |
159 clrf flag14 | |
160 clrf flag15 | |
153 | 161 |
169
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
167
diff
changeset
|
162 ; Should we set win_flip_screen ? |
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
167
diff
changeset
|
163 bsf flag1,0 ; Precondition to yes |
153 | 164 clrf EEADRH ; Reset EEADRH |
165 read_int_eeprom d'1' | |
166 movlw .7 | |
169
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
167
diff
changeset
|
167 cpfsgt EEDATA ; serial > 2048 (Mk2n hardware) ? |
153 | 168 bcf flag1,0 |
169
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
167
diff
changeset
|
169 incf EEDATA,W ; serial == 65535 (emulation) ? |
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
167
diff
changeset
|
170 btfsc STATUS,Z |
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
167
diff
changeset
|
171 bcf flag1,0 |
153 | 172 movff flag1,win_flags ; store in Bank0 register |
173 clrf flag1 ; Clear flag1 (again) | |
239 | 174 |
175 ; Select high altitude (Fly) mode? | |
176 movff last_surfpressure_30min+0,sub_b+0 | |
177 movff last_surfpressure_30min+1,sub_b+1 | |
178 movlw HIGH d'880' | |
179 movwf sub_a+1 | |
180 movlw LOW d'880' ; Hard-wired 880mBar | |
181 movwf sub_a+0 | |
182 call sub16 ; sub_c = sub_a - sub_b | |
183 btfss neg_flag ; Result negative (Ambient>880mBar)? | |
184 bsf high_altitude_mode ; No, Set Flag! | |
169
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
167
diff
changeset
|
185 |
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
167
diff
changeset
|
186 ; Should we disable sleep (hardware emulator) |
154 | 187 movlw .0 |
188 cpfsgt EEDATA ; >256 | |
167 | 189 bsf nsm ; NO-SLEEP-MODE : for hardware debugging |
153 | 190 |
142 | 191 call gassetup_sort_gaslist ; Sorts Gaslist according to change depth |
0 | 192 WIN_TOP .0 |
193 WIN_LEFT .0 | |
194 WIN_FONT FT_SMALL | |
195 WIN_INVERT .0 ; Init new Wordprocessor | |
83
3e351e25f5d1
adding anti-aliased fonts frame and merging some patches from Jeando
heinrichsweikamp
parents:
62
diff
changeset
|
196 setf WREG |
3e351e25f5d1
adding anti-aliased fonts frame and merging some patches from Jeando
heinrichsweikamp
parents:
62
diff
changeset
|
197 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
|
198 movff WREG,win_color2 |
0 | 199 call I2CReset ; Just in Case any I2C device blocks the Bus |
200 movff last_surfpressure_30min+0,last_surfpressure+0 ; Use 30min old airpressure | |
201 movff last_surfpressure_30min+1,last_surfpressure+1 ; Use 30min old airpressure | |
202 | |
203 ; Check if new CF were added in the last firmware version | |
204 clrf EEADRH | |
205 read_int_eeprom d'92' ; Read number of CF used in this firmware | |
206 movlw max_custom_number ; Defined in definitions.asm | |
207 cpfseq EEDATA ; Compare with last version | |
208 bra restart_01 ; New CF, show warning and store new number | |
209 bra restart_1 ; No new CF, continue with boot | |
210 restart_01: | |
211 ; Save new number of current CF count | |
255
1efd59d689f8
small change in the set time menu, default setpoints set to 0.8, 1.0 and 1.2Bar
heinrichsweikamp
parents:
239
diff
changeset
|
212 call PLED_boot ; PLED boot (Incl. Clear Screen!) |
0 | 213 rcall display_new_cf_installed; Show warning |
214 movlw max_custom_number ; Defined in definitions.asm | |
215 movwf EEDATA | |
216 write_int_eeprom d'92' ; Store number of CF used in this firmware | |
217 | |
218 restart_1: | |
219 | |
220 ; Set Debug mode? | |
221 read_int_eeprom d'39' | |
222 bsf debug_mode | |
223 movlw d'1' | |
224 cpfseq EEDATA | |
225 bcf debug_mode ; clear flag if <> 1 | |
226 | |
227 goto surfloop ; Jump to Surfaceloop! | |
228 | |
229 | |
230 display_new_cf_installed: | |
231 call PLED_new_cf_warning ; Display new CF warning screen | |
232 movlw d'20' ; timeout for warning screen | |
233 bra startup_screen3a ; Will RETURN after timeout or button press | |
197 | 234 |
235 ;============================================================================= | |
236 ; Setup all flags and parameters for divemode and simulator computations. | |
237 ; | |
238 restart_set_modes_and_flags: ; "Call"ed from divemode, as well! | |
0 | 239 bcf gauge_mode |
240 bcf FLAG_const_ppO2_mode | |
241 bcf FLAG_apnoe_mode | |
45 | 242 |
243 ; Pre-load modes for OC, GF 90/90 and no Aponoe or Gauge. | |
197 | 244 bcf no_deco_customviews ; Clear no-deco-mode-flag |
45 | 245 movlw d'0' |
197 | 246 movff WREG,char_I_deco_model ; Clear Flagbyte |
45 | 247 ; Load GF values into RAM |
248 movlw d'90' | |
197 | 249 movff WREG,char_I_GF_Low_percentage |
250 movff WREG,char_I_GF_High_percentage ; Set to 90/90... | |
0 | 251 clrf EEADRH |
197 | 252 read_int_eeprom d'34' ; Read deco data |
253 movlw d'1' ; Gauge mode | |
0 | 254 cpfseq EEDATA |
197 | 255 bra restart_3_test_ppO2_mode ; check for ppO2 mode |
256 bsf gauge_mode ; Set flag for gauge mode | |
257 bsf no_deco_customviews ; Set no-deco-mode-flag | |
258 return ; start in Surfacemode | |
0 | 259 restart_3_test_ppO2_mode: |
197 | 260 movlw d'2' ; const ppO2 mode |
0 | 261 cpfseq EEDATA |
197 | 262 bra restart_3_test_apnoe_mode; check for apnoe mode |
263 bsf FLAG_const_ppO2_mode ; Set flag for ppO2 mode | |
264 return ; start in Surfacemode | |
0 | 265 restart_3_test_apnoe_mode: |
197 | 266 movlw d'3' ; Apnoe mode |
0 | 267 cpfseq EEDATA |
197 | 268 bra restart_4_test_gf_mode ; check for GF OC mode |
269 bsf FLAG_apnoe_mode ; Set flag for Apnoe Mode | |
270 bsf no_deco_customviews ; Set no-deco-mode-flag | |
271 return ; start in Surfacemode | |
0 | 272 restart_4_test_gf_mode: |
197 | 273 movlw d'4' ; GF OC mode |
0 | 274 cpfseq EEDATA |
197 | 275 bra restart_5_test_gfO2_mode ; check for GF CC mode |
0 | 276 movlw d'1' |
197 | 277 movff WREG,char_I_deco_model ; Set Flagbyte for GF method |
45 | 278 ; Load GF values into RAM |
197 | 279 GETCUSTOM8 d'32' ; GF low |
280 movff EEDATA,char_I_GF_Low_percentage | |
281 GETCUSTOM8 d'33' ; GF high | |
282 movff EEDATA,char_I_GF_High_percentage | |
283 return ; start in Surfacemode | |
0 | 284 restart_5_test_gfO2_mode: |
197 | 285 movlw d'5' ; GF CC mode |
0 | 286 cpfseq EEDATA |
197 | 287 return ; Start in Surfacemode |
288 bsf FLAG_const_ppO2_mode ; Set flag for ppO2 mode | |
0 | 289 movlw d'1' |
197 | 290 movff WREG,char_I_deco_model ; Set Flagbyte for GF method |
137 | 291 ; Load GF values into RAM |
197 | 292 GETCUSTOM8 d'32' ; GF low |
163 | 293 movff EEDATA,char_I_GF_Low_percentage |
197 | 294 GETCUSTOM8 d'33' ; GF high |
163 | 295 movff EEDATA,char_I_GF_High_percentage |
197 | 296 return ; start in Surfacemode |
297 | |
298 ;============================================================================= | |
0 | 299 |
300 startup_screen1: | |
301 call PLED_ClearScreen | |
302 call PLED_startupscreen1 ; show startup sreen | |
303 startup_screen1_2: | |
304 movlw d'10' ; timeout for startup screen | |
305 movwf temp1 | |
306 WAITMS d'200' | |
307 bcf switch_left | |
308 bcf switch_right | |
309 screen1_loop: | |
310 btfsc onesecupdate ; do every second tasks? | |
311 call set_dive_modes ; tests if depth>threshold | |
312 btfsc onesecupdate ; do every second tasks? | |
313 decf temp1,F | |
314 bcf onesecupdate ; every second tasks done | |
315 | |
316 tstfsz temp1 ; timout occured? | |
317 bra screen1_loop2 ; no | |
318 return | |
319 | |
320 screen1_loop2: | |
321 btfsc divemode ; Divemode active? | |
322 return | |
323 btfsc switch_left ; Ack? | |
324 return | |
325 btfsc switch_right ; Ack? | |
326 return | |
327 bra screen1_loop ; loop screen | |
328 | |
329 startup_screen2: | |
330 call PLED_ClearScreen ; Page 1 | |
331 call PLED_startupscreen2 ; show startup sreen | |
332 bra startup_screen1_2 | |
333 | |
334 startup_screen3a:; WARNING: Also used for decodescriptions and CF Warning screen! | |
335 movwf temp1 | |
336 WAITMS d'200' | |
337 bcf switch_left | |
338 bcf switch_right | |
339 screen3_loop: | |
340 btfsc onesecupdate ; do every second tasks? | |
341 call set_dive_modes ; tests if depth>threshold | |
342 | |
343 btfsc onesecupdate ; do every second tasks? | |
344 decf temp1,F | |
345 bcf onesecupdate ; every second tasks done | |
346 | |
347 tstfsz temp1 ; timout occured? | |
348 bra screen3_loop2 ; no | |
349 return | |
350 screen3_loop2: | |
351 btfsc switch_left ; Ack? | |
352 return | |
353 btfsc switch_right ; Ack? | |
354 return | |
355 bra screen3_loop ; loop screen | |
356 | |
306 | 357 first_start: |
358 movlw max_custom_number ; Defined in definitions.asm | |
359 movwf EEDATA | |
360 write_int_eeprom d'92' ; Store number of CF used in this firmware | |
361 bra start3 ; continue with normal start | |
362 | |
0 | 363 init: |
364 movlw b'01101100' ; 4MHz (x4 PLL) | |
365 movwf OSCCON | |
366 | |
367 movlw b'00010001' ; I/O Ports | |
368 movwf TRISA | |
369 clrf PORTA | |
370 movlw b'00000011' | |
371 movwf TRISB | |
372 clrf PORTB | |
373 movlw b'11011101' ; UART | |
374 movwf TRISC | |
375 clrf PORTC | |
376 movlw b'00000000' | |
377 movwf TRISE | |
378 clrf PORTE | |
379 movlw b'00000000' | |
380 movwf TRISD | |
381 clrf PORTD | |
382 | |
383 movlw b'01000000' ; Bit6: PPL enable | |
384 movwf OSCTUNE | |
385 | |
386 movlw b'00011111' ; Timer0 | |
387 movwf T0CON | |
388 | |
389 movlw b'00000111' ; Timer1 | |
390 movwf T1CON | |
391 | |
392 movlw b'11010000' ; Interrups | |
393 movwf INTCON | |
394 movlw b'00000101' | |
395 movwf INTCON2 | |
396 movlw b'00001000' | |
397 movwf INTCON3 | |
398 movlw b'00100001' | |
399 movwf PIE1 | |
400 movlw b'00000000' | |
401 movwf PIE2 | |
402 clrf RCON | |
403 | |
404 movlw b'00000000' ; A/D Converter | |
405 movwf ADCON0 | |
406 movlw b'00001110' | |
407 movwf ADCON1 | |
408 movlw b'10001010' ; Right justified | |
409 movwf ADCON2 | |
410 | |
411 clrf SSPCON1 ; Set I²C Mode | |
412 movlw b'00000000' | |
413 movwf SSPSTAT | |
414 movlw b'00101000' | |
415 movwf SSPCON1 | |
416 movlw b'00000000' | |
417 movwf SSPCON2 | |
418 movlw d'8' ; 400kHz I2C clock @ 16MHz Fcy | |
419 movwf SSPADD | |
420 | |
421 clrf CCP1CON ; PWM Module off | |
422 clrf ECCP1CON ; PWM Module off | |
423 | |
424 movlw b'00000111' ; Comperator Module off | |
425 movwf CMCON | |
426 | |
427 movlw b'00100000' | |
428 movwf CANCON ; ECAN Module OFF | |
429 | |
430 movlw b'00100100' ; UART | |
431 movwf TXSTA | |
432 movlw b'10010000' | |
433 movwf RCSTA | |
434 movlw b'00001000' | |
435 movwf BAUDCON | |
436 clrf SPBRGH | |
437 movlw d'34' | |
438 movwf SPBRG | |
439 clrf RCREG | |
440 clrf PIR1 | |
441 return |