annotate code_part1/OSTC_code_asm_part1/start.asm @ 7:5c4ba624165d

cf32 bug fixed
author heinrichsweikamp
date Wed, 24 Feb 2010 13:33:17 +0100
parents 3cf8af30b36e
children 588a969a0cae
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:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
158 GETCUSTOM15 .31
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
159 movlw LOW .666
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
160 cpfseq lo
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
161 bra restart_2 ; Not equal!
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
162 movlw HIGH .666
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
163 cpfseq hi
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
164 bra restart_2 ; Not equal!
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
165 bra restart_3 ; Skip screen....
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
166
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
167 restart_2:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
168 btfsc show_startup_screen ; Show start screen?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
169 call startup_screen1 ;1/2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
170 btfsc show_startup_screen ; Show start screen?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
171 call startup_screen2 ;2/2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
172
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
173 restart_3:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
174 clrf flag1 ; clear all flags
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
175 clrf flag2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
176 clrf flag3
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
177 clrf flag4
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
178 clrf flag5
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
179 clrf flag6
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
180 clrf flag7
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
181 clrf flag8
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
182 clrf flag9
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
183 clrf flag10
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
184 clrf flag11
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
185 clrf flag12
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
186 clrf flag13
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
187 clrf flag14
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
188 clrf flag15
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
189
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
190 ; Set Debug mode?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
191 read_int_eeprom d'39'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
192 bsf debug_mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
193 movlw d'1'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
194 cpfseq EEDATA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
195 bcf debug_mode ; clear flag if <> 1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
196
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
197 goto surfloop ; Jump to Surfaceloop!
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
198
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
199
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
200 display_new_cf_installed:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
201 call PLED_new_cf_warning ; Display new CF warning screen
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
202 movlw d'20' ; timeout for warning screen
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
203 bra startup_screen3a ; Will RETURN after timeout or button press
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
204
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
205 restart_set_modes_and_flags: ; "Call"ed from divemode, as well!
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
206 bcf gauge_mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
207 bcf FLAG_const_ppO2_mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
208 bcf FLAG_apnoe_mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
209 clrf EEADRH
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
210 read_int_eeprom d'34' ; Read deco data
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
211 movlw d'1' ; Gauge mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
212 cpfseq EEDATA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
213 bra restart_3_test_ppO2_mode; check for ppO2 mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
214 bsf gauge_mode ; Set flag for gauge mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
215 movlw d'0'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
216 movwf wait_temp
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
217 movff wait_temp,char_I_deco_model ; Clear Flagbyte
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
218 return ; start in Surfacemode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
219 restart_3_test_ppO2_mode:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
220 movlw d'2' ; const ppO2 mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
221 cpfseq EEDATA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
222 bra restart_3_test_apnoe_mode; check for apnoe mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
223 bsf FLAG_const_ppO2_mode ; Set flag for ppO2 mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
224 movlw d'0'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
225 movwf wait_temp
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
226 movff wait_temp,char_I_deco_model ; Clear Flagbyte
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
227 return ; start in Surfacemode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
228 restart_3_test_apnoe_mode:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
229 movlw d'3' ; Apnoe mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
230 cpfseq EEDATA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
231 bra restart_4_test_gf_mode ; check for GF OC mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
232 bsf FLAG_apnoe_mode ; Set flag for Apnoe Mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
233 movlw d'0'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
234 movwf wait_temp
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
235 movff wait_temp,char_I_deco_model ; Clear Flagbyte
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
236 return ; start in Surfacemode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
237 restart_4_test_gf_mode:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
238 movlw d'4' ; GF OC mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
239 cpfseq EEDATA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
240 bra restart_5_test_gfO2_mode; check for GF CC mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
241 movlw d'1'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
242 movwf wait_temp
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
243 movff wait_temp,char_I_deco_model ; Set Flagbyte for GF method
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
244 return ; start in Surfacemode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
245 restart_5_test_gfO2_mode:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
246 movlw d'5' ; GF CC mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
247 cpfseq EEDATA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
248 return ; Start in Surfacemode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
249 bsf FLAG_const_ppO2_mode ; Set flag for ppO2 mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
250 movlw d'1'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
251 movwf wait_temp
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
252 movff wait_temp,char_I_deco_model ; Set Flagbyte for GF method
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
253 return ; start in Surfacemode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
254
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
255 startup_screen1:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
256 call PLED_ClearScreen
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
257 call PLED_startupscreen1 ; show startup sreen
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
258 startup_screen1_2:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
259 movlw d'10' ; timeout for startup screen
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
260 movwf temp1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
261 WAITMS d'200'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
262 bcf switch_left
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
263 bcf switch_right
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
264 screen1_loop:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
265 btfsc onesecupdate ; do every second tasks?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
266 call set_dive_modes ; tests if depth>threshold
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
267 btfsc onesecupdate ; do every second tasks?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
268 decf temp1,F
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
269 bcf onesecupdate ; every second tasks done
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
270
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
271 tstfsz temp1 ; timout occured?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
272 bra screen1_loop2 ; no
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
273 return
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
274
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
275 screen1_loop2:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
276 btfsc divemode ; Divemode active?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
277 return
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
278 btfsc switch_left ; Ack?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
279 return
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
280 btfsc switch_right ; Ack?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
281 return
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
282 bra screen1_loop ; loop screen
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
283
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
284 startup_screen2:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
285 call PLED_ClearScreen ; Page 1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
286 call PLED_startupscreen2 ; show startup sreen
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
287 bra startup_screen1_2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
288
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
289 startup_screen3a:; WARNING: Also used for decodescriptions and CF Warning screen!
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
290 movwf temp1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
291 WAITMS d'200'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
292 bcf switch_left
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
293 bcf switch_right
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
294 screen3_loop:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
295 btfsc onesecupdate ; do every second tasks?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
296 call set_dive_modes ; tests if depth>threshold
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
297
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
298 btfsc onesecupdate ; do every second tasks?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
299 decf temp1,F
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
300 bcf onesecupdate ; every second tasks done
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
301
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
302 tstfsz temp1 ; timout occured?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
303 bra screen3_loop2 ; no
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
304 return
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
305 screen3_loop2:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
306 btfsc switch_left ; Ack?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
307 return
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
308 btfsc switch_right ; Ack?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
309 return
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
310 bra screen3_loop ; loop screen
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
311
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
312 init:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
313 movlw b'01101100' ; 4MHz (x4 PLL)
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
314 movwf OSCCON
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
315
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
316 movlw b'00010001' ; I/O Ports
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
317 movwf TRISA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
318 clrf PORTA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
319 movlw b'00000011'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
320 movwf TRISB
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
321 clrf PORTB
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
322 movlw b'11011101' ; UART
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
323 movwf TRISC
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
324 clrf PORTC
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
325 movlw b'00000000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
326 movwf TRISE
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
327 clrf PORTE
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
328 movlw b'00000000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
329 movwf TRISD
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
330 clrf PORTD
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
331
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
332 movlw b'01000000' ; Bit6: PPL enable
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
333 movwf OSCTUNE
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
334
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
335 movlw b'00011111' ; Timer0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
336 movwf T0CON
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
337
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
338 movlw b'00000111' ; Timer1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
339 movwf T1CON
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
340
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
341 movlw b'11010000' ; Interrups
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
342 movwf INTCON
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
343 movlw b'00000101'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
344 movwf INTCON2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
345 movlw b'00001000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
346 movwf INTCON3
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
347 movlw b'00100001'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
348 movwf PIE1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
349 movlw b'00000000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
350 movwf PIE2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
351 clrf RCON
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
352
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
353 movlw b'00000000' ; A/D Converter
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
354 movwf ADCON0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
355 movlw b'00001110'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
356 movwf ADCON1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
357 movlw b'10001010' ; Right justified
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
358 movwf ADCON2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
359
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
360 clrf SSPCON1 ; Set I²C Mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
361 movlw b'00000000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
362 movwf SSPSTAT
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
363 movlw b'00101000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
364 movwf SSPCON1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
365 movlw b'00000000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
366 movwf SSPCON2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
367 movlw d'8' ; 400kHz I2C clock @ 16MHz Fcy
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
368 movwf SSPADD
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
369
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
370 clrf CCP1CON ; PWM Module off
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
371 clrf ECCP1CON ; PWM Module off
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
372
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
373 movlw b'00000111' ; Comperator Module off
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
374 movwf CMCON
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
375
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
376 movlw b'00100000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
377 movwf CANCON ; ECAN Module OFF
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
378
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
379 movlw b'00100100' ; UART
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
380 movwf TXSTA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
381 movlw b'10010000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
382 movwf RCSTA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
383 movlw b'00001000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
384 movwf BAUDCON
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
385 clrf SPBRGH
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
386 movlw d'34'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
387 movwf SPBRG
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
388 clrf RCREG
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
389 clrf PIR1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
390 return