annotate code_part1/OSTC_code_asm_part1/start.asm @ 33:6e5db85382a2

Speedy simulator! New Deco code test 1
author heinrichsweikamp
date Tue, 25 May 2010 17:37:26 +0200
parents a776039bda63
children 65d5b0c8da41
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
31
2b52a4a7dce6 preparations for new deco code...
heinrichsweikamp
parents: 21
diff changeset
77 movlw d'0'
2b52a4a7dce6 preparations for new deco code...
heinrichsweikamp
parents: 21
diff changeset
78 movff WREG,char_I_step_is_1min ; 2 second deco mode
32
a776039bda63 simulator-speed increased
heinrichsweikamp
parents: 31
diff changeset
79 call deco_main_clear_tissue ;
a776039bda63 simulator-speed increased
heinrichsweikamp
parents: 31
diff changeset
80 movlb b'00000001' ; select ram bank 1
0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
81 call deco_main_calc_desaturation_time; calculate desaturation time
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
82 movlb b'00000001' ; select ram bank 1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
83 call main_clear_CNS_fraction ; clear CNS
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
84 movlb b'00000001' ; select ram bank 1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
85 call calc_deko_surfmode ; calculate desaturation every minute
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
86 movlb b'00000001' ; select ram bank 1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
87 call deco_main_calc_wo_deco_step_1_m ; calculate deco in surface mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
88 movlb b'00000001' ; select ram bank 1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
89
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
90 ; check firmware and reset Custom Functions after an update
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
91 movlw LOW 0x101
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
92 movwf EEADR
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
93 movlw HIGH 0x101
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
94 movwf EEADRH
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
95 call read_eeprom ; read current version x
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
96 movff EEDATA,temp1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
97 incf EEADR,F ; set to 0x102
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
98 call read_eeprom ; read current version y
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
99 movff EEDATA,temp2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
100 clrf EEADRH ; Reset EEADRH
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
101
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
102 movlw softwareversion_x
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
103 cpfseq temp1 ; compare version x
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
104 bra check_firmware_new ; is not equal -> reset CF and store new version in EEPROM
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
105
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
106 movlw softwareversion_y
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
107 cpfseq temp2 ; compare version y
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
108 bra check_firmware_new ; is not equal -> reset CF and store new version in EEPROM
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
109 bra restart ; x and y are equal -> do not reset cf
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
110
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
111 check_firmware_new:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
112 movlw LOW 0x101 ; store current version in EEPROM
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
113 movwf EEADR
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
114 movlw HIGH 0x101
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
115 movwf EEADRH
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
116 movlw softwareversion_x
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
117 movwf EEDATA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
118 call write_eeprom ; write version x
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
119 incf EEADR,F ; set to 0x102
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
120 movlw softwareversion_y
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
121 movwf EEDATA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
122 call write_eeprom ; write version y
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
123 clrf EEADRH ; Reset EEADRH
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
124 ; 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
125 goto reset_all_cf_bank1 ; resets all custom functions bank1 and jumps to "restart"
0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
126
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
127 restart:
21
73014f788032 1.60 stable rc1
heinrichsweikamp
parents: 15
diff changeset
128 bcf LED_red
73014f788032 1.60 stable rc1
heinrichsweikamp
parents: 15
diff changeset
129 bcf LED_blue ; all LEDs off
15
6d1177291d38 1.54beta rc1
heinrichsweikamp
parents: 12
diff changeset
130
6d1177291d38 1.54beta rc1
heinrichsweikamp
parents: 12
diff changeset
131 clrf flag1 ; clear all flags
6d1177291d38 1.54beta rc1
heinrichsweikamp
parents: 12
diff changeset
132 clrf flag2
6d1177291d38 1.54beta rc1
heinrichsweikamp
parents: 12
diff changeset
133 clrf flag3
6d1177291d38 1.54beta rc1
heinrichsweikamp
parents: 12
diff changeset
134 clrf flag4
6d1177291d38 1.54beta rc1
heinrichsweikamp
parents: 12
diff changeset
135 clrf flag5
6d1177291d38 1.54beta rc1
heinrichsweikamp
parents: 12
diff changeset
136 clrf flag6
6d1177291d38 1.54beta rc1
heinrichsweikamp
parents: 12
diff changeset
137 clrf flag7
6d1177291d38 1.54beta rc1
heinrichsweikamp
parents: 12
diff changeset
138 clrf flag8
6d1177291d38 1.54beta rc1
heinrichsweikamp
parents: 12
diff changeset
139 clrf flag9
6d1177291d38 1.54beta rc1
heinrichsweikamp
parents: 12
diff changeset
140 clrf flag10
6d1177291d38 1.54beta rc1
heinrichsweikamp
parents: 12
diff changeset
141 clrf flag11
6d1177291d38 1.54beta rc1
heinrichsweikamp
parents: 12
diff changeset
142 clrf flag12
6d1177291d38 1.54beta rc1
heinrichsweikamp
parents: 12
diff changeset
143 clrf flag13
6d1177291d38 1.54beta rc1
heinrichsweikamp
parents: 12
diff changeset
144 clrf flag14
6d1177291d38 1.54beta rc1
heinrichsweikamp
parents: 12
diff changeset
145 clrf flag15
6d1177291d38 1.54beta rc1
heinrichsweikamp
parents: 12
diff changeset
146
0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
147 call PLED_boot ; PLED boot (Incl. Clear Screen!)
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
148 WIN_TOP .0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
149 WIN_LEFT .0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
150 WIN_FONT FT_SMALL
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
151 WIN_INVERT .0 ; Init new Wordprocessor
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
152 movlw 0xFF
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
153 movwf oled1_temp
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
154 movff oled1_temp,win_color1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
155 movlw 0xFF
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
156 movwf oled1_temp
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
157 movff oled1_temp,win_color2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
158 call I2CReset ; Just in Case any I2C device blocks the Bus
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
159 movff last_surfpressure_30min+0,last_surfpressure+0 ; Use 30min old airpressure
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
160 movff last_surfpressure_30min+1,last_surfpressure+1 ; Use 30min old airpressure
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
161
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
162 ; Check if new CF were added in the last firmware version
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
163 clrf EEADRH
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
164 read_int_eeprom d'92' ; Read number of CF used in this firmware
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
165 movlw max_custom_number ; Defined in definitions.asm
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
166 cpfseq EEDATA ; Compare with last version
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
167 bra restart_01 ; New CF, show warning and store new number
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
168 bra restart_1 ; No new CF, continue with boot
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
169 restart_01:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
170 ; Save new number of current CF count
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
171 rcall display_new_cf_installed; Show warning
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
172 movlw max_custom_number ; Defined in definitions.asm
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
173 movwf EEDATA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
174 write_int_eeprom d'92' ; Store number of CF used in this firmware
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
175
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
176 restart_1:
15
6d1177291d38 1.54beta rc1
heinrichsweikamp
parents: 12
diff changeset
177 ; btfss pressure_refresh ; Wait for pressure sensor...
6d1177291d38 1.54beta rc1
heinrichsweikamp
parents: 12
diff changeset
178 ; bra restart_1 ; loop until pressure and temp stable
12
588a969a0cae 1.53 beta rc
heinrichsweikamp
parents: 3
diff changeset
179 ;
0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
180
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
181 ; Set Debug mode?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
182 read_int_eeprom d'39'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
183 bsf debug_mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
184 movlw d'1'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
185 cpfseq EEDATA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
186 bcf debug_mode ; clear flag if <> 1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
187
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
188 goto surfloop ; Jump to Surfaceloop!
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
189
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
190
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
191 display_new_cf_installed:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
192 call PLED_new_cf_warning ; Display new CF warning screen
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
193 movlw d'20' ; timeout for warning screen
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
194 bra startup_screen3a ; Will RETURN after timeout or button press
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
195
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
196 restart_set_modes_and_flags: ; "Call"ed from divemode, as well!
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
197 bcf gauge_mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
198 bcf FLAG_const_ppO2_mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
199 bcf FLAG_apnoe_mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
200 clrf EEADRH
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
201 read_int_eeprom d'34' ; Read deco data
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
202 movlw d'1' ; Gauge mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
203 cpfseq EEDATA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
204 bra restart_3_test_ppO2_mode; check for ppO2 mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
205 bsf gauge_mode ; Set flag for gauge mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
206 movlw d'0'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
207 movwf wait_temp
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
208 movff wait_temp,char_I_deco_model ; Clear Flagbyte
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
209 return ; start in Surfacemode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
210 restart_3_test_ppO2_mode:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
211 movlw d'2' ; const ppO2 mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
212 cpfseq EEDATA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
213 bra restart_3_test_apnoe_mode; check for apnoe mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
214 bsf FLAG_const_ppO2_mode ; Set flag for ppO2 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_apnoe_mode:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
220 movlw d'3' ; Apnoe mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
221 cpfseq EEDATA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
222 bra restart_4_test_gf_mode ; check for GF OC mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
223 bsf FLAG_apnoe_mode ; Set flag for Apnoe 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_4_test_gf_mode:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
229 movlw d'4' ; GF OC mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
230 cpfseq EEDATA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
231 bra restart_5_test_gfO2_mode; check for GF CC mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
232 movlw d'1'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
233 movwf wait_temp
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
234 movff wait_temp,char_I_deco_model ; Set Flagbyte for GF method
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
235 return ; start in Surfacemode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
236 restart_5_test_gfO2_mode:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
237 movlw d'5' ; GF CC mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
238 cpfseq EEDATA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
239 return ; Start in Surfacemode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
240 bsf FLAG_const_ppO2_mode ; Set flag for ppO2 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
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
246 startup_screen1:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
247 call PLED_ClearScreen
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
248 call PLED_startupscreen1 ; show startup sreen
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
249 startup_screen1_2:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
250 movlw d'10' ; timeout for startup screen
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
251 movwf temp1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
252 WAITMS d'200'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
253 bcf switch_left
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
254 bcf switch_right
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
255 screen1_loop:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
256 btfsc onesecupdate ; do every second tasks?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
257 call set_dive_modes ; tests if depth>threshold
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
258 btfsc onesecupdate ; do every second tasks?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
259 decf temp1,F
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
260 bcf onesecupdate ; every second tasks done
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
261
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
262 tstfsz temp1 ; timout occured?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
263 bra screen1_loop2 ; no
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
264 return
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
265
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
266 screen1_loop2:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
267 btfsc divemode ; Divemode active?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
268 return
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
269 btfsc switch_left ; Ack?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
270 return
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
271 btfsc switch_right ; Ack?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
272 return
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
273 bra screen1_loop ; loop screen
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
274
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
275 startup_screen2:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
276 call PLED_ClearScreen ; Page 1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
277 call PLED_startupscreen2 ; show startup sreen
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
278 bra startup_screen1_2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
279
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
280 startup_screen3a:; WARNING: Also used for decodescriptions and CF Warning screen!
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
281 movwf temp1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
282 WAITMS d'200'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
283 bcf switch_left
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
284 bcf switch_right
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
285 screen3_loop:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
286 btfsc onesecupdate ; do every second tasks?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
287 call set_dive_modes ; tests if depth>threshold
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
288
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
289 btfsc onesecupdate ; do every second tasks?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
290 decf temp1,F
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
291 bcf onesecupdate ; every second tasks done
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
292
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
293 tstfsz temp1 ; timout occured?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
294 bra screen3_loop2 ; no
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
295 return
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
296 screen3_loop2:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
297 btfsc switch_left ; Ack?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
298 return
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
299 btfsc switch_right ; Ack?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
300 return
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
301 bra screen3_loop ; loop screen
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
302
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
303 init:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
304 movlw b'01101100' ; 4MHz (x4 PLL)
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
305 movwf OSCCON
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
306
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
307 movlw b'00010001' ; I/O Ports
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
308 movwf TRISA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
309 clrf PORTA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
310 movlw b'00000011'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
311 movwf TRISB
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
312 clrf PORTB
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
313 movlw b'11011101' ; UART
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
314 movwf TRISC
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
315 clrf PORTC
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
316 movlw b'00000000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
317 movwf TRISE
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
318 clrf PORTE
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
319 movlw b'00000000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
320 movwf TRISD
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
321 clrf PORTD
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
322
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
323 movlw b'01000000' ; Bit6: PPL enable
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
324 movwf OSCTUNE
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
325
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
326 movlw b'00011111' ; Timer0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
327 movwf T0CON
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
328
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
329 movlw b'00000111' ; Timer1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
330 movwf T1CON
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
331
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
332 movlw b'11010000' ; Interrups
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
333 movwf INTCON
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
334 movlw b'00000101'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
335 movwf INTCON2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
336 movlw b'00001000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
337 movwf INTCON3
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
338 movlw b'00100001'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
339 movwf PIE1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
340 movlw b'00000000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
341 movwf PIE2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
342 clrf RCON
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
343
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
344 movlw b'00000000' ; A/D Converter
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
345 movwf ADCON0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
346 movlw b'00001110'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
347 movwf ADCON1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
348 movlw b'10001010' ; Right justified
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
349 movwf ADCON2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
350
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
351 clrf SSPCON1 ; Set I²C Mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
352 movlw b'00000000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
353 movwf SSPSTAT
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
354 movlw b'00101000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
355 movwf SSPCON1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
356 movlw b'00000000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
357 movwf SSPCON2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
358 movlw d'8' ; 400kHz I2C clock @ 16MHz Fcy
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
359 movwf SSPADD
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
360
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
361 clrf CCP1CON ; PWM Module off
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
362 clrf ECCP1CON ; PWM Module off
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
363
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
364 movlw b'00000111' ; Comperator Module off
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
365 movwf CMCON
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
366
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
367 movlw b'00100000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
368 movwf CANCON ; ECAN Module OFF
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
369
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
370 movlw b'00100100' ; UART
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
371 movwf TXSTA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
372 movlw b'10010000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
373 movwf RCSTA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
374 movlw b'00001000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
375 movwf BAUDCON
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
376 clrf SPBRGH
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
377 movlw d'34'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
378 movwf SPBRG
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
379 clrf RCREG
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
380 clrf PIR1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
381 return