Mercurial > public > mk2
annotate code_part1/OSTC_code_asm_part1/start.asm @ 186:57a654c199ae
BUGFIX Gradient Factor algo.
+ Fix calc_hauptroutine_update_tissues() crazzy calculation in GF mode for deco limit.
+ Backup lock/GF_step/deco_pointer during ascent simulation.
| author | JeanDo |
|---|---|
| date | Wed, 02 Feb 2011 00:09:30 +0100 |
| parents | e26f49674956 |
| children | f15e804ff67f |
| 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 | |
| 119 | 27 movff STKPTR,temp10 |
| 0 | 28 call init |
| 29 btfsc divemode ; Reset from Divemode? | |
| 30 call PLED_resetdebugger ; Yes! Something went wrong, show reset informations | |
| 31 | |
| 32 clrf STKPTR ; Clear Stackpointer | |
|
98
6f8e3a08011e
1.73beta rc1 (Added new customview for divemode)
heinrichsweikamp
parents:
97
diff
changeset
|
33 lfsr FSR0, 10Bh ; Clear rambank 1-9, do not delete RTC registers |
| 0 | 34 clear_rambank: |
| 35 clrf POSTINC0 | |
| 36 movlw 0x0A | |
| 37 cpfseq FSR0H ; Bank 9 done? | |
| 38 bra clear_rambank ; clear... | |
| 39 | |
| 40 ; Defaults for RTC | |
| 41 call disable_rs232 ; disable UART module | |
| 42 call RTCinit ; reset RTC | |
| 43 | |
| 97 | 44 ; Extra power-up reset jDG jDG jDG jDG |
|
83
3e351e25f5d1
adding anti-aliased fonts frame and merging some patches from Jeando
heinrichsweikamp
parents:
62
diff
changeset
|
45 ifdef TESTING |
| 97 | 46 call do_menu_reset_all2 |
|
83
3e351e25f5d1
adding anti-aliased fonts frame and merging some patches from Jeando
heinrichsweikamp
parents:
62
diff
changeset
|
47 endif |
|
3e351e25f5d1
adding anti-aliased fonts frame and merging some patches from Jeando
heinrichsweikamp
parents:
62
diff
changeset
|
48 ; DONE jDG jDG jDG jDG |
|
3e351e25f5d1
adding anti-aliased fonts frame and merging some patches from Jeando
heinrichsweikamp
parents:
62
diff
changeset
|
49 |
| 0 | 50 ; Air pressure compensation after reset |
| 51 call get_calibration_data ; Get calibration data from pressure sensor | |
| 52 | |
| 53 bcf pressure_refresh | |
| 54 wait_start_pressure: | |
| 55 btfss pressure_refresh ; Air pressure compensation | |
| 56 bra wait_start_pressure | |
| 57 | |
| 58 clrf rel_pressure+0 | |
| 59 clrf rel_pressure+1 | |
| 60 clrf surface_interval+0 | |
| 61 clrf surface_interval+1 | |
| 62 | |
| 63 bsf sleepmode ; Routine only works in sleepmode... | |
| 64 call pressuretest_sleep_fast ; Gets pressure without averaging (faster!) | |
| 65 bcf sleepmode ; Normal mode again | |
| 66 | |
| 67 movff amb_pressure+0,last_surfpressure+0 | |
| 68 movff amb_pressure+1,last_surfpressure+1 | |
| 69 movff amb_pressure+0,last_surfpressure_15min+0 | |
| 70 movff amb_pressure+1,last_surfpressure_15min+1 | |
| 71 movff amb_pressure+0,last_surfpressure_30min+0 | |
| 72 movff amb_pressure+1,last_surfpressure_30min+1 ; Rests all airpressure registers | |
| 73 | |
| 74 ; reset deco data | |
| 75 incf nofly_time+0,F ; =1 | |
| 76 clrf wait_temp ; Use as buffer | |
| 77 movff wait_temp,char_I_He_ratio ; No He at the Surface | |
| 78 movlw d'79' ; 79% N2 | |
| 79 movwf wait_temp ; Use as buffer | |
| 80 movff wait_temp,char_I_N2_ratio ; No He at the Surface | |
| 81 movff amb_pressure+0,int_I_pres_respiration+0 ; copy surface air pressure to deco routine | |
| 82 movff amb_pressure+1,int_I_pres_respiration+1 | |
| 83 | |
| 31 | 84 movlw d'0' |
| 85 movff WREG,char_I_step_is_1min ; 2 second deco mode | |
| 116 | 86 call deco_clear_tissue ; |
| 87 call deco_calc_desaturation_time ; calculate desaturation time | |
| 88 call deco_clear_CNS_fraction ; clear CNS | |
| 0 | 89 call calc_deko_surfmode ; calculate desaturation every minute |
| 116 | 90 call deco_calc_wo_deco_step_1_min ; calculate deco in surface mode |
| 0 | 91 movlb b'00000001' ; select ram bank 1 |
| 92 | |
| 93 ; check firmware and reset Custom Functions after an update | |
| 94 movlw LOW 0x101 | |
| 95 movwf EEADR | |
| 96 movlw HIGH 0x101 | |
| 97 movwf EEADRH | |
| 98 call read_eeprom ; read current version x | |
| 99 movff EEDATA,temp1 | |
| 100 incf EEADR,F ; set to 0x102 | |
| 101 call read_eeprom ; read current version y | |
| 102 movff EEDATA,temp2 | |
| 103 clrf EEADRH ; Reset EEADRH | |
| 104 | |
| 105 movlw softwareversion_x | |
| 106 cpfseq temp1 ; compare version x | |
| 107 bra check_firmware_new ; is not equal -> reset CF and store new version in EEPROM | |
| 108 | |
| 109 movlw softwareversion_y | |
| 110 cpfseq temp2 ; compare version y | |
| 111 bra check_firmware_new ; is not equal -> reset CF and store new version in EEPROM | |
| 112 bra restart ; x and y are equal -> do not reset cf | |
| 113 | |
| 114 check_firmware_new: | |
| 115 movlw LOW 0x101 ; store current version in EEPROM | |
| 116 movwf EEADR | |
| 117 movlw HIGH 0x101 | |
| 118 movwf EEADRH | |
| 119 movlw softwareversion_x | |
| 120 movwf EEDATA | |
| 121 call write_eeprom ; write version x | |
| 122 incf EEADR,F ; set to 0x102 | |
| 123 movlw softwareversion_y | |
| 124 movwf EEDATA | |
| 125 call write_eeprom ; write version y | |
| 126 clrf EEADRH ; Reset EEADRH | |
| 160 | 127 ; goto reset_all_cf ; resets all custom functions bank0 and bank1 and jumps to "restart" |
| 52 | 128 ; goto reset_all_cf_bank1 ; resets all custom functions bank1 and jumps to "restart" |
| 0 | 129 |
| 130 restart: | |
| 21 | 131 bcf LED_red |
| 132 bcf LED_blue ; all LEDs off | |
| 43 | 133 GETCUSTOM8 d'48' ; time correction value |
| 134 movff WREG, time_correction_value ; store in Bank0 register | |
| 15 | 135 |
| 136 clrf flag1 ; clear all flags | |
| 137 clrf flag2 | |
| 138 clrf flag3 | |
| 139 clrf flag4 | |
| 140 clrf flag5 | |
| 141 clrf flag6 | |
| 142 clrf flag7 | |
| 143 clrf flag8 | |
| 144 clrf flag9 | |
| 145 clrf flag10 | |
| 146 clrf flag11 | |
| 147 clrf flag12 | |
| 148 clrf flag13 | |
| 149 clrf flag14 | |
| 150 clrf flag15 | |
| 153 | 151 |
|
169
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
167
diff
changeset
|
152 ; Should we set win_flip_screen ? |
|
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
167
diff
changeset
|
153 bsf flag1,0 ; Precondition to yes |
| 153 | 154 clrf EEADRH ; Reset EEADRH |
| 155 read_int_eeprom d'1' | |
| 156 movlw .7 | |
|
169
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
167
diff
changeset
|
157 cpfsgt EEDATA ; serial > 2048 (Mk2n hardware) ? |
| 153 | 158 bcf flag1,0 |
|
169
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
167
diff
changeset
|
159 incf EEDATA,W ; serial == 65535 (emulation) ? |
|
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
167
diff
changeset
|
160 btfsc STATUS,Z |
|
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
167
diff
changeset
|
161 bcf flag1,0 |
| 153 | 162 movff flag1,win_flags ; store in Bank0 register |
| 163 clrf flag1 ; Clear flag1 (again) | |
|
169
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
167
diff
changeset
|
164 |
|
e26f49674956
Merge decoplan display for both GF and Buhlmann models.
JeanDo
parents:
167
diff
changeset
|
165 ; Should we disable sleep (hardware emulator) |
| 154 | 166 movlw .0 |
| 167 cpfsgt EEDATA ; >256 | |
| 167 | 168 bsf nsm ; NO-SLEEP-MODE : for hardware debugging |
| 153 | 169 |
| 142 | 170 call gassetup_sort_gaslist ; Sorts Gaslist according to change depth |
| 171 call PLED_boot ; PLED boot (Incl. Clear Screen!) | |
| 0 | 172 WIN_TOP .0 |
| 173 WIN_LEFT .0 | |
| 174 WIN_FONT FT_SMALL | |
| 175 WIN_INVERT .0 ; Init new Wordprocessor | |
|
83
3e351e25f5d1
adding anti-aliased fonts frame and merging some patches from Jeando
heinrichsweikamp
parents:
62
diff
changeset
|
176 setf WREG |
|
3e351e25f5d1
adding anti-aliased fonts frame and merging some patches from Jeando
heinrichsweikamp
parents:
62
diff
changeset
|
177 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
|
178 movff WREG,win_color2 |
| 0 | 179 call I2CReset ; Just in Case any I2C device blocks the Bus |
| 180 movff last_surfpressure_30min+0,last_surfpressure+0 ; Use 30min old airpressure | |
| 181 movff last_surfpressure_30min+1,last_surfpressure+1 ; Use 30min old airpressure | |
| 182 | |
| 183 ; Check if new CF were added in the last firmware version | |
| 184 clrf EEADRH | |
| 185 read_int_eeprom d'92' ; Read number of CF used in this firmware | |
| 186 movlw max_custom_number ; Defined in definitions.asm | |
| 187 cpfseq EEDATA ; Compare with last version | |
| 188 bra restart_01 ; New CF, show warning and store new number | |
| 189 bra restart_1 ; No new CF, continue with boot | |
| 190 restart_01: | |
| 191 ; Save new number of current CF count | |
| 192 rcall display_new_cf_installed; Show warning | |
| 193 movlw max_custom_number ; Defined in definitions.asm | |
| 194 movwf EEDATA | |
| 195 write_int_eeprom d'92' ; Store number of CF used in this firmware | |
| 196 | |
| 197 restart_1: | |
| 198 | |
| 199 ; Set Debug mode? | |
| 200 read_int_eeprom d'39' | |
| 201 bsf debug_mode | |
| 202 movlw d'1' | |
| 203 cpfseq EEDATA | |
| 204 bcf debug_mode ; clear flag if <> 1 | |
| 205 | |
| 206 goto surfloop ; Jump to Surfaceloop! | |
| 207 | |
| 208 | |
| 209 display_new_cf_installed: | |
| 210 call PLED_new_cf_warning ; Display new CF warning screen | |
| 211 movlw d'20' ; timeout for warning screen | |
| 212 bra startup_screen3a ; Will RETURN after timeout or button press | |
| 213 | |
| 214 restart_set_modes_and_flags: ; "Call"ed from divemode, as well! | |
| 215 bcf gauge_mode | |
| 216 bcf FLAG_const_ppO2_mode | |
| 217 bcf FLAG_apnoe_mode | |
| 45 | 218 |
| 219 ; Pre-load modes for OC, GF 90/90 and no Aponoe or Gauge. | |
| 137 | 220 bcf no_deco_customviews ; Clear no-deco-mode-flag |
| 45 | 221 movlw d'0' |
| 222 movwf wait_temp | |
| 223 movff wait_temp,char_I_deco_model ; Clear Flagbyte | |
| 224 ; Load GF values into RAM | |
| 225 movlw d'90' | |
| 226 movwf wait_temp | |
| 163 | 227 movff wait_temp,char_I_GF_Low_percentage |
| 228 movff wait_temp,char_I_GF_High_percentage ; Set to 90/90... | |
| 0 | 229 clrf EEADRH |
| 230 read_int_eeprom d'34' ; Read deco data | |
| 231 movlw d'1' ; Gauge mode | |
| 232 cpfseq EEDATA | |
| 233 bra restart_3_test_ppO2_mode; check for ppO2 mode | |
| 234 bsf gauge_mode ; Set flag for gauge mode | |
| 137 | 235 bsf no_deco_customviews ; Set no-deco-mode-flag |
| 0 | 236 return ; start in Surfacemode |
| 237 restart_3_test_ppO2_mode: | |
| 238 movlw d'2' ; const ppO2 mode | |
| 239 cpfseq EEDATA | |
| 240 bra restart_3_test_apnoe_mode; check for apnoe mode | |
| 241 bsf FLAG_const_ppO2_mode ; Set flag for ppO2 mode | |
| 242 return ; start in Surfacemode | |
| 243 restart_3_test_apnoe_mode: | |
| 244 movlw d'3' ; Apnoe mode | |
| 245 cpfseq EEDATA | |
| 246 bra restart_4_test_gf_mode ; check for GF OC mode | |
| 247 bsf FLAG_apnoe_mode ; Set flag for Apnoe Mode | |
| 137 | 248 bsf no_deco_customviews ; Set no-deco-mode-flag |
| 0 | 249 return ; start in Surfacemode |
| 250 restart_4_test_gf_mode: | |
| 251 movlw d'4' ; GF OC mode | |
| 252 cpfseq EEDATA | |
| 253 bra restart_5_test_gfO2_mode; check for GF CC mode | |
| 254 movlw d'1' | |
| 255 movwf wait_temp | |
| 256 movff wait_temp,char_I_deco_model ; Set Flagbyte for GF method | |
| 45 | 257 ; Load GF values into RAM |
| 258 GETCUSTOM8 d'32' ; GF low | |
| 163 | 259 movff EEDATA,char_I_GF_Low_percentage |
| 45 | 260 GETCUSTOM8 d'33' ; GF high |
| 163 | 261 movff EEDATA,char_I_GF_High_percentage |
| 0 | 262 return ; start in Surfacemode |
| 263 restart_5_test_gfO2_mode: | |
| 264 movlw d'5' ; GF CC mode | |
| 265 cpfseq EEDATA | |
| 266 return ; Start in Surfacemode | |
| 267 bsf FLAG_const_ppO2_mode ; Set flag for ppO2 mode | |
| 268 movlw d'1' | |
| 269 movwf wait_temp | |
| 270 movff wait_temp,char_I_deco_model ; Set Flagbyte for GF method | |
| 137 | 271 ; Load GF values into RAM |
| 45 | 272 GETCUSTOM8 d'32' ; GF low |
| 163 | 273 movff EEDATA,char_I_GF_Low_percentage |
| 45 | 274 GETCUSTOM8 d'33' ; GF high |
| 163 | 275 movff EEDATA,char_I_GF_High_percentage |
| 0 | 276 return ; start in Surfacemode |
| 277 | |
| 278 startup_screen1: | |
| 279 call PLED_ClearScreen | |
| 280 call PLED_startupscreen1 ; show startup sreen | |
| 281 startup_screen1_2: | |
| 282 movlw d'10' ; timeout for startup screen | |
| 283 movwf temp1 | |
| 284 WAITMS d'200' | |
| 285 bcf switch_left | |
| 286 bcf switch_right | |
| 287 screen1_loop: | |
| 288 btfsc onesecupdate ; do every second tasks? | |
| 289 call set_dive_modes ; tests if depth>threshold | |
| 290 btfsc onesecupdate ; do every second tasks? | |
| 291 decf temp1,F | |
| 292 bcf onesecupdate ; every second tasks done | |
| 293 | |
| 294 tstfsz temp1 ; timout occured? | |
| 295 bra screen1_loop2 ; no | |
| 296 return | |
| 297 | |
| 298 screen1_loop2: | |
| 299 btfsc divemode ; Divemode active? | |
| 300 return | |
| 301 btfsc switch_left ; Ack? | |
| 302 return | |
| 303 btfsc switch_right ; Ack? | |
| 304 return | |
| 305 bra screen1_loop ; loop screen | |
| 306 | |
| 307 startup_screen2: | |
| 308 call PLED_ClearScreen ; Page 1 | |
| 309 call PLED_startupscreen2 ; show startup sreen | |
| 310 bra startup_screen1_2 | |
| 311 | |
| 312 startup_screen3a:; WARNING: Also used for decodescriptions and CF Warning screen! | |
| 313 movwf temp1 | |
| 314 WAITMS d'200' | |
| 315 bcf switch_left | |
| 316 bcf switch_right | |
| 317 screen3_loop: | |
| 318 btfsc onesecupdate ; do every second tasks? | |
| 319 call set_dive_modes ; tests if depth>threshold | |
| 320 | |
| 321 btfsc onesecupdate ; do every second tasks? | |
| 322 decf temp1,F | |
| 323 bcf onesecupdate ; every second tasks done | |
| 324 | |
| 325 tstfsz temp1 ; timout occured? | |
| 326 bra screen3_loop2 ; no | |
| 327 return | |
| 328 screen3_loop2: | |
| 329 btfsc switch_left ; Ack? | |
| 330 return | |
| 331 btfsc switch_right ; Ack? | |
| 332 return | |
| 333 bra screen3_loop ; loop screen | |
| 334 | |
| 335 init: | |
| 336 movlw b'01101100' ; 4MHz (x4 PLL) | |
| 337 movwf OSCCON | |
| 338 | |
| 339 movlw b'00010001' ; I/O Ports | |
| 340 movwf TRISA | |
| 341 clrf PORTA | |
| 342 movlw b'00000011' | |
| 343 movwf TRISB | |
| 344 clrf PORTB | |
| 345 movlw b'11011101' ; UART | |
| 346 movwf TRISC | |
| 347 clrf PORTC | |
| 348 movlw b'00000000' | |
| 349 movwf TRISE | |
| 350 clrf PORTE | |
| 351 movlw b'00000000' | |
| 352 movwf TRISD | |
| 353 clrf PORTD | |
| 354 | |
| 355 movlw b'01000000' ; Bit6: PPL enable | |
| 356 movwf OSCTUNE | |
| 357 | |
| 358 movlw b'00011111' ; Timer0 | |
| 359 movwf T0CON | |
| 360 | |
| 361 movlw b'00000111' ; Timer1 | |
| 362 movwf T1CON | |
| 363 | |
| 364 movlw b'11010000' ; Interrups | |
| 365 movwf INTCON | |
| 366 movlw b'00000101' | |
| 367 movwf INTCON2 | |
| 368 movlw b'00001000' | |
| 369 movwf INTCON3 | |
| 370 movlw b'00100001' | |
| 371 movwf PIE1 | |
| 372 movlw b'00000000' | |
| 373 movwf PIE2 | |
| 374 clrf RCON | |
| 375 | |
| 376 movlw b'00000000' ; A/D Converter | |
| 377 movwf ADCON0 | |
| 378 movlw b'00001110' | |
| 379 movwf ADCON1 | |
| 380 movlw b'10001010' ; Right justified | |
| 381 movwf ADCON2 | |
| 382 | |
| 383 clrf SSPCON1 ; Set I²C Mode | |
| 384 movlw b'00000000' | |
| 385 movwf SSPSTAT | |
| 386 movlw b'00101000' | |
| 387 movwf SSPCON1 | |
| 388 movlw b'00000000' | |
| 389 movwf SSPCON2 | |
| 390 movlw d'8' ; 400kHz I2C clock @ 16MHz Fcy | |
| 391 movwf SSPADD | |
| 392 | |
| 393 clrf CCP1CON ; PWM Module off | |
| 394 clrf ECCP1CON ; PWM Module off | |
| 395 | |
| 396 movlw b'00000111' ; Comperator Module off | |
| 397 movwf CMCON | |
| 398 | |
| 399 movlw b'00100000' | |
| 400 movwf CANCON ; ECAN Module OFF | |
| 401 | |
| 402 movlw b'00100100' ; UART | |
| 403 movwf TXSTA | |
| 404 movlw b'10010000' | |
| 405 movwf RCSTA | |
| 406 movlw b'00001000' | |
| 407 movwf BAUDCON | |
| 408 clrf SPBRGH | |
| 409 movlw d'34' | |
| 410 movwf SPBRG | |
| 411 clrf RCREG | |
| 412 clrf PIR1 | |
| 413 return |