annotate code_part1/OSTC_code_asm_part1/start.asm @ 12:588a969a0cae

1.53 beta rc
author heinrichsweikamp
date Wed, 24 Mar 2010 20:26:09 +0100
parents 3cf8af30b36e
children 6d1177291d38
Ignore whitespace changes - Everywhere: Within whitespace: At end of lines:
rev   line source
0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
1 ; OSTC - diving computer code
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
2 ; Copyright (C) 2008 HeinrichsWeikamp GbR
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
3
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
4 ; This program is free software: you can redistribute it and/or modify
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
5 ; it under the terms of the GNU General Public License as published by
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
6 ; the Free Software Foundation, either version 3 of the License, or
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
7 ; (at your option) any later version.
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
8
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
9 ; This program is distributed in the hope that it will be useful,
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
10 ; but WITHOUT ANY WARRANTY; without even the implied warranty of
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
11 ; MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
12 ; GNU General Public License for more details.
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
13
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
14 ; You should have received a copy of the GNU General Public License
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
15 ; along with this program. If not, see <http://www.gnu.org/licenses/>.
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
16
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
17
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
18 ; Start and init
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
19 ; written by: Matthias Heinrichs, info@heinrichsweikamp.com
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
20 ; written: 10/13/04
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
21 ; last updated: 06/24/08
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
22 ; known bugs:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
23 ; ToDo:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
24
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
25 start:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
26 movlb b'00000001' ; ram bank 1 selected
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
27 call init
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
28 btfsc divemode ; Reset from Divemode?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
29 call PLED_resetdebugger ; Yes! Something went wrong, show reset informations
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
30
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
31 clrf STKPTR ; Clear Stackpointer
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
32 lfsr FSR0, 109h ; Clear rambank 1-9, do not delete RTC registers
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
33 clear_rambank:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
34 clrf POSTINC0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
35 movlw 0x0A
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
36 cpfseq FSR0H ; Bank 9 done?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
37 bra clear_rambank ; clear...
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
38
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
39 ; Defaults for RTC
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
40 call disable_rs232 ; disable UART module
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
41 call RTCinit ; reset RTC
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
42
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
43 ; Air pressure compensation after reset
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
44 call get_calibration_data ; Get calibration data from pressure sensor
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
45
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
46 bcf pressure_refresh
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
47 wait_start_pressure:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
48 btfss pressure_refresh ; Air pressure compensation
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
49 bra wait_start_pressure
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
50
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
51 clrf rel_pressure+0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
52 clrf rel_pressure+1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
53 clrf surface_interval+0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
54 clrf surface_interval+1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
55
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
56 bsf sleepmode ; Routine only works in sleepmode...
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
57 call pressuretest_sleep_fast ; Gets pressure without averaging (faster!)
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
58 bcf sleepmode ; Normal mode again
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
59
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
60 movff amb_pressure+0,last_surfpressure+0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
61 movff amb_pressure+1,last_surfpressure+1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
62 movff amb_pressure+0,last_surfpressure_15min+0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
63 movff amb_pressure+1,last_surfpressure_15min+1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
64 movff amb_pressure+0,last_surfpressure_30min+0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
65 movff amb_pressure+1,last_surfpressure_30min+1 ; Rests all airpressure registers
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
66
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
67 ; reset deco data
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
68 incf nofly_time+0,F ; =1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
69 clrf wait_temp ; Use as buffer
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
70 movff wait_temp,char_I_He_ratio ; No He at the Surface
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
71 movlw d'79' ; 79% N2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
72 movwf wait_temp ; Use as buffer
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
73 movff wait_temp,char_I_N2_ratio ; No He at the Surface
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
74 movff amb_pressure+0,int_I_pres_respiration+0 ; copy surface air pressure to deco routine
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
75 movff amb_pressure+1,int_I_pres_respiration+1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
76
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
77 call deco_main_clear_tissue ;
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
78 movlb b'00000001' ; select ram bank 1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
79 call deco_main_calc_desaturation_time; calculate desaturation time
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
80 movlb b'00000001' ; select ram bank 1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
81 call main_clear_CNS_fraction ; clear CNS
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
82 movlb b'00000001' ; select ram bank 1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
83 call calc_deko_surfmode ; calculate desaturation every minute
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
84 movlb b'00000001' ; select ram bank 1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
85 call deco_main_calc_wo_deco_step_1_m ; calculate deco in surface mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
86 movlb b'00000001' ; select ram bank 1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
87
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
88 ; check firmware and reset Custom Functions after an update
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
89 movlw LOW 0x101
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
90 movwf EEADR
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
91 movlw HIGH 0x101
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
92 movwf EEADRH
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
93 call read_eeprom ; read current version x
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
94 movff EEDATA,temp1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
95 incf EEADR,F ; set to 0x102
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
96 call read_eeprom ; read current version y
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
97 movff EEDATA,temp2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
98 clrf EEADRH ; Reset EEADRH
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
99
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
100 movlw softwareversion_x
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
101 cpfseq temp1 ; compare version x
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
102 bra check_firmware_new ; is not equal -> reset CF and store new version in EEPROM
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
103
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
104 movlw softwareversion_y
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
105 cpfseq temp2 ; compare version y
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
106 bra check_firmware_new ; is not equal -> reset CF and store new version in EEPROM
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
107 bra restart ; x and y are equal -> do not reset cf
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
108
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
109 check_firmware_new:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
110 movlw LOW 0x101 ; store current version in EEPROM
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
111 movwf EEADR
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
112 movlw HIGH 0x101
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
113 movwf EEADRH
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
114 movlw softwareversion_x
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
115 movwf EEDATA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
116 call write_eeprom ; write version x
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
117 incf EEADR,F ; set to 0x102
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
118 movlw softwareversion_y
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
119 movwf EEDATA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
120 call write_eeprom ; write version y
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
121 clrf EEADRH ; Reset EEADRH
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
122 ; goto reset_all_cf ; resets all custom functions bank0 and bank1 and jumps to "restart"
3
3cf8af30b36e v1.51 beta
heinrichsweikamp
parents: 0
diff changeset
123 goto reset_all_cf_bank1 ; resets all custom functions bank1 and jumps to "restart"
0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
124
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
125 restart:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
126 call clear_LEDr
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
127 call clear_LEDnofly ; all LEDs off
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
128 call PLED_boot ; PLED boot (Incl. Clear Screen!)
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
129 WIN_TOP .0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
130 WIN_LEFT .0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
131 WIN_FONT FT_SMALL
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
132 WIN_INVERT .0 ; Init new Wordprocessor
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
133 movlw 0xFF
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
134 movwf oled1_temp
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
135 movff oled1_temp,win_color1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
136 movlw 0xFF
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
137 movwf oled1_temp
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
138 movff oled1_temp,win_color2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
139 call I2CReset ; Just in Case any I2C device blocks the Bus
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
140 movff last_surfpressure_30min+0,last_surfpressure+0 ; Use 30min old airpressure
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
141 movff last_surfpressure_30min+1,last_surfpressure+1 ; Use 30min old airpressure
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
142
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
143 ; Check if new CF were added in the last firmware version
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
144 clrf EEADRH
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
145 read_int_eeprom d'92' ; Read number of CF used in this firmware
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
146 movlw max_custom_number ; Defined in definitions.asm
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
147 cpfseq EEDATA ; Compare with last version
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
148 bra restart_01 ; New CF, show warning and store new number
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
149 bra restart_1 ; No new CF, continue with boot
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
150 restart_01:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
151 ; Save new number of current CF count
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
152 rcall display_new_cf_installed; Show warning
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
153 movlw max_custom_number ; Defined in definitions.asm
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
154 movwf EEDATA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
155 write_int_eeprom d'92' ; Store number of CF used in this firmware
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
156
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
157 restart_1:
12
588a969a0cae 1.53 beta rc
heinrichsweikamp
parents: 3
diff changeset
158 btfss pressure_refresh ; Wait for pressure sensor...
588a969a0cae 1.53 beta rc
heinrichsweikamp
parents: 3
diff changeset
159 bra restart_1 ; loop until pressure and temp stable
0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
160
12
588a969a0cae 1.53 beta rc
heinrichsweikamp
parents: 3
diff changeset
161 ; call startup_screen3 ;splash screen
588a969a0cae 1.53 beta rc
heinrichsweikamp
parents: 3
diff changeset
162 ; GETCUSTOM15 .31
588a969a0cae 1.53 beta rc
heinrichsweikamp
parents: 3
diff changeset
163 ; movlw LOW .666
588a969a0cae 1.53 beta rc
heinrichsweikamp
parents: 3
diff changeset
164 ; cpfseq lo
588a969a0cae 1.53 beta rc
heinrichsweikamp
parents: 3
diff changeset
165 ; bra restart_2 ; Not equal!
588a969a0cae 1.53 beta rc
heinrichsweikamp
parents: 3
diff changeset
166 ; movlw HIGH .666
588a969a0cae 1.53 beta rc
heinrichsweikamp
parents: 3
diff changeset
167 ; cpfseq hi
588a969a0cae 1.53 beta rc
heinrichsweikamp
parents: 3
diff changeset
168 ; bra restart_2 ; Not equal!
588a969a0cae 1.53 beta rc
heinrichsweikamp
parents: 3
diff changeset
169 ; bra restart_3 ; Skip screen....
588a969a0cae 1.53 beta rc
heinrichsweikamp
parents: 3
diff changeset
170 ;
588a969a0cae 1.53 beta rc
heinrichsweikamp
parents: 3
diff changeset
171 ;restart_2:
588a969a0cae 1.53 beta rc
heinrichsweikamp
parents: 3
diff changeset
172 ; btfsc show_startup_screen ; Show start screen?
588a969a0cae 1.53 beta rc
heinrichsweikamp
parents: 3
diff changeset
173 ; call startup_screen1 ;1/2
588a969a0cae 1.53 beta rc
heinrichsweikamp
parents: 3
diff changeset
174 ; btfsc show_startup_screen ; Show start screen?
588a969a0cae 1.53 beta rc
heinrichsweikamp
parents: 3
diff changeset
175 ; call startup_screen2 ;2/2
588a969a0cae 1.53 beta rc
heinrichsweikamp
parents: 3
diff changeset
176 ;
588a969a0cae 1.53 beta rc
heinrichsweikamp
parents: 3
diff changeset
177 ;restart_3:
0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
178 clrf flag1 ; clear all flags
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
179 clrf flag2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
180 clrf flag3
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
181 clrf flag4
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
182 clrf flag5
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
183 clrf flag6
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
184 clrf flag7
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
185 clrf flag8
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
186 clrf flag9
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
187 clrf flag10
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
188 clrf flag11
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
189 clrf flag12
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
190 clrf flag13
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
191 clrf flag14
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
192 clrf flag15
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
193
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
194 ; Set Debug mode?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
195 read_int_eeprom d'39'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
196 bsf debug_mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
197 movlw d'1'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
198 cpfseq EEDATA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
199 bcf debug_mode ; clear flag if <> 1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
200
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
201 goto surfloop ; Jump to Surfaceloop!
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
202
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
203
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
204 display_new_cf_installed:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
205 call PLED_new_cf_warning ; Display new CF warning screen
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
206 movlw d'20' ; timeout for warning screen
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
207 bra startup_screen3a ; Will RETURN after timeout or button press
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
208
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
209 restart_set_modes_and_flags: ; "Call"ed from divemode, as well!
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
210 bcf gauge_mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
211 bcf FLAG_const_ppO2_mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
212 bcf FLAG_apnoe_mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
213 clrf EEADRH
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
214 read_int_eeprom d'34' ; Read deco data
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
215 movlw d'1' ; Gauge mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
216 cpfseq EEDATA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
217 bra restart_3_test_ppO2_mode; check for ppO2 mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
218 bsf gauge_mode ; Set flag for gauge mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
219 movlw d'0'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
220 movwf wait_temp
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
221 movff wait_temp,char_I_deco_model ; Clear Flagbyte
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
222 return ; start in Surfacemode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
223 restart_3_test_ppO2_mode:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
224 movlw d'2' ; const ppO2 mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
225 cpfseq EEDATA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
226 bra restart_3_test_apnoe_mode; check for apnoe mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
227 bsf FLAG_const_ppO2_mode ; Set flag for ppO2 mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
228 movlw d'0'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
229 movwf wait_temp
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
230 movff wait_temp,char_I_deco_model ; Clear Flagbyte
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
231 return ; start in Surfacemode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
232 restart_3_test_apnoe_mode:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
233 movlw d'3' ; Apnoe mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
234 cpfseq EEDATA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
235 bra restart_4_test_gf_mode ; check for GF OC mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
236 bsf FLAG_apnoe_mode ; Set flag for Apnoe Mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
237 movlw d'0'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
238 movwf wait_temp
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
239 movff wait_temp,char_I_deco_model ; Clear Flagbyte
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
240 return ; start in Surfacemode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
241 restart_4_test_gf_mode:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
242 movlw d'4' ; GF OC mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
243 cpfseq EEDATA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
244 bra restart_5_test_gfO2_mode; check for GF CC mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
245 movlw d'1'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
246 movwf wait_temp
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
247 movff wait_temp,char_I_deco_model ; Set Flagbyte for GF method
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
248 return ; start in Surfacemode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
249 restart_5_test_gfO2_mode:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
250 movlw d'5' ; GF CC mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
251 cpfseq EEDATA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
252 return ; Start in Surfacemode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
253 bsf FLAG_const_ppO2_mode ; Set flag for ppO2 mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
254 movlw d'1'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
255 movwf wait_temp
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
256 movff wait_temp,char_I_deco_model ; Set Flagbyte for GF method
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
257 return ; start in Surfacemode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
258
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
259 startup_screen1:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
260 call PLED_ClearScreen
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
261 call PLED_startupscreen1 ; show startup sreen
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
262 startup_screen1_2:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
263 movlw d'10' ; timeout for startup screen
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
264 movwf temp1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
265 WAITMS d'200'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
266 bcf switch_left
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
267 bcf switch_right
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
268 screen1_loop:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
269 btfsc onesecupdate ; do every second tasks?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
270 call set_dive_modes ; tests if depth>threshold
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
271 btfsc onesecupdate ; do every second tasks?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
272 decf temp1,F
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
273 bcf onesecupdate ; every second tasks done
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
274
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
275 tstfsz temp1 ; timout occured?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
276 bra screen1_loop2 ; no
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
277 return
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
278
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
279 screen1_loop2:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
280 btfsc divemode ; Divemode active?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
281 return
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
282 btfsc switch_left ; Ack?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
283 return
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
284 btfsc switch_right ; Ack?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
285 return
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
286 bra screen1_loop ; loop screen
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
287
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
288 startup_screen2:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
289 call PLED_ClearScreen ; Page 1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
290 call PLED_startupscreen2 ; show startup sreen
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
291 bra startup_screen1_2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
292
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
293 startup_screen3a:; WARNING: Also used for decodescriptions and CF Warning screen!
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
294 movwf temp1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
295 WAITMS d'200'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
296 bcf switch_left
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
297 bcf switch_right
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
298 screen3_loop:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
299 btfsc onesecupdate ; do every second tasks?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
300 call set_dive_modes ; tests if depth>threshold
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
301
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
302 btfsc onesecupdate ; do every second tasks?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
303 decf temp1,F
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
304 bcf onesecupdate ; every second tasks done
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
305
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
306 tstfsz temp1 ; timout occured?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
307 bra screen3_loop2 ; no
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
308 return
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
309 screen3_loop2:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
310 btfsc switch_left ; Ack?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
311 return
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
312 btfsc switch_right ; Ack?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
313 return
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
314 bra screen3_loop ; loop screen
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
315
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
316 init:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
317 movlw b'01101100' ; 4MHz (x4 PLL)
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
318 movwf OSCCON
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
319
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
320 movlw b'00010001' ; I/O Ports
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
321 movwf TRISA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
322 clrf PORTA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
323 movlw b'00000011'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
324 movwf TRISB
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
325 clrf PORTB
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
326 movlw b'11011101' ; UART
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
327 movwf TRISC
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
328 clrf PORTC
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
329 movlw b'00000000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
330 movwf TRISE
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
331 clrf PORTE
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
332 movlw b'00000000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
333 movwf TRISD
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
334 clrf PORTD
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
335
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
336 movlw b'01000000' ; Bit6: PPL enable
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
337 movwf OSCTUNE
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
338
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
339 movlw b'00011111' ; Timer0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
340 movwf T0CON
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
341
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
342 movlw b'00000111' ; Timer1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
343 movwf T1CON
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
344
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
345 movlw b'11010000' ; Interrups
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
346 movwf INTCON
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
347 movlw b'00000101'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
348 movwf INTCON2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
349 movlw b'00001000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
350 movwf INTCON3
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
351 movlw b'00100001'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
352 movwf PIE1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
353 movlw b'00000000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
354 movwf PIE2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
355 clrf RCON
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
356
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
357 movlw b'00000000' ; A/D Converter
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
358 movwf ADCON0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
359 movlw b'00001110'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
360 movwf ADCON1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
361 movlw b'10001010' ; Right justified
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
362 movwf ADCON2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
363
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
364 clrf SSPCON1 ; Set I²C Mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
365 movlw b'00000000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
366 movwf SSPSTAT
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
367 movlw b'00101000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
368 movwf SSPCON1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
369 movlw b'00000000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
370 movwf SSPCON2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
371 movlw d'8' ; 400kHz I2C clock @ 16MHz Fcy
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
372 movwf SSPADD
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
373
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
374 clrf CCP1CON ; PWM Module off
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
375 clrf ECCP1CON ; PWM Module off
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
376
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
377 movlw b'00000111' ; Comperator Module off
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
378 movwf CMCON
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
379
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
380 movlw b'00100000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
381 movwf CANCON ; ECAN Module OFF
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
382
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
383 movlw b'00100100' ; UART
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
384 movwf TXSTA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
385 movlw b'10010000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
386 movwf RCSTA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
387 movlw b'00001000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
388 movwf BAUDCON
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
389 clrf SPBRGH
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
390 movlw d'34'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
391 movwf SPBRG
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
392 clrf RCREG
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
393 clrf PIR1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
394 return