Mercurial > public > mk2
annotate code_part1/OSTC_code_asm_part1/start.asm @ 714:b7f7184d800d
banksafe sensor init
| author | heinrichsweikamp |
|---|---|
| date | Thu, 16 May 2013 14:16:09 +0200 |
| parents | 8c293e76a517 |
| children | 4452837aff37 |
| rev | line source |
|---|---|
| 0 | 1 ; OSTC - diving computer code |
| 2 ; Copyright (C) 2008 HeinrichsWeikamp GbR | |
| 3 | |
| 4 ; This program is free software: you can redistribute it and/or modify | |
| 5 ; it under the terms of the GNU General Public License as published by | |
| 6 ; the Free Software Foundation, either version 3 of the License, or | |
| 7 ; (at your option) any later version. | |
| 8 | |
| 9 ; This program is distributed in the hope that it will be useful, | |
| 10 ; but WITHOUT ANY WARRANTY; without even the implied warranty of | |
| 11 ; MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
| 12 ; GNU General Public License for more details. | |
| 13 | |
| 14 ; You should have received a copy of the GNU General Public License | |
| 15 ; along with this program. If not, see <http://www.gnu.org/licenses/>. | |
| 16 | |
| 17 | |
| 18 ; Start and init | |
| 19 ; written by: Matthias Heinrichs, info@heinrichsweikamp.com | |
| 20 ; written: 10/13/04 | |
| 21 ; last updated: 06/24/08 | |
| 22 ; known bugs: | |
| 23 ; ToDo: | |
| 24 | |
| 25 start: | |
| 26 movlb b'00000001' ; ram bank 1 selected | |
| 521 | 27 movff STKPTR,temp10 ; Save stack pointer, for crash reports. |
| 235 | 28 clrf temp10+1 |
| 0 | 29 call init |
| 30 btfsc divemode ; Reset from Divemode? | |
| 681 | 31 call DISP_resetdebugger ; Yes! Something went wrong, show reset informations |
| 306 | 32 start3: |
| 0 | 33 clrf STKPTR ; Clear Stackpointer |
| 359 | 34 lfsr FSR0,year+1 ; Clear rambank 1-9, do not delete RTC registers |
| 0 | 35 clear_rambank: |
| 36 clrf POSTINC0 | |
| 37 movlw 0x0A | |
| 38 cpfseq FSR0H ; Bank 9 done? | |
| 39 bra clear_rambank ; clear... | |
| 40 | |
| 41 ; Defaults for RTC | |
| 42 call disable_rs232 ; disable UART module | |
| 43 call RTCinit ; reset RTC | |
| 44 | |
| 45 ; Air pressure compensation after reset | |
| 46 call get_calibration_data ; Get calibration data from pressure sensor | |
| 714 | 47 banksel flag5 |
| 713 | 48 bcf no_sensor_int ; Enable sensor interrupt |
| 0 | 49 bcf pressure_refresh |
| 50 wait_start_pressure: | |
| 51 btfss pressure_refresh ; Air pressure compensation | |
| 52 bra wait_start_pressure | |
| 53 | |
| 54 clrf rel_pressure+0 | |
| 55 clrf rel_pressure+1 | |
| 56 clrf surface_interval+0 | |
| 57 clrf surface_interval+1 | |
| 58 | |
| 59 bsf sleepmode ; Routine only works in sleepmode... | |
| 60 call pressuretest_sleep_fast ; Gets pressure without averaging (faster!) | |
| 61 bcf sleepmode ; Normal mode again | |
| 233 | 62 |
| 521 | 63 ; Extra power-up reset (JeanDo emulator) |
| 64 Ifdef TESTING | |
| 65 call reset_gases | |
| 66 call reset_all_cf | |
| 67 call reset_external_eeprom | |
| 68 | |
| 69 movlw LOW(.1000) | |
| 70 movwf amb_pressure+0 | |
| 71 movlw HIGH(.1000) | |
| 72 movwf amb_pressure+1 | |
| 73 Endif | |
| 74 | |
| 75 ; Get real pressure (if not in emulator mode) | |
| 76 Ifndef TESTING | |
| 507 | 77 SAFE_2BYTE_COPY amb_pressure_avg, amb_pressure ; copy for compatibility |
| 78 Endif | |
| 79 | |
| 80 movff amb_pressure+0,last_surfpressure+0 | |
| 81 movff amb_pressure+1,last_surfpressure+1 | |
|
341
2144f19fa1eb
BUGFIX protect against ISR changing pressure/temperature while reading it.
JeanDo
parents:
327
diff
changeset
|
82 movff last_surfpressure+0,last_surfpressure_15min+0 |
|
2144f19fa1eb
BUGFIX protect against ISR changing pressure/temperature while reading it.
JeanDo
parents:
327
diff
changeset
|
83 movff last_surfpressure+1,last_surfpressure_15min+1 |
|
2144f19fa1eb
BUGFIX protect against ISR changing pressure/temperature while reading it.
JeanDo
parents:
327
diff
changeset
|
84 movff last_surfpressure+0,last_surfpressure_30min+0 |
|
2144f19fa1eb
BUGFIX protect against ISR changing pressure/temperature while reading it.
JeanDo
parents:
327
diff
changeset
|
85 movff last_surfpressure+1,last_surfpressure_30min+1 ; Rests all airpressure registers |
| 0 | 86 |
| 87 ; reset deco data | |
| 236 | 88 ostc_debug '0' ; Sends debug-information to screen if debugmode active |
| 89 | |
| 0 | 90 movlw d'79' ; 79% N2 |
| 197 | 91 movff WREG,char_I_N2_ratio ; No He at the Surface |
| 236 | 92 clrf WREG ; Use as buffer |
| 93 movff WREG,char_I_He_ratio ; No He at the Surface | |
| 94 movff WREG,char_I_step_is_1min ; 2 second deco mode | |
| 95 GETCUSTOM8 d'11' ; Saturation multiplier % | |
| 96 movff WREG,char_I_saturation_multiplier | |
| 97 GETCUSTOM8 d'12' ; Desaturation multiplier % | |
| 98 movff WREG,char_I_desaturation_multiplier | |
| 507 | 99 movff amb_pressure+0,int_I_pres_respiration+0 ; copy for deco routine |
| 100 movff amb_pressure+1,int_I_pres_respiration+1 | |
| 101 movff int_I_pres_respiration+0,int_I_pres_surface+0 ; copy for desat routine | |
|
341
2144f19fa1eb
BUGFIX protect against ISR changing pressure/temperature while reading it.
JeanDo
parents:
327
diff
changeset
|
102 movff int_I_pres_respiration+1,int_I_pres_surface+1 |
| 0 | 103 |
| 513 | 104 call deco_clear_tissue |
| 105 movlb b'00000001' ; select ram bank 1 | |
| 106 | |
|
508
b595569e4bcc
BUGFIX char_I_(N2_ratio/He_ratio) array not inited at boot time
JeanDo
parents:
507
diff
changeset
|
107 call divemode_check_decogases ; Setup N2/He ratio array |
|
520
acf4776eec08
BUGFIX bank1 error, deco_calc_wo_deco done twice in start routine.
JeanDo
parents:
513
diff
changeset
|
108 |
|
acf4776eec08
BUGFIX bank1 error, deco_calc_wo_deco done twice in start routine.
JeanDo
parents:
513
diff
changeset
|
109 call calc_deko_surfmode ; calculate desaturation for one minute |
|
acf4776eec08
BUGFIX bank1 error, deco_calc_wo_deco done twice in start routine.
JeanDo
parents:
513
diff
changeset
|
110 |
| 116 | 111 call deco_calc_desaturation_time ; calculate desaturation time |
| 112 call deco_clear_CNS_fraction ; clear CNS | |
|
520
acf4776eec08
BUGFIX bank1 error, deco_calc_wo_deco done twice in start routine.
JeanDo
parents:
513
diff
changeset
|
113 movlb b'00000001' ; select ram bank 1 |
|
acf4776eec08
BUGFIX bank1 error, deco_calc_wo_deco done twice in start routine.
JeanDo
parents:
513
diff
changeset
|
114 |
| 412 | 115 clrf nofly_time+0 ; Reset NoFly |
| 116 clrf nofly_time+1 ; Reset NoFly | |
| 117 bcf nofly_active ; Clear flag | |
| 0 | 118 |
| 119 ; check firmware and reset Custom Functions after an update | |
|
384
904863f96582
Work-Around for "Reset all" overwriting 0x00 to 0x04 in EEPROM Bank1
heinrichsweikamp
parents:
380
diff
changeset
|
120 movlw d'1' |
| 0 | 121 movwf EEADR |
|
384
904863f96582
Work-Around for "Reset all" overwriting 0x00 to 0x04 in EEPROM Bank1
heinrichsweikamp
parents:
380
diff
changeset
|
122 movlw d'1' |
| 0 | 123 movwf EEADRH |
| 124 call read_eeprom ; read current version x | |
| 125 movff EEDATA,temp1 | |
| 126 incf EEADR,F ; set to 0x102 | |
| 127 call read_eeprom ; read current version y | |
| 128 movff EEDATA,temp2 | |
| 129 clrf EEADRH ; Reset EEADRH | |
| 130 | |
| 131 movlw softwareversion_x | |
| 132 cpfseq temp1 ; compare version x | |
| 133 bra check_firmware_new ; is not equal -> reset CF and store new version in EEPROM | |
| 134 | |
| 135 movlw softwareversion_y | |
| 136 cpfseq temp2 ; compare version y | |
| 137 bra check_firmware_new ; is not equal -> reset CF and store new version in EEPROM | |
| 138 bra restart ; x and y are equal -> do not reset cf | |
| 139 | |
| 140 check_firmware_new: | |
|
384
904863f96582
Work-Around for "Reset all" overwriting 0x00 to 0x04 in EEPROM Bank1
heinrichsweikamp
parents:
380
diff
changeset
|
141 movlw d'1' ; store current version in EEPROM |
| 0 | 142 movwf EEADR |
|
384
904863f96582
Work-Around for "Reset all" overwriting 0x00 to 0x04 in EEPROM Bank1
heinrichsweikamp
parents:
380
diff
changeset
|
143 movlw d'1' |
| 0 | 144 movwf EEADRH |
| 145 movlw softwareversion_x | |
| 146 movwf EEDATA | |
| 147 call write_eeprom ; write version x | |
| 148 incf EEADR,F ; set to 0x102 | |
| 149 movlw softwareversion_y | |
| 150 movwf EEDATA | |
| 151 call write_eeprom ; write version y | |
| 152 clrf EEADRH ; Reset EEADRH | |
| 392 | 153 |
| 500 | 154 ; After update resets |
| 155 ; Reset brightness to ECO | |
| 578 | 156 movlw LOW 0x103 |
| 500 | 157 movwf EEADR |
| 578 | 158 movlw HIGH 0x103 |
| 681 | 159 movwf EEADRH ; DISPLAY brightness (=0: Eco, =1: High) |
| 500 | 160 movlw .0 |
| 161 movwf EEDATA | |
| 162 call write_eeprom ; write byte | |
| 649 | 163 clrf EEADRH ; Reset EEADRH |
| 164 | |
| 0 | 165 restart: |
| 390 | 166 movlw b'00000011' |
| 167 movwf T3CON ; Timer3 with 32768Hz clock running | |
| 168 clrf TMR3L | |
| 537 | 169 nop |
| 390 | 170 clrf TMR3H |
| 21 | 171 bcf LED_red |
| 172 bcf LED_blue ; all LEDs off | |
| 43 | 173 GETCUSTOM8 d'48' ; time correction value |
| 174 movff WREG, time_correction_value ; store in Bank0 register | |
| 15 | 175 |
| 176 clrf flag1 ; clear all flags | |
| 177 clrf flag2 | |
| 178 clrf flag3 | |
| 179 clrf flag4 | |
| 180 clrf flag5 | |
| 181 clrf flag6 | |
| 182 clrf flag7 | |
| 183 clrf flag8 | |
| 184 clrf flag9 | |
| 185 clrf flag10 | |
| 186 clrf flag11 | |
| 187 clrf flag12 | |
| 188 clrf flag13 | |
| 189 clrf flag14 | |
| 190 clrf flag15 | |
| 153 | 191 |
|
169
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
167
diff
changeset
|
192 ; Should we set win_flip_screen ? |
|
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
167
diff
changeset
|
193 bsf flag1,0 ; Precondition to yes |
| 153 | 194 clrf EEADRH ; Reset EEADRH |
| 195 read_int_eeprom d'1' | |
| 196 movlw .7 | |
|
169
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
167
diff
changeset
|
197 cpfsgt EEDATA ; serial > 2048 (Mk2n hardware) ? |
| 153 | 198 bcf flag1,0 |
|
169
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
167
diff
changeset
|
199 incf EEDATA,W ; serial == 65535 (emulation) ? |
|
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
167
diff
changeset
|
200 btfsc STATUS,Z |
|
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
167
diff
changeset
|
201 bcf flag1,0 |
| 153 | 202 movff flag1,win_flags ; store in Bank0 register |
| 203 clrf flag1 ; Clear flag1 (again) | |
| 239 | 204 |
| 205 ; Select high altitude (Fly) mode? | |
| 206 movff last_surfpressure_30min+0,sub_b+0 | |
| 207 movff last_surfpressure_30min+1,sub_b+1 | |
| 208 movlw HIGH d'880' | |
| 209 movwf sub_a+1 | |
| 210 movlw LOW d'880' ; Hard-wired 880mBar | |
| 211 movwf sub_a+0 | |
| 212 call sub16 ; sub_c = sub_a - sub_b | |
| 213 btfss neg_flag ; Result negative (Ambient>880mBar)? | |
| 214 bsf high_altitude_mode ; No, Set Flag! | |
|
169
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
167
diff
changeset
|
215 |
| 142 | 216 call gassetup_sort_gaslist ; Sorts Gaslist according to change depth |
| 0 | 217 WIN_TOP .0 |
| 218 WIN_LEFT .0 | |
| 219 WIN_FONT FT_SMALL | |
| 220 WIN_INVERT .0 ; Init new Wordprocessor | |
|
83
3e351e25f5d1
adding anti-aliased fonts frame and merging some patches from Jeando
heinrichsweikamp
parents:
62
diff
changeset
|
221 setf WREG |
|
3e351e25f5d1
adding anti-aliased fonts frame and merging some patches from Jeando
heinrichsweikamp
parents:
62
diff
changeset
|
222 movff WREG,win_color1 ; Beware: win_color1 is bank0, and we are bank1 currently |
|
3e351e25f5d1
adding anti-aliased fonts frame and merging some patches from Jeando
heinrichsweikamp
parents:
62
diff
changeset
|
223 movff WREG,win_color2 |
| 0 | 224 call I2CReset ; Just in Case any I2C device blocks the Bus |
| 225 movff last_surfpressure_30min+0,last_surfpressure+0 ; Use 30min old airpressure | |
| 226 movff last_surfpressure_30min+1,last_surfpressure+1 ; Use 30min old airpressure | |
| 227 | |
| 228 ; Check if new CF were added in the last firmware version | |
| 229 clrf EEADRH | |
| 230 read_int_eeprom d'92' ; Read number of CF used in this firmware | |
| 231 movlw max_custom_number ; Defined in definitions.asm | |
| 232 cpfseq EEDATA ; Compare with last version | |
| 605 | 233 bra restart1 ; New CF, show warning and store new number |
| 234 bra restart2 ; No new CF, continue with boot | |
| 235 | |
| 236 restart1: | |
| 622 | 237 ; Reset all CF and Gases |
| 238 call reset_gases | |
|
677
683e7d821678
Set CF17 (ppo2_warning_low) low level to 0.16bar
heinrichsweikamp
parents:
668
diff
changeset
|
239 ; call reset_all_cf |
| 605 | 240 ; Show info screen |
| 681 | 241 call DISPLAY_boot ; DISP boot (Incl. Clear Screen!) |
| 605 | 242 rcall display_new_cf_installed; Show info screen |
| 0 | 243 ; Save new number of current CF count |
| 244 movlw max_custom_number ; Defined in definitions.asm | |
| 245 movwf EEDATA | |
| 246 write_int_eeprom d'92' ; Store number of CF used in this firmware | |
| 247 | |
| 605 | 248 restart2: |
| 0 | 249 ; Set Debug mode? |
| 250 read_int_eeprom d'39' | |
| 251 bsf debug_mode | |
| 252 movlw d'1' | |
| 253 cpfseq EEDATA | |
| 254 bcf debug_mode ; clear flag if <> 1 | |
| 255 | |
|
362
64da813d4726
Logbook converter (Needs ~8Minutes and is called one time). Backup your dives before use!!
Heinrichsweikamp
parents:
359
diff
changeset
|
256 ; Check if logbook has been converted already (Internal EEPROM 0x100=0xAA) |
|
64da813d4726
Logbook converter (Needs ~8Minutes and is called one time). Backup your dives before use!!
Heinrichsweikamp
parents:
359
diff
changeset
|
257 movlw LOW 0x100 |
|
64da813d4726
Logbook converter (Needs ~8Minutes and is called one time). Backup your dives before use!!
Heinrichsweikamp
parents:
359
diff
changeset
|
258 movwf EEADR |
|
64da813d4726
Logbook converter (Needs ~8Minutes and is called one time). Backup your dives before use!!
Heinrichsweikamp
parents:
359
diff
changeset
|
259 movlw HIGH 0x100 |
|
64da813d4726
Logbook converter (Needs ~8Minutes and is called one time). Backup your dives before use!!
Heinrichsweikamp
parents:
359
diff
changeset
|
260 movwf EEADRH |
|
64da813d4726
Logbook converter (Needs ~8Minutes and is called one time). Backup your dives before use!!
Heinrichsweikamp
parents:
359
diff
changeset
|
261 call read_eeprom ; read byte |
|
64da813d4726
Logbook converter (Needs ~8Minutes and is called one time). Backup your dives before use!!
Heinrichsweikamp
parents:
359
diff
changeset
|
262 movlw 0xAA |
|
64da813d4726
Logbook converter (Needs ~8Minutes and is called one time). Backup your dives before use!!
Heinrichsweikamp
parents:
359
diff
changeset
|
263 cpfseq EEDATA ; is 0xAA already? |
|
64da813d4726
Logbook converter (Needs ~8Minutes and is called one time). Backup your dives before use!!
Heinrichsweikamp
parents:
359
diff
changeset
|
264 call logbook_convert_64k ; No, convert now (And write 0xAA to internal EEPROM 0x100) |
|
64da813d4726
Logbook converter (Needs ~8Minutes and is called one time). Backup your dives before use!!
Heinrichsweikamp
parents:
359
diff
changeset
|
265 |
| 681 | 266 ; Set DISPLAY brightness flag |
| 578 | 267 movlw LOW 0x103 |
|
499
2ac77db9c150
Added OLED brightness setting, texts 280, 312 and 313 need update
heinrichsweikamp
parents:
493
diff
changeset
|
268 movwf EEADR |
| 578 | 269 movlw HIGH 0x103 |
| 681 | 270 movwf EEADRH ; DISPLAY brightness (=0: Eco, =1: High) |
|
499
2ac77db9c150
Added OLED brightness setting, texts 280, 312 and 313 need update
heinrichsweikamp
parents:
493
diff
changeset
|
271 call read_eeprom ; read byte |
| 681 | 272 bcf DISPLAY_brightness_high ; Eco mode |
|
499
2ac77db9c150
Added OLED brightness setting, texts 280, 312 and 313 need update
heinrichsweikamp
parents:
493
diff
changeset
|
273 movlw .0 |
|
2ac77db9c150
Added OLED brightness setting, texts 280, 312 and 313 need update
heinrichsweikamp
parents:
493
diff
changeset
|
274 cpfseq EEDATA ; High? |
| 681 | 275 bsf DISPLAY_brightness_high ; Yes! |
|
499
2ac77db9c150
Added OLED brightness setting, texts 280, 312 and 313 need update
heinrichsweikamp
parents:
493
diff
changeset
|
276 |
|
2ac77db9c150
Added OLED brightness setting, texts 280, 312 and 313 need update
heinrichsweikamp
parents:
493
diff
changeset
|
277 clrf EEADRH ; Reset EEADRH |
| 0 | 278 goto surfloop ; Jump to Surfaceloop! |
| 279 | |
| 280 | |
| 281 display_new_cf_installed: | |
| 681 | 282 call DISP_new_cf_warning ; Display new CF warning screen |
| 0 | 283 movlw d'20' ; timeout for warning screen |
| 284 bra startup_screen3a ; Will RETURN after timeout or button press | |
| 197 | 285 |
| 286 ;============================================================================= | |
| 287 ; Setup all flags and parameters for divemode and simulator computations. | |
| 288 ; | |
| 289 restart_set_modes_and_flags: ; "Call"ed from divemode, as well! | |
| 0 | 290 bcf gauge_mode |
| 291 bcf FLAG_const_ppO2_mode | |
| 292 bcf FLAG_apnoe_mode | |
| 45 | 293 |
| 294 ; Pre-load modes for OC, GF 90/90 and no Aponoe or Gauge. | |
| 197 | 295 bcf no_deco_customviews ; Clear no-deco-mode-flag |
| 45 | 296 movlw d'0' |
| 469 | 297 movff WREG,char_I_deco_model ; ZH-L16 |
| 45 | 298 ; Load GF values into RAM |
| 299 movlw d'90' | |
| 197 | 300 movff WREG,char_I_GF_Low_percentage |
| 301 movff WREG,char_I_GF_High_percentage ; Set to 90/90... | |
| 0 | 302 clrf EEADRH |
| 197 | 303 read_int_eeprom d'34' ; Read deco data |
| 304 movlw d'1' ; Gauge mode | |
| 0 | 305 cpfseq EEDATA |
| 197 | 306 bra restart_3_test_ppO2_mode ; check for ppO2 mode |
| 307 bsf gauge_mode ; Set flag for gauge mode | |
| 308 bsf no_deco_customviews ; Set no-deco-mode-flag | |
| 309 return ; start in Surfacemode | |
| 0 | 310 restart_3_test_ppO2_mode: |
| 197 | 311 movlw d'2' ; const ppO2 mode |
| 0 | 312 cpfseq EEDATA |
| 197 | 313 bra restart_3_test_apnoe_mode; check for apnoe mode |
| 314 bsf FLAG_const_ppO2_mode ; Set flag for ppO2 mode | |
| 315 return ; start in Surfacemode | |
| 0 | 316 restart_3_test_apnoe_mode: |
| 197 | 317 movlw d'3' ; Apnoe mode |
| 0 | 318 cpfseq EEDATA |
| 197 | 319 bra restart_4_test_gf_mode ; check for GF OC mode |
| 320 bsf FLAG_apnoe_mode ; Set flag for Apnoe Mode | |
| 321 bsf no_deco_customviews ; Set no-deco-mode-flag | |
| 322 return ; start in Surfacemode | |
| 0 | 323 restart_4_test_gf_mode: |
| 197 | 324 movlw d'4' ; GF OC mode |
| 0 | 325 cpfseq EEDATA |
| 197 | 326 bra restart_5_test_gfO2_mode ; check for GF CC mode |
| 0 | 327 movlw d'1' |
| 197 | 328 movff WREG,char_I_deco_model ; Set Flagbyte for GF method |
| 45 | 329 ; Load GF values into RAM |
| 667 | 330 rcall restart_load_gf |
| 197 | 331 return ; start in Surfacemode |
| 0 | 332 restart_5_test_gfO2_mode: |
| 197 | 333 movlw d'5' ; GF CC mode |
| 0 | 334 cpfseq EEDATA |
|
592
cda5b45b953f
NEW: Deco mode "pSCR-GF": Computes deco and CNS based on pSCR parameters (CF62/63)
heinrichsweikamp
parents:
578
diff
changeset
|
335 bra restart_5_test_pSCR_mode ; check for pSCR-GF |
| 197 | 336 bsf FLAG_const_ppO2_mode ; Set flag for ppO2 mode |
| 0 | 337 movlw d'1' |
| 197 | 338 movff WREG,char_I_deco_model ; Set Flagbyte for GF method |
| 137 | 339 ; Load GF values into RAM |
| 667 | 340 rcall restart_load_gf |
| 197 | 341 return ; start in Surfacemode |
|
592
cda5b45b953f
NEW: Deco mode "pSCR-GF": Computes deco and CNS based on pSCR parameters (CF62/63)
heinrichsweikamp
parents:
578
diff
changeset
|
342 restart_5_test_pSCR_mode: |
|
cda5b45b953f
NEW: Deco mode "pSCR-GF": Computes deco and CNS based on pSCR parameters (CF62/63)
heinrichsweikamp
parents:
578
diff
changeset
|
343 movlw d'6' ; pSCR-GF |
|
cda5b45b953f
NEW: Deco mode "pSCR-GF": Computes deco and CNS based on pSCR parameters (CF62/63)
heinrichsweikamp
parents:
578
diff
changeset
|
344 cpfseq EEDATA |
|
cda5b45b953f
NEW: Deco mode "pSCR-GF": Computes deco and CNS based on pSCR parameters (CF62/63)
heinrichsweikamp
parents:
578
diff
changeset
|
345 return ; start in Surfacemode |
|
cda5b45b953f
NEW: Deco mode "pSCR-GF": Computes deco and CNS based on pSCR parameters (CF62/63)
heinrichsweikamp
parents:
578
diff
changeset
|
346 bcf FLAG_const_ppO2_mode ; Clear flag for ppO2 mode |
|
cda5b45b953f
NEW: Deco mode "pSCR-GF": Computes deco and CNS based on pSCR parameters (CF62/63)
heinrichsweikamp
parents:
578
diff
changeset
|
347 movlw d'1' |
|
cda5b45b953f
NEW: Deco mode "pSCR-GF": Computes deco and CNS based on pSCR parameters (CF62/63)
heinrichsweikamp
parents:
578
diff
changeset
|
348 movff WREG,char_I_deco_model ; Set Flagbyte for GF method |
|
cda5b45b953f
NEW: Deco mode "pSCR-GF": Computes deco and CNS based on pSCR parameters (CF62/63)
heinrichsweikamp
parents:
578
diff
changeset
|
349 ; Load GF values into RAM |
| 667 | 350 rcall restart_load_gf |
| 351 return ; start in Surfacemode | |
| 352 | |
| 353 restart_load_gf: | |
| 668 | 354 btfsc use_aGF |
| 667 | 355 bra restart_load_gf2 ; Use aGf |
| 356 ; Use normal GF | |
| 357 ; Load GF values into RAM | |
|
592
cda5b45b953f
NEW: Deco mode "pSCR-GF": Computes deco and CNS based on pSCR parameters (CF62/63)
heinrichsweikamp
parents:
578
diff
changeset
|
358 GETCUSTOM8 d'32' ; GF low |
| 667 | 359 movff EEDATA,char_I_GF_Low_percentage |
|
592
cda5b45b953f
NEW: Deco mode "pSCR-GF": Computes deco and CNS based on pSCR parameters (CF62/63)
heinrichsweikamp
parents:
578
diff
changeset
|
360 GETCUSTOM8 d'33' ; GF high |
| 667 | 361 movff EEDATA,char_I_GF_High_percentage |
| 362 return ; Done. | |
| 363 restart_load_gf2: ; Use aGf | |
| 364 ; Load GF values into RAM | |
| 365 GETCUSTOM8 d'67' ; aGF low | |
| 366 movff EEDATA,char_I_GF_Low_percentage | |
| 367 GETCUSTOM8 d'68' ; aGF high | |
| 368 movff EEDATA,char_I_GF_High_percentage | |
| 369 return ; Done. | |
| 370 | |
|
592
cda5b45b953f
NEW: Deco mode "pSCR-GF": Computes deco and CNS based on pSCR parameters (CF62/63)
heinrichsweikamp
parents:
578
diff
changeset
|
371 |
| 197 | 372 ;============================================================================= |
| 0 | 373 |
| 374 startup_screen1: | |
| 681 | 375 call DISP_ClearScreen |
| 376 call DISP_startupscreen1 ; show startup sreen | |
| 0 | 377 startup_screen1_2: |
| 378 movlw d'10' ; timeout for startup screen | |
| 379 movwf temp1 | |
| 380 WAITMS d'200' | |
| 576 | 381 call wait_switches ; Waits until switches are released, resets flag if button stays pressed! |
| 0 | 382 screen1_loop: |
| 337 | 383 btfsc uart_dump_screen ; Asked to dump screen contains ? |
| 384 call dump_screen ; Yes! | |
| 385 | |
| 0 | 386 btfsc onesecupdate ; do every second tasks? |
| 387 call set_dive_modes ; tests if depth>threshold | |
| 388 btfsc onesecupdate ; do every second tasks? | |
| 389 decf temp1,F | |
| 390 bcf onesecupdate ; every second tasks done | |
| 391 | |
| 392 tstfsz temp1 ; timout occured? | |
| 393 bra screen1_loop2 ; no | |
| 394 return | |
| 395 | |
| 396 screen1_loop2: | |
| 397 btfsc divemode ; Divemode active? | |
| 398 return | |
| 399 btfsc switch_left ; Ack? | |
| 400 return | |
| 401 btfsc switch_right ; Ack? | |
| 402 return | |
| 403 bra screen1_loop ; loop screen | |
| 404 | |
| 405 startup_screen2: | |
| 681 | 406 call DISP_ClearScreen ; Page 1 |
| 407 call DISP_startupscreen2 ; show startup sreen | |
| 0 | 408 bra startup_screen1_2 |
| 409 | |
| 410 startup_screen3a:; WARNING: Also used for decodescriptions and CF Warning screen! | |
| 411 movwf temp1 | |
| 412 WAITMS d'200' | |
| 576 | 413 call wait_switches ; Waits until switches are released, resets flag if button stays pressed! |
| 0 | 414 screen3_loop: |
| 337 | 415 btfsc uart_dump_screen ; Asked to dump screen contains ? |
| 416 call dump_screen ; Yes! | |
| 417 | |
| 0 | 418 btfsc onesecupdate ; do every second tasks? |
| 419 call set_dive_modes ; tests if depth>threshold | |
| 420 | |
| 421 btfsc onesecupdate ; do every second tasks? | |
| 422 decf temp1,F | |
| 423 bcf onesecupdate ; every second tasks done | |
| 424 | |
| 425 tstfsz temp1 ; timout occured? | |
| 426 bra screen3_loop2 ; no | |
| 427 return | |
| 428 screen3_loop2: | |
| 429 btfsc switch_left ; Ack? | |
| 430 return | |
| 431 btfsc switch_right ; Ack? | |
| 432 return | |
| 433 bra screen3_loop ; loop screen | |
| 434 | |
| 337 | 435 ;============================================================================= |
| 436 | |
| 306 | 437 first_start: |
| 438 movlw max_custom_number ; Defined in definitions.asm | |
| 439 movwf EEDATA | |
| 440 write_int_eeprom d'92' ; Store number of CF used in this firmware | |
| 441 bra start3 ; continue with normal start | |
| 442 | |
| 0 | 443 init: |
| 466 | 444 movlw OSCCON_VALUE |
| 0 | 445 movwf OSCCON |
| 446 | |
| 447 movlw b'00010001' ; I/O Ports | |
| 448 movwf TRISA | |
| 449 clrf PORTA | |
| 450 movlw b'00000011' | |
| 451 movwf TRISB | |
| 452 clrf PORTB | |
| 453 movlw b'11011101' ; UART | |
| 454 movwf TRISC | |
| 455 clrf PORTC | |
| 456 movlw b'00000000' | |
| 457 movwf TRISE | |
| 458 clrf PORTE | |
| 459 movlw b'00000000' | |
| 460 movwf TRISD | |
| 461 clrf PORTD | |
| 462 | |
| 463 movlw b'01000000' ; Bit6: PPL enable | |
| 464 movwf OSCTUNE | |
| 465 | |
| 466 | 466 movlw T0CON_VALUE ; Timer0 |
| 0 | 467 movwf T0CON |
| 468 | |
| 469 movlw b'00000111' ; Timer1 | |
| 470 movwf T1CON | |
| 471 | |
| 472 movlw b'11010000' ; Interrups | |
| 473 movwf INTCON | |
| 474 movlw b'00000101' | |
| 475 movwf INTCON2 | |
| 476 movlw b'00001000' | |
| 477 movwf INTCON3 | |
| 478 movlw b'00100001' | |
| 479 movwf PIE1 | |
| 480 movlw b'00000000' | |
| 481 movwf PIE2 | |
| 482 clrf RCON | |
| 483 | |
| 484 movlw b'00000000' ; A/D Converter | |
| 485 movwf ADCON0 | |
| 486 movlw b'00001110' | |
| 487 movwf ADCON1 | |
| 488 movlw b'10001010' ; Right justified | |
| 489 movwf ADCON2 | |
| 490 | |
| 491 clrf SSPCON1 ; Set I²C Mode | |
| 537 | 492 movlw SSPSTAT_VALUE |
| 0 | 493 movwf SSPSTAT |
| 494 movlw b'00101000' | |
| 495 movwf SSPCON1 | |
| 496 movlw b'00000000' | |
| 497 movwf SSPCON2 | |
| 466 | 498 movlw SSPADD_VALUE ; I²C Speed |
| 0 | 499 movwf SSPADD |
| 500 | |
| 501 clrf CCP1CON ; PWM Module off | |
| 502 clrf ECCP1CON ; PWM Module off | |
| 503 | |
| 504 movlw b'00000111' ; Comperator Module off | |
| 505 movwf CMCON | |
| 506 | |
| 507 movlw b'00100000' | |
| 508 movwf CANCON ; ECAN Module OFF | |
| 509 | |
| 510 movlw b'00100100' ; UART | |
| 511 movwf TXSTA | |
| 512 movlw b'10010000' | |
| 513 movwf RCSTA | |
| 514 movlw b'00001000' | |
| 515 movwf BAUDCON | |
| 516 clrf SPBRGH | |
| 466 | 517 movlw SPBRG_VALUE |
| 0 | 518 movwf SPBRG |
| 519 clrf RCREG | |
| 520 clrf PIR1 | |
| 521 return |