Mercurial > public > mk2
annotate code_part1/OSTC_code_asm_part1/isr.asm @ 293:e0083f259552
BUGFIX char_O_gradient_factor calculation in GF model.
| author | JeanDo |
|---|---|
| date | Wed, 27 Apr 2011 17:24:01 +0200 |
| parents | 4ec488f046f4 |
| children | ceedf078b2d8 |
| rev | line source |
|---|---|
| 0 | 1 |
| 2 ; OSTC - diving computer code | |
| 3 ; Copyright (C) 2008 HeinrichsWeikamp GbR | |
| 4 | |
| 5 ; This program is free software: you can redistribute it and/or modify | |
| 6 ; it under the terms of the GNU General Public License as published by | |
| 7 ; the Free Software Foundation, either version 3 of the License, or | |
| 8 ; (at your option) any later version. | |
| 9 | |
| 10 ; This program is distributed in the hope that it will be useful, | |
| 11 ; but WITHOUT ANY WARRANTY; without even the implied warranty of | |
| 12 ; MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
| 13 ; GNU General Public License for more details. | |
| 14 | |
| 15 ; You should have received a copy of the GNU General Public License | |
| 16 ; along with this program. If not, see <http://www.gnu.org/licenses/>. | |
| 17 | |
| 18 | |
| 19 ; written by: Matthias Heinrichs, info@heinrichsweikamp.com | |
| 20 ; written: 10/30/05 | |
| 21 ; last updated: 05/16/08 | |
| 22 ; known bugs: | |
| 23 ; ToDo: | |
| 24 | |
| 25 ; the timer1 module interrupts every 62.5ms (16x/second) | |
| 26 ; temperature and pressure is averaged over 4 measurements | |
| 27 ; flag pressure_refresh is set every 500ms | |
| 28 ; and provides accurate pressure (+/-1mBar stable) and temperature (0.1C stable) | |
| 29 | |
| 30 uartint: | |
| 31 btfsc simulatormode_active ; are we in simulatormode? | |
| 32 bra simulator_int ; Yes, reading is depth in m! | |
| 33 | |
| 34 movff RCREG,uart1_temp | |
| 35 movlw d'96' | |
| 36 subwf uart1_temp,F | |
| 37 dcfsnz uart1_temp,F ; "a" | |
| 38 bsf dump_external_eeprom ; set flag | |
| 39 dcfsnz uart1_temp,F ; "b" | |
| 40 bsf uart_settime ; set flag | |
| 41 dcfsnz uart1_temp,F ; "c" | |
| 42 bsf simulatormode_active ; set flag | |
| 43 dcfsnz uart1_temp,F ; "d" | |
| 44 bsf internal_eeprom_write ; set flag | |
| 45 dcfsnz uart1_temp,F ; "e" | |
| 46 bsf uart_send_hash ; set flag | |
| 47 dcfsnz uart1_temp,F ; "f" | |
| 49 | 48 nop ; no longer used command "f" |
| 0 | 49 dcfsnz uart1_temp,F ; "g" |
| 50 bsf uart_send_int_eeprom ; set flag | |
| 51 dcfsnz uart1_temp,F ; "h" | |
| 52 bsf uart_reset_decodata ; set flag | |
| 53 dcfsnz uart1_temp,F ; "i" | |
| 54 bsf internal_eeprom_write2 ; set flag | |
| 55 dcfsnz uart1_temp,F ; "j" | |
| 56 bsf uart_send_int_eeprom2 ; set flag | |
| 57 dcfsnz uart1_temp,F ; "k" | |
| 58 bsf uart_store_tissue_data ; set flag | |
|
283
4ec488f046f4
Battery sign color coded, work on new uart-started 115200Baud bootloader (Do NOT use yet!)
heinrichsweikamp
parents:
266
diff
changeset
|
59 |
|
4ec488f046f4
Battery sign color coded, work on new uart-started 115200Baud bootloader (Do NOT use yet!)
heinrichsweikamp
parents:
266
diff
changeset
|
60 movlw 0xC1 |
|
4ec488f046f4
Battery sign color coded, work on new uart-started 115200Baud bootloader (Do NOT use yet!)
heinrichsweikamp
parents:
266
diff
changeset
|
61 cpfseq RCREG ; 115200Baud Bootloader request? |
|
4ec488f046f4
Battery sign color coded, work on new uart-started 115200Baud bootloader (Do NOT use yet!)
heinrichsweikamp
parents:
266
diff
changeset
|
62 bra uartint1 ; No |
|
4ec488f046f4
Battery sign color coded, work on new uart-started 115200Baud bootloader (Do NOT use yet!)
heinrichsweikamp
parents:
266
diff
changeset
|
63 bsf uart_115200_bootloader ; Yes, set Flag |
| 0 | 64 |
| 65 | |
| 66 uartint1: | |
| 67 movf RCREG,w ; unload RCREG in stand-alone simulator mode | |
| 68 bcf PIR1,RCIF ; Clear flag | |
| 69 bcf RCSTA,CREN ; Clear receiver status | |
| 70 bsf RCSTA,CREN | |
| 71 return | |
| 72 | |
| 73 simulator_int: | |
| 74 btfsc standalone_simulator ; ignore in standalone simulator mode | |
| 75 bra uartint1 | |
| 76 | |
| 21 | 77 bsf LED_blue |
| 0 | 78 tstfsz RCREG ; =0x00? |
| 79 bra simulator_int1 ; No | |
| 80 incf RCREG,F ; Yes, so force RCREG=1 | |
| 81 | |
| 82 simulator_int1: | |
| 83 movf RCREG,w ; depth in m | |
| 84 mullw d'100' ; result will be mbar | |
| 85 movff PRODL,sim_pressure+0 ; stored for pressure overwrite | |
| 86 movff PRODH,sim_pressure+1 | |
| 87 bra uartint1 ; exit uart int | |
| 88 | |
| 238 | 89 switch_left_int: |
| 0 | 90 bcf INTCON,INT0IF ; Clear flag |
| 91 | |
| 92 btfsc T0CON,TMR0ON ; Timer0 running? | |
| 93 bra timer0_restart ; Yes, restart | |
| 94 | |
| 266 | 95 ; OSTC 2N has flipped screen and exchanged switches... |
| 96 movff win_flags,WREG ; Get into Bank0 | |
| 97 btfss WREG,0 | |
| 0 | 98 bsf switch_left ; Set flag, button press is OK |
| 266 | 99 btfsc WREG,0 |
| 100 bsf switch_right ; Set flag, button press is OK | |
| 0 | 101 |
| 102 bsf T0CON,TMR0ON ; Start Timer 0 | |
| 103 return | |
| 104 | |
| 105 | |
| 238 | 106 switch_right_int: |
| 0 | 107 bcf INTCON3,INT1IF ; Clear flag |
| 108 | |
| 109 btfsc T0CON,TMR0ON ; Timer0 running? | |
| 110 bra timer0_restart ; Yes, restart | |
| 111 | |
| 266 | 112 ; OSTC 2N has flipped screen and exchanged switches... |
| 113 movff win_flags,WREG ; Get into Bank0 | |
| 114 btfsc WREG,0 | |
| 115 bsf switch_left ; Set flag, button press is OK | |
| 116 btfss WREG,0 | |
| 0 | 117 bsf switch_right ; Set flag, button press is OK |
| 118 | |
| 119 bsf T0CON,TMR0ON ; Start Timer 0 | |
| 120 return | |
| 121 | |
| 122 timer0_restart: | |
| 123 bcf INTCON,TMR0IF ; Clear flag | |
| 124 clrf T0CON ; Timer0 | |
| 125 clrf TMR0H | |
| 126 clrf TMR0L | |
| 127 bsf T0CON,TMR0ON ; Start Timer 0 | |
| 128 return | |
| 129 | |
| 130 timer0int: | |
| 131 bcf INTCON,TMR0IF ; Clear flag | |
| 132 bcf T0CON,TMR0ON ; Stop Timer 0 | |
| 133 clrf TMR0H | |
| 134 clrf TMR0L | |
| 135 return | |
| 136 | |
| 137 timer1int: | |
| 138 bcf PIR1,TMR1IF ; Clear flag | |
| 139 | |
| 140 timer1int_debug: | |
| 21 | 141 bcf LED_red ; LEDr off (For charge indicator) |
| 0 | 142 |
| 143 movlw 0x08 ; Timer1 int after 62.5ms (=16/second) | |
| 144 cpfslt TMR1H ; Did we miss a 1/16 second? | |
| 145 incf timer1int_counter1,F ; Yes, add extra 1/16 second | |
| 146 | |
| 147 movlw 0x08 ; Timer1 int after 62.5ms (=16/second) | |
| 148 subwf TMR1H,F | |
| 149 | |
| 238 | 150 incf timer1int_counter1,F ; Increase timer1 counter |
| 151 | |
| 0 | 152 movlw d'15' ; One second 16 |
| 153 cpfsgt timer1int_counter1 | |
| 154 bra sensor_int_pre ; only pressure sensor | |
| 238 | 155 rcall RTCisr ; adjust time, then query pressure sensor |
| 0 | 156 |
| 157 sensor_int_pre: | |
| 238 | 158 btfsc sleepmode ; In sleepmode? |
| 159 return ; Yes | |
| 0 | 160 |
| 161 sensor_int: | |
| 162 btfsc no_sensor_int ; No sensor interrupt (because it's addressed during sleep) | |
| 163 return | |
| 164 | |
| 238 | 165 incf timer1int_counter2,F ; counts to eight for state maschine |
| 0 | 166 |
| 238 | 167 ; State 1: Clear flags and average registers, get temperature (51us) and start pressure integration (73,5us) |
| 168 ; State 2: Get pressure (51us), start temperature integration (73,5us) and calculate temperature compensated pressure (233us) | |
| 169 ; State 3: Get temperature (51us) and start pressure integration (73,5us) | |
| 170 ; State 4: Get pressure (51us), start temperature integration (73,5us) and calculate temperature compensated pressure (233us) | |
| 171 ; State 5: Get temperature (51us) and start pressure integration (73,5us) | |
| 172 ; State 6: Get pressure (51us), start temperature integration (73,5us) and calculate temperature compensated pressure (233us) | |
| 173 ; State 7: Get temperature (51us) and start pressure integration (73,5us) | |
| 174 ; State 8: Get pressure (51us), start temperature integration (73,5us), calculate temperature compensated pressure (233us) and build average for half-second update of tempperature and pressure | |
| 175 | |
| 176 movff timer1int_counter2,isr_divB ; isr_divB used as temp here... | |
| 177 dcfsnz isr_divB,F | |
| 178 bra sensor_int_state1_plus_restart ; Do State 1 | |
| 179 dcfsnz isr_divB,F | |
| 180 bra sensor_int_state2 ; Do State 2 | |
| 181 dcfsnz isr_divB,F | |
| 182 bra sensor_int_state1 ; Do State 3 | |
| 183 dcfsnz isr_divB,F | |
| 184 bra sensor_int_state2 ; Do State 4 | |
| 185 dcfsnz isr_divB,F | |
| 186 bra sensor_int_state1 ; Do State 5 | |
| 187 dcfsnz isr_divB,F | |
| 188 bra sensor_int_state2 ; Do State 6 | |
| 189 dcfsnz isr_divB,F | |
| 190 bra sensor_int_state1 ; Do State 7 | |
| 191 ; bra sensor_int2_plus_average ; Do State 8 | |
| 192 | |
| 193 ;sensor_int2_plus_average: | |
| 194 rcall sensor_int_state2 | |
| 195 sensor_int2_plus_average2: | |
| 0 | 196 bcf STATUS,C |
| 197 rrcf isr3_temp+1 ; isr3_temp / 2 | |
| 198 rrcf isr3_temp+0 | |
| 199 bcf STATUS,C | |
| 200 rrcf temperature_temp+1 ; temperature_temp /2 | |
| 201 rrcf temperature_temp+0 | |
| 238 | 202 |
| 203 bcf STATUS,C | |
| 204 rrcf isr3_temp+1 ; isr3_temp / 4 | |
| 205 rrcf isr3_temp+0 | |
| 206 bcf STATUS,C | |
| 207 rrcf temperature_temp+1 ; temperature_temp /4 | |
| 208 rrcf temperature_temp+0 | |
| 209 | |
| 0 | 210 movff isr3_temp+1,amb_pressure+1 ; copy into actual register |
| 211 movff isr3_temp+0,amb_pressure+0 | |
| 212 | |
| 213 movff temperature_temp+1,temperature+1 | |
| 214 movff temperature_temp+0,temperature+0 | |
| 215 | |
| 216 bsf pressure_refresh ; Set flag! Temp and pressure were updated! | |
| 238 | 217 clrf timer1int_counter2 ; Then reset State counter |
| 0 | 218 |
| 219 btfss simulatormode_active ; are we in simulator mode? | |
| 220 bra comp_air_pressure ; no | |
| 221 | |
| 222 comp_air_pressure0: | |
| 223 movlw LOW d'1000' ; yes, so simulate 1Bar surface pressure | |
| 224 movwf last_surfpressure+0 | |
| 225 movlw HIGH d'1000' | |
| 226 movwf last_surfpressure+1 | |
| 227 | |
| 228 comp_air_pressure: | |
| 229 bcf neg_flag | |
| 230 movf last_surfpressure+0,W ; compensate airpressure | |
| 231 subwf amb_pressure+0,W | |
| 238 | 232 movwf rel_pressure+0 ; rel_pressure stores depth! |
| 0 | 233 |
| 234 movf last_surfpressure+1,W | |
| 235 subwfb amb_pressure+1,W | |
| 236 movwf rel_pressure+1 | |
| 238 | 237 btfss STATUS,N ; result is below zero? |
| 238 return | |
| 239 clrf rel_pressure+0 ; Yes, do not display negative depths | |
| 240 clrf rel_pressure+1 ; e.g. when surface air pressure dropped during the dive | |
| 0 | 241 return |
| 238 | 242 |
| 243 | |
| 244 sensor_int_state1_plus_restart: | |
| 245 bcf pressure_refresh ; clear flags | |
| 246 clrf isr3_temp+0 ; pressure average registers | |
| 247 clrf isr3_temp+1 | |
| 248 clrf temperature_temp+0 | |
| 249 clrf temperature_temp+1 | |
| 250 | |
| 251 sensor_int_state1: | |
| 252 call get_temperature_value ; State 1: Get temperature | |
| 253 call get_pressure_start ; and start pressure integration. | |
| 254 return ; Done. | |
| 255 | |
| 256 sensor_int_state2: | |
| 257 call get_pressure_value ; State2: Get pressure (51us) | |
| 258 call get_temperature_start ; and start temperature integration (73,5us) | |
| 259 call calculate_compensation ; calculate temperature compensated pressure (233us) | |
| 260 movf amb_pressure+0,W | |
| 261 addwf isr3_temp+0 ; average pressure | |
| 262 movf amb_pressure+1,W | |
| 263 addwfc isr3_temp+1 | |
| 264 movf temperature+0,W | |
| 265 addwf temperature_temp+0 ; average temperature | |
| 266 movf temperature+1,W | |
| 267 addwfc temperature_temp+1 | |
| 268 return | |
| 269 | |
| 0 | 270 |
| 271 RTCisr: | |
| 272 clrf timer1int_counter1 ; counts to 16 (one second / 62.5ms) | |
| 273 bsf onesecupdate ; we have a new second! | |
| 274 | |
| 275 bcf STATUS,Z ; are we in dive mode? | |
| 276 btfss divemode | |
| 238 | 277 bra RTCisr2 ; No, must be surface or sleepmode |
| 0 | 278 |
| 279 incf samplesecs,F ; CF20 diving seconds done | |
| 280 decf samplesecs_value,W ; holds CF20 value (minus 1 into WREG) | |
| 281 cpfsgt samplesecs | |
| 238 | 282 bra RTCisr1 ; no |
| 0 | 283 |
| 284 clrf samplesecs ; clear counter... | |
| 285 bsf store_sample ; ...and set bit for profile storage | |
| 238 | 286 |
| 0 | 287 RTCisr1: |
| 288 ; Increase re-setable average depth divetime counter | |
| 111 | 289 incf average_divesecs+0,F ; increase stopwatch registers |
| 0 | 290 btfsc STATUS,Z |
| 111 | 291 incf average_divesecs+1,F ; increase stopwatch registers |
| 0 | 292 |
| 293 btfss divemode2 ; displayed divetime is running? | |
| 294 bra RTCisr2 ; No (e.g. too shallow) | |
| 295 | |
| 296 incf divesecs,F ; increase divetime registers | |
| 297 movlw d'59' | |
| 298 cpfsgt divesecs | |
| 299 bra RTCisr1a | |
| 238 | 300 |
| 0 | 301 clrf divesecs |
| 302 bsf realdive ; this bit is always set (again) if the dive is longer then one minute | |
| 303 | |
| 304 incf divemins+0,F ; increase divemins | |
| 305 btfsc STATUS,Z | |
| 306 incf divemins+1,F ; and now do the realtime clock routine anyway | |
| 307 | |
| 308 RTCisr1a: | |
| 309 btfss FLAG_apnoe_mode ; Are we in Apnoe mode? | |
| 310 bra RTCisr2 ; No, skip the following | |
| 311 | |
| 312 incf apnoe_secs,F ; increase descent registers | |
| 313 movlw d'59' | |
| 314 cpfsgt apnoe_secs | |
| 315 bra RTCisr2 | |
| 316 clrf apnoe_secs | |
| 317 | |
| 318 incf apnoe_mins,F ; increase descent mins | |
| 319 ; Now, do the RTC routine.... | |
| 320 RTCisr2: | |
| 321 incf secs,F ; adjusts seconds, minutes, hours, day, month and year. Checks for a leap year and works until 2099! | |
| 322 movlw d'59' | |
| 323 cpfsgt secs | |
| 324 return | |
| 325 clrf secs | |
| 326 bsf oneminupdate | |
| 327 incf mins,F | |
| 328 movlw d'59' | |
| 329 cpfsgt mins | |
| 330 return | |
| 331 clrf mins | |
| 332 incf hours,F | |
| 333 movlw d'23' | |
| 334 cpfsgt hours | |
| 335 return | |
| 336 clrf hours | |
| 13 | 337 incf day,F |
| 43 | 338 movff time_correction_value,secs ; Correct too slow clock |
| 13 | 339 |
| 0 | 340 check_date: |
| 341 movff month,isr_divB ; new month? | |
| 342 dcfsnz isr_divB,F | |
| 343 movlw .31 | |
| 344 dcfsnz isr_divB,F | |
| 345 movlw .28 | |
| 346 dcfsnz isr_divB,F | |
| 347 movlw .31 | |
| 348 dcfsnz isr_divB,F | |
| 349 movlw .30 | |
| 350 dcfsnz isr_divB,F | |
| 351 movlw .31 | |
| 352 dcfsnz isr_divB,F | |
| 353 movlw .30 | |
| 354 dcfsnz isr_divB,F | |
| 355 movlw .31 | |
| 356 dcfsnz isr_divB,F | |
| 357 movlw .31 | |
| 358 dcfsnz isr_divB,F | |
| 359 movlw .30 | |
| 360 dcfsnz isr_divB,F | |
| 361 movlw .31 | |
| 362 dcfsnz isr_divB,F | |
| 363 movlw .30 | |
| 364 dcfsnz isr_divB,F | |
| 365 movlw .31 | |
| 366 cpfsgt day,1 | |
| 367 return | |
| 368 movlw .1 | |
| 369 movwf day | |
| 370 incf month,F | |
| 371 movlw .12 | |
| 372 cpfsgt month,1 | |
| 373 return | |
| 374 movlw .1 | |
| 375 movwf month | |
| 376 incf year,F | |
| 377 return |