annotate code_part1/OSTC_code_asm_part1/start.asm @ 75:35d947d7a6e7

1.73beta started, small fixes
author heinrichsweikamp
date Sun, 05 Dec 2010 21:40:58 +0100
parents 2972a06b0785
children 3e351e25f5d1
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
62
2972a06b0785 1.71 beta in work
heinrichsweikamp
parents: 52
diff changeset
124 ; goto reset_all_cf ; resets all custom functions bank0 and bank1 and jumps to "restart"
52
4f6d6f00e685 Gas Change for Simulator debugged
heinrichsweikamp
parents: 49
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
43
65d5b0c8da41 New CF48, changed CF15
heinrichsweikamp
parents: 33
diff changeset
130 GETCUSTOM8 d'48' ; time correction value
65d5b0c8da41 New CF48, changed CF15
heinrichsweikamp
parents: 33
diff changeset
131 movff WREG, time_correction_value ; store in Bank0 register
15
6d1177291d38 1.54beta rc1
heinrichsweikamp
parents: 12
diff changeset
132
6d1177291d38 1.54beta rc1
heinrichsweikamp
parents: 12
diff changeset
133 clrf flag1 ; clear all flags
6d1177291d38 1.54beta rc1
heinrichsweikamp
parents: 12
diff changeset
134 clrf flag2
6d1177291d38 1.54beta rc1
heinrichsweikamp
parents: 12
diff changeset
135 clrf flag3
6d1177291d38 1.54beta rc1
heinrichsweikamp
parents: 12
diff changeset
136 clrf flag4
6d1177291d38 1.54beta rc1
heinrichsweikamp
parents: 12
diff changeset
137 clrf flag5
6d1177291d38 1.54beta rc1
heinrichsweikamp
parents: 12
diff changeset
138 clrf flag6
6d1177291d38 1.54beta rc1
heinrichsweikamp
parents: 12
diff changeset
139 clrf flag7
6d1177291d38 1.54beta rc1
heinrichsweikamp
parents: 12
diff changeset
140 clrf flag8
6d1177291d38 1.54beta rc1
heinrichsweikamp
parents: 12
diff changeset
141 clrf flag9
6d1177291d38 1.54beta rc1
heinrichsweikamp
parents: 12
diff changeset
142 clrf flag10
6d1177291d38 1.54beta rc1
heinrichsweikamp
parents: 12
diff changeset
143 clrf flag11
6d1177291d38 1.54beta rc1
heinrichsweikamp
parents: 12
diff changeset
144 clrf flag12
6d1177291d38 1.54beta rc1
heinrichsweikamp
parents: 12
diff changeset
145 clrf flag13
6d1177291d38 1.54beta rc1
heinrichsweikamp
parents: 12
diff changeset
146 clrf flag14
6d1177291d38 1.54beta rc1
heinrichsweikamp
parents: 12
diff changeset
147 clrf flag15
47
56aea9fcdd8f 1.65beta release
heinrichsweikamp
parents: 45
diff changeset
148 call gassetup_sort_gaslist ; Sorts Gaslist according to change depth
0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
149 call PLED_boot ; PLED boot (Incl. Clear Screen!)
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
150 WIN_TOP .0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
151 WIN_LEFT .0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
152 WIN_FONT FT_SMALL
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
153 WIN_INVERT .0 ; Init new Wordprocessor
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
154 movlw 0xFF
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
155 movwf oled1_temp
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
156 movff oled1_temp,win_color1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
157 movlw 0xFF
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
158 movwf oled1_temp
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
159 movff oled1_temp,win_color2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
160 call I2CReset ; Just in Case any I2C device blocks the Bus
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
161 movff last_surfpressure_30min+0,last_surfpressure+0 ; Use 30min old airpressure
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
162 movff last_surfpressure_30min+1,last_surfpressure+1 ; Use 30min old airpressure
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
163
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
164 ; Check if new CF were added in the last firmware version
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
165 clrf EEADRH
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
166 read_int_eeprom d'92' ; Read number of CF used in this firmware
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
167 movlw max_custom_number ; Defined in definitions.asm
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
168 cpfseq EEDATA ; Compare with last version
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
169 bra restart_01 ; New CF, show warning and store new number
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
170 bra restart_1 ; No new CF, continue with boot
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
171 restart_01:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
172 ; Save new number of current CF count
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
173 rcall display_new_cf_installed; Show warning
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
174 movlw max_custom_number ; Defined in definitions.asm
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
175 movwf EEDATA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
176 write_int_eeprom d'92' ; Store number of CF used in this firmware
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
177
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
178 restart_1:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
179
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
180 ; Set Debug mode?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
181 read_int_eeprom d'39'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
182 bsf debug_mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
183 movlw d'1'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
184 cpfseq EEDATA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
185 bcf debug_mode ; clear flag if <> 1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
186
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
187 goto surfloop ; Jump to Surfaceloop!
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
188
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
189
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
190 display_new_cf_installed:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
191 call PLED_new_cf_warning ; Display new CF warning screen
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
192 movlw d'20' ; timeout for warning screen
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
193 bra startup_screen3a ; Will RETURN after timeout or button press
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
194
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
195 restart_set_modes_and_flags: ; "Call"ed from divemode, as well!
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
196 bcf gauge_mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
197 bcf FLAG_const_ppO2_mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
198 bcf FLAG_apnoe_mode
45
985607cfb813 1.65beta
heinrichsweikamp
parents: 43
diff changeset
199
985607cfb813 1.65beta
heinrichsweikamp
parents: 43
diff changeset
200 ; Pre-load modes for OC, GF 90/90 and no Aponoe or Gauge.
985607cfb813 1.65beta
heinrichsweikamp
parents: 43
diff changeset
201 movlw d'0'
985607cfb813 1.65beta
heinrichsweikamp
parents: 43
diff changeset
202 movwf wait_temp
985607cfb813 1.65beta
heinrichsweikamp
parents: 43
diff changeset
203 movff wait_temp,char_I_deco_model ; Clear Flagbyte
985607cfb813 1.65beta
heinrichsweikamp
parents: 43
diff changeset
204 ; Load GF values into RAM
985607cfb813 1.65beta
heinrichsweikamp
parents: 43
diff changeset
205 movlw d'90'
985607cfb813 1.65beta
heinrichsweikamp
parents: 43
diff changeset
206 movwf wait_temp
985607cfb813 1.65beta
heinrichsweikamp
parents: 43
diff changeset
207 movff wait_temp,char_I_GF_Lo_percentage
985607cfb813 1.65beta
heinrichsweikamp
parents: 43
diff changeset
208 movff wait_temp,char_I_GF_Hi_percentage ; Set to 90/90...
0
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 return ; start in Surfacemode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
216 restart_3_test_ppO2_mode:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
217 movlw d'2' ; const ppO2 mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
218 cpfseq EEDATA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
219 bra restart_3_test_apnoe_mode; check for apnoe mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
220 bsf FLAG_const_ppO2_mode ; Set flag for ppO2 mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
221 return ; start in Surfacemode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
222 restart_3_test_apnoe_mode:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
223 movlw d'3' ; Apnoe mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
224 cpfseq EEDATA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
225 bra restart_4_test_gf_mode ; check for GF OC mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
226 bsf FLAG_apnoe_mode ; Set flag for Apnoe Mode
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
45
985607cfb813 1.65beta
heinrichsweikamp
parents: 43
diff changeset
235 ; Load GF values into RAM
985607cfb813 1.65beta
heinrichsweikamp
parents: 43
diff changeset
236 GETCUSTOM8 d'32' ; GF low
985607cfb813 1.65beta
heinrichsweikamp
parents: 43
diff changeset
237 movff EEDATA,char_I_GF_Lo_percentage
985607cfb813 1.65beta
heinrichsweikamp
parents: 43
diff changeset
238 GETCUSTOM8 d'33' ; GF high
985607cfb813 1.65beta
heinrichsweikamp
parents: 43
diff changeset
239 movff EEDATA,char_I_GF_Hi_percentage
0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
240 return ; start in Surfacemode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
241 restart_5_test_gfO2_mode:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
242 movlw d'5' ; GF CC mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
243 cpfseq EEDATA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
244 return ; Start in Surfacemode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
245 bsf FLAG_const_ppO2_mode ; Set flag for ppO2 mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
246 movlw d'1'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
247 movwf wait_temp
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
248 movff wait_temp,char_I_deco_model ; Set Flagbyte for GF method
45
985607cfb813 1.65beta
heinrichsweikamp
parents: 43
diff changeset
249 ; Load GF values into RAM
985607cfb813 1.65beta
heinrichsweikamp
parents: 43
diff changeset
250 GETCUSTOM8 d'32' ; GF low
985607cfb813 1.65beta
heinrichsweikamp
parents: 43
diff changeset
251 movff EEDATA,char_I_GF_Lo_percentage
985607cfb813 1.65beta
heinrichsweikamp
parents: 43
diff changeset
252 GETCUSTOM8 d'33' ; GF high
985607cfb813 1.65beta
heinrichsweikamp
parents: 43
diff changeset
253 movff EEDATA,char_I_GF_Hi_percentage
0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
254 return ; start in Surfacemode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
255
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
256 startup_screen1:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
257 call PLED_ClearScreen
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
258 call PLED_startupscreen1 ; show startup sreen
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
259 startup_screen1_2:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
260 movlw d'10' ; timeout for startup screen
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
261 movwf temp1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
262 WAITMS d'200'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
263 bcf switch_left
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
264 bcf switch_right
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
265 screen1_loop:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
266 btfsc onesecupdate ; do every second tasks?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
267 call set_dive_modes ; tests if depth>threshold
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
268 btfsc onesecupdate ; do every second tasks?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
269 decf temp1,F
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
270 bcf onesecupdate ; every second tasks done
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
271
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
272 tstfsz temp1 ; timout occured?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
273 bra screen1_loop2 ; no
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
274 return
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
275
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
276 screen1_loop2:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
277 btfsc divemode ; Divemode active?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
278 return
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
279 btfsc switch_left ; Ack?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
280 return
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
281 btfsc switch_right ; Ack?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
282 return
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
283 bra screen1_loop ; loop screen
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
284
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
285 startup_screen2:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
286 call PLED_ClearScreen ; Page 1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
287 call PLED_startupscreen2 ; show startup sreen
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
288 bra startup_screen1_2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
289
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
290 startup_screen3a:; WARNING: Also used for decodescriptions and CF Warning screen!
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
291 movwf temp1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
292 WAITMS d'200'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
293 bcf switch_left
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
294 bcf switch_right
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
295 screen3_loop:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
296 btfsc onesecupdate ; do every second tasks?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
297 call set_dive_modes ; tests if depth>threshold
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
298
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
299 btfsc onesecupdate ; do every second tasks?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
300 decf temp1,F
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
301 bcf onesecupdate ; every second tasks done
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
302
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
303 tstfsz temp1 ; timout occured?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
304 bra screen3_loop2 ; no
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
305 return
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
306 screen3_loop2:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
307 btfsc switch_left ; Ack?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
308 return
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
309 btfsc switch_right ; Ack?
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
310 return
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
311 bra screen3_loop ; loop screen
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
312
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
313 init:
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
314 movlw b'01101100' ; 4MHz (x4 PLL)
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
315 movwf OSCCON
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
316
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
317 movlw b'00010001' ; I/O Ports
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
318 movwf TRISA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
319 clrf PORTA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
320 movlw b'00000011'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
321 movwf TRISB
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
322 clrf PORTB
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
323 movlw b'11011101' ; UART
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
324 movwf TRISC
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
325 clrf PORTC
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
326 movlw b'00000000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
327 movwf TRISE
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
328 clrf PORTE
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
329 movlw b'00000000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
330 movwf TRISD
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
331 clrf PORTD
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
332
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
333 movlw b'01000000' ; Bit6: PPL enable
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
334 movwf OSCTUNE
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
335
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
336 movlw b'00011111' ; Timer0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
337 movwf T0CON
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
338
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
339 movlw b'00000111' ; Timer1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
340 movwf T1CON
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
341
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
342 movlw b'11010000' ; Interrups
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
343 movwf INTCON
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
344 movlw b'00000101'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
345 movwf INTCON2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
346 movlw b'00001000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
347 movwf INTCON3
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
348 movlw b'00100001'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
349 movwf PIE1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
350 movlw b'00000000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
351 movwf PIE2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
352 clrf RCON
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
353
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
354 movlw b'00000000' ; A/D Converter
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
355 movwf ADCON0
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
356 movlw b'00001110'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
357 movwf ADCON1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
358 movlw b'10001010' ; Right justified
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
359 movwf ADCON2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
360
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
361 clrf SSPCON1 ; Set I²C Mode
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
362 movlw b'00000000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
363 movwf SSPSTAT
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
364 movlw b'00101000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
365 movwf SSPCON1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
366 movlw b'00000000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
367 movwf SSPCON2
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
368 movlw d'8' ; 400kHz I2C clock @ 16MHz Fcy
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
369 movwf SSPADD
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
370
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
371 clrf CCP1CON ; PWM Module off
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
372 clrf ECCP1CON ; PWM Module off
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
373
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
374 movlw b'00000111' ; Comperator Module off
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
375 movwf CMCON
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
376
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
377 movlw b'00100000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
378 movwf CANCON ; ECAN Module OFF
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
379
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
380 movlw b'00100100' ; UART
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
381 movwf TXSTA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
382 movlw b'10010000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
383 movwf RCSTA
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
384 movlw b'00001000'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
385 movwf BAUDCON
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
386 clrf SPBRGH
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
387 movlw d'34'
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
388 movwf SPBRG
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
389 clrf RCREG
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
390 clrf PIR1
96a35aeda5f2 Initial setup
heinrichsweikamp
parents:
diff changeset
391 return