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