Mercurial > public > hwos_code
view src/isr.asm @ 628:cd58f7fc86db
3.05 stable work
| author | heinrichsweikamp |
|---|---|
| date | Thu, 19 Sep 2019 12:01:29 +0200 |
| parents | c40025d8e750 |
| children | 237931377539 |
line wrap: on
line source
;============================================================================= ; ; File isr.asm combined next generation V3.03.7 ; ; INTERUPT subroutines ; ; Copyright (c) 2011, JD Gascuel, HeinrichsWeikamp, all right reserved. ;============================================================================= ; HISTORY ; 2011-05-24 : [jDG] Cleanups from initial Matthias code. #include "hwos.inc" #include "shared_definitions.h" ; Mailbox from/to p2_deco.c #include "ms5541.inc" #include "adc_lightsensor.inc" extern restore_flash ;============================================================================= ; Code to be placed at fixed position ; isr_high CODE 0x0008 ; high priority interrupts bra HighInt nop nop nop nop nop nop bra HighInt ; *** low priority interrupts are not used *** isr_low CODE 0x00018 ; low priority interrupts retfie FAST ; do an immediate return with restore of BSR, STATUS and WREG ;============================================================================= ; Interrupt Dispatcher ; HighInt: ; initialize interrupt code banksel isr_backup ; default bank for all ISR code is bank ISR data rcall isr_registers_backup ; back-up registers ; serve buttons btfsc PIR1,TMR1IF ; timer 1 interrupt (button hold-down timer)? rcall timer1int ; YES - reset timer btfsc INTCON,INT0IF ; right button activity? rcall isr_switch_right ; YES - check right switch btfsc INTCON3,INT1IF ; left button activity? rcall isr_switch_left ; YES - check left switch IFDEF _external_sensor ; serve IR/S8 link timer btfsc PIR3,RC2IF ; UART 2 interrupt? rcall isr_uart2 ; YES - get a byte from the IR/S8 link btfsc PIR2,TMR3IF ; timer 3 interrupt? rcall isr_timer3 ; YES - check bytes received from IR/S8 link for being a valid telegram ELSE bcf PIR3,RC2IF ; Clear UART 2 interrupt? bcf PIR2,TMR3IF ; Clear timer 3 interrupt? ENDIF ; serve pressure and temperature sensor btfsc PIR5,TMR7IF ; timer 7 interrupt? rcall isr_tmr7 ; YES - do every 62.5 ms tasks: read sensors, set CPU speed ; serve real-time clock (RTCC) btfsc PIR3,RTCCIF ; real-time-clock interrupt? rcall isr_rtcc ; YES - do every 1/2 s tasks: read RTC, trigger timed tasks, adjust CPU speed, gauge battery, etc. ; clean up and exit rcall isr_registers_restore ; restore registers bsf trigger_isr_updates ; signal that the ISR had kicked in retfie FAST ; return from interrupt restoring BSR, STATUS and WREG ;============================================================================= ; CPU speed adjustment ; isr_adjust_speed: movff cpu_speed_request,cpu_speed_state ; acknowledge CPU speed request btfsc speed_is_eco ; speed 'eco' requested? bra isr_set_speed_to_eco ; YES - set eco speed btfsc speed_is_fastest ; NO - speed 'fastest' requested? bra isr_set_speed_to_fastest ; YES - set fastest speed ;bra isr_set_speed_to_normal ; NO - default to normal speed isr_set_speed_to_normal: movlw b'00000000' ; coding for x4 PLL disabled movwf OSCTUNE ; switch off x4 PLL movlw b'01110010' ; select 16 MHz movwf OSCCON ; set prescaler movlw T2CON_NORMAL ; PWM1 dimming factor for speed 'normal' movwf T2CON ; adjust PWM1 for LED dimming bra isr_adjust_speed_exit isr_set_speed_to_eco: movlw b'00000000' ; coding for x4 PLL disabled movwf OSCTUNE ; switch off x4 PLL movlw b'00110010' ; select 1 MHz movwf OSCCON ; set prescaler movlw T2CON_ECO ; PWM1 dimming factor for speed 'eco' movwf T2CON ; adjust PWM1 for LED dimming bra isr_adjust_speed_exit isr_set_speed_to_fastest: movlw b'01110010' ; select 16 MHz by default btfsc lv_core ; on OSTC with low voltage core? movlw b'01100010' ; YES - reduce to 8 MHz movwf OSCCON ; set prescaler movlw b'01000000' ; coding for x4 PLL enable movwf OSCTUNE ; switch on x4 PLL -> 64 MHz on high voltage core, 32 MHz on low voltage core movlw T2CON_FASTEST ; PWM1 dimming factor for speed 'fastest' movwf T2CON ; adjust PWM1 for LED dimming ;bra isr_adjust_speed_exit isr_adjust_speed_exit: btfss OSCCON,HFIOFS ; PLL stabilized? bra isr_adjust_speed_exit ; NO - loop to give it some more time return ; YES - done ; Attention: fill-up the gap between the end of this section ; and the next section which starts at 0x00080 !! nop block_0_code_end: ; marker to find end of code in block 0 in linker report file ;============================================================================= ; jump vector for the bootloader, placed at an appointed position here ; isr_restore CODE 0x00080 ; restore first flash page from EEPROM restore_flash_0x00080: goto restore_flash ;============================================================================= ; back-up and restore registers ; isr_registers_backup: MOVII PRODL,PROD_backup ; back-up PRODH:PRODL return isr_registers_restore: MOVII PROD_backup,PRODL ; restore PRODH:PRODL return ;============================================================================= ; routines for handling digital-attached external sensors ; IFDEF _external_sensor ; Take a byte received on IR/S8 link and slot it into the RX buffer ; isr_uart2: bcf PIR3,RC2IF ; Clear UART 2 interrupt flag banksel RCREG2 ; RC*2 is outside access RAM movff RCREG2,isr_lo ; copy received byte to isr_lo bcf RCSTA2,CREN ; clear receiver status bsf RCSTA2,CREN ; ... banksel isr_backup ; back to default ISR bank movlw .18 ; size of the buffer cpfslt ir_s8_counter ; number of received bytes < buffer size? bra isr_uart2_1 ; NO - buffer full, do not store the byte movf ir_s8_counter,W ; YES - copy number of received bytes to WREG MOVII FSR0L,FSR0_backup ; - back-up FSR0 lfsr FSR0,ir_s8_buffer ; - load base address of buffer movff isr_lo,PLUSW0 ; - store received byte MOVII FSR0_backup,FSR0L ; - restore FSR0 incf ir_s8_counter,F ; - increment number of received bytes by 1 isr_uart2_1: clrf TMR3L ; reload timer 3 movlw .253 ; ... movwf TMR3H ; ... bsf T3CON,TMR3ON ; (re)start timeout timer 3 return ; Timeout on IR/S8 link: check the checksum and gather the received data ; isr_timer3: bcf T3CON,TMR3ON ; stop timer 3 movlw .15 cpfseq ir_s8_counter ; got exactly 15 bytes? bra isr_timer3_1 ; NO - test for 16 bytes bra isr_timer3_ir ; YES - got 15 bytes, compute local checksum isr_timer3_1: movlw .16 cpfseq ir_s8_counter ; got exactly 16 bytes? bra isr_timer3_2 ; NO - test for 17 bytes tstfsz ir_s8_buffer+.15 ; YES - last byte = 0x00 ? bra isr_timer3_exit ; No - exit bra isr_timer3_ir ; YES - got 16 bytes, compute local checksum isr_timer3_2: movlw .17 cpfseq ir_s8_counter ; got exactly 17 bytes? bra isr_timer3_exit ; NO - exit bra isr_timer3_s8 ; YES - S8 data ; Process telegram received on IR link isr_timer3_ir: movlw .12 ; checksum shall be computed for 1st and next 12 bytes rcall compute_IR_S8_checksum ; compute checksum movf ir_s8_buffer+.13,W ; get low byte of the received checksum cpfseq isr_mpr+0 ; = low byte of the calculated local checksum? bra isr_timer3_exit ; NO - exit movf ir_s8_buffer+.14,W ; get high byte of the received checksum cpfseq isr_mpr+1 ; = high byte of the calculated local checksum? bra isr_timer3_exit ; NO - exit ; YES to both - received telegram valid, copy data movff ir_s8_buffer+.1, hud_status_byte movff ir_s8_buffer+.2, sensor1_mv+0 movff ir_s8_buffer+.3, sensor1_mv+1 movff ir_s8_buffer+.4, sensor2_mv+0 movff ir_s8_buffer+.5, sensor2_mv+1 movff ir_s8_buffer+.6, sensor3_mv+0 movff ir_s8_buffer+.7, sensor3_mv+1 movff ir_s8_buffer+.8, sensor1_ppO2 movff ir_s8_buffer+.9, sensor2_ppO2 movff ir_s8_buffer+.10,sensor3_ppO2 movff ir_s8_buffer+.11,hud_battery_mv+0 movff ir_s8_buffer+.12,hud_battery_mv+1 bsf hud_connection_ok ; set manually for hwHUD w/o the HUD module bra isr_timer3_reload ; reload timer and exit ; Process telegram received on S8 link isr_timer3_s8: movlw .14 ; checksum shall be computed for 1st and next 14 bytes rcall compute_IR_S8_checksum ; compute checksum movf ir_s8_buffer+.15,W ; get low byte of the received checksum cpfseq isr_mpr+0 ; = low byte of the calculated local checksum? bra isr_timer3_exit ; NO - exit movf ir_s8_buffer+.16,W ; get high byte of the received checksum cpfseq isr_mpr+1 ; = high byte of the calculated local checksum? bra isr_timer3_exit ; NO - exit ; YES to both - received telegram valid, copy data movff ir_s8_buffer+.3, hud_status_byte movff ir_s8_buffer+.13,hud_battery_mv+0 movff ir_s8_buffer+.14,hud_battery_mv+1 btfsc trigger_S8_data_update ; last data already processed? bra isr_timer3_exit ; NO - skip copying new results (And not reload the timeout) bsf trigger_S8_data_update ; YES - set flag for new data available ; - copy more data movff ir_s8_buffer+.4, s8_rawdata_sensor1+0 movff ir_s8_buffer+.5, s8_rawdata_sensor1+1 movff ir_s8_buffer+.6, s8_rawdata_sensor1+2 movff ir_s8_buffer+.7, s8_rawdata_sensor2+0 movff ir_s8_buffer+.8, s8_rawdata_sensor2+1 movff ir_s8_buffer+.9, s8_rawdata_sensor2+2 movff ir_s8_buffer+.10,s8_rawdata_sensor3+0 movff ir_s8_buffer+.11,s8_rawdata_sensor3+1 movff ir_s8_buffer+.12,s8_rawdata_sensor3+2 isr_timer3_reload: movlw ir_timeout_value ; in multiples of 62.5 ms movwf ir_s8_timeout ; reload timeout isr_timer3_exit: clrf ir_s8_counter ; clear pointer bcf PIR2,TMR3IF ; clear flag return ; compute checksum on data in RX buffer ; compute_IR_S8_checksum: movwf ir_s8_counter ; initialize loop counter from WREG movff ir_s8_buffer+0,isr_mpr+0 ; initialize low byte of the local checksum with first byte in buffer clrf isr_mpr+1 ; clear the high byte of the local checksum lfsr FSR0,ir_s8_buffer ; load base address of the buffer compute_IR_S8_checksum_loop: movf PREINC0,W ; get next byte addwf isr_mpr+0,F ; add it to the to checksum, low byte movlw .0 ; no explicit data to add to the high byte... addwfc isr_mpr+1,F ; ... besides the carry decfsz ir_s8_counter ; decrement number of bytes yet to do, all done? bra compute_IR_S8_checksum_loop ; NO - loop return ; YES - done ENDIF ; _external_sensor ;============================================================================= ;============================================================================= ; Tasks every 62.5 ms: buttons, dimming, pressure/temp sensor and CPU speed ; isr_tmr7: bcf PIR5,TMR7IF ; clear flag movlw .248 ; rollover after 248 cycles -> 62.5 ms movff WREG,TMR7H ; timer 7 is outside access RAM call get_analog_switches ; get analog readings, CAUTION: returns in bank common banksel isr_backup ;back to ISR default bank btfss INTCON3,INT1IE bra isr_tmr7_a btfsc analog_sw2_pressed rcall isr_switch_left ; get digital readings of left switch isr_tmr7_a: btfss INTCON,INT0IE bra isr_tmr7_b btfsc analog_sw1_pressed rcall isr_switch_right ; get digital readings of right switch isr_tmr7_b: btfss block_sensor_interrupt ; sensor interrupts disabled? bra isr_tmr7_c ; NO - continue return ; YES - done isr_tmr7_c: movf max_CCPR1L,W ; dim value cpfseq CCPR1L ; = current PWM value? rcall isr_dimm_tft ; NO - adjust until max_CCPR1L = CCPR1L IFDEF _external_sensor decfsz ir_s8_timeout,F ; IR / S8 digital data still valid? bra isr_tmr7_2 ; YES - continue movlw ir_timeout_value ; NO - get timer reload in multiples of 62.5 ms movwf ir_s8_timeout ; - reload the timer btfss analog_o2_input ; - analog input available? bra isr_tmr7_1a ; NO - clear data btfss s8_digital_avail ; YES - S8 digital interface available? bra isr_tmr7_2 ; NO - must be analog interface in use, keep data isr_tmr7_1a: clrf hud_status_byte ; S8/IR timeout clears all analog input readings to zero -> fallback will be triggered when in sensor mode CLRI hud_battery_mv ; clear battery voltage banksel sensor1_mv ; select bank where sensor data are stored CLRI sensor1_mv ; clear all sensor data CLRI sensor2_mv ; ... CLRI sensor3_mv ; ... clrf sensor1_ppO2 ; ... clrf sensor2_ppO2 ; ... clrf sensor3_ppO2 ; ... banksel s8_rawdata_sensor1 CLRI s8_rawdata_sensor1 ; clear all sensor data (raw data) clrf s8_rawdata_sensor1+2 CLRI s8_rawdata_sensor2 ; clear all sensor data (raw data) clrf s8_rawdata_sensor2+2 CLRI s8_rawdata_sensor3 ; clear all sensor data (raw data) clrf s8_rawdata_sensor3+2 banksel isr_backup ; back to ISR default bank bsf trigger_S8_data_update ; signal a data update ENDIF isr_tmr7_2: btfsc block_sensor_interrupt ; sensor interrupts disabled? return ; YES - abort isr_sensor_state2: btfss sensor_state_counter,0 ; every 1/4 second bsf trigger_quarter_second ; set flag btfss speed_is_normal ; CPU running on normal speed? rcall isr_set_speed_to_normal ; NO - set CPU speed to normal ; update surface pressure btfss update_surface_pressure ; shall update the surface pressure? bra isr_sensor_state2_1 ; NO bcf update_surface_pressure ; YES - clear request flag MOVII pressure_abs_ref,pressure_surf ; - update surface pressure isr_sensor_state2_1: incf sensor_state_counter,F ; counts to eight for state machine ; State 1: clear flags and average registers, get temperature (51 us) and start pressure integration (73.5 us) ; State 2: get pressure (51 us), start temperature integration (73.5 us) and calculate temperature compensated pressure (233 us) ; State 3: get temperature (51 us) and start pressure integration (73.5 us) ; State 4: get pressure (51 us), start temperature integration (73.5 us) and calculate temperature compensated pressure (233 us) ; State 5: get temperature (51 us) and start pressure integration (73.5 us) ; State 6: get pressure (51 us), start temperature integration (73.5 us) and calculate temperature compensated pressure (233 us) ; State 7: get temperature (51 us) and start pressure integration (73.5 us) ; State 8: get pressure (51 us), start temperature integration (73.5 us) and calculate temperature compensated pressure (233 us) and build average for half-second update of temperature and pressure movff sensor_state_counter,WREG ; WREG used as temp here... dcfsnz WREG,F bra sensor_int_state1_plus_restart ; do state 1 dcfsnz WREG,F bra sensor_int_state2 ; do state 2 dcfsnz WREG,F bra sensor_int_state1 ; do state 3 dcfsnz WREG,F bra sensor_int_state2 ; do state 4 dcfsnz WREG,F bra sensor_int_state1 ; do state 5 dcfsnz WREG,F bra sensor_int_state2 ; do state 6 dcfsnz WREG,F bra sensor_int_state1 ; do state 7 ; first, do state 2: call get_pressure_value ; state 2: get pressure (51 us) call get_temperature_start ; and start temperature integration (73.5 us) call calculate_compensation ; calculate temperature compensated pressure (27 us) ; build average for pressure bcf STATUS,C ; clear carry bit rrcf pressure_abs_avg+1 ; divide by 2 rrcf pressure_abs_avg+0 bcf STATUS,C ; clear carry bit rrcf pressure_abs_avg+1 ; divide by 2, again rrcf pressure_abs_avg+0 ; copy into result register MOVII pressure_abs_avg,pressure_abs ; build average for temperature bcf STATUS,C ; clear carry bit by default btfsc temperature_avg+1,7 ; sign bit set? bsf STATUS,C ; YES - copy sign bit to carry bit rrcf temperature_avg+1 ; divide signed temperature by 2 rrcf temperature_avg+0 ; ... bcf STATUS,C ; clear carry bit by default btfsc temperature_avg+1,7 ; sign bit set? bsf STATUS,C ; YES - copy sign bit to carry bit rrcf temperature_avg+1 ; divide signed temperature by 2 again (by 4 in total now) rrcf temperature_avg+0 ; ... MOVII temperature_avg,temperature_cur ; store final result ; check for temperature change movf temperature_cur+0,W ; get current temperature, low byte cpfseq temperature_last+0 ; compare with last temperature, equal? bra isr_sensor_state2_2 ; NO - temperature has changed movf temperature_cur+1,W ; get current temperature, high byte cpfseq temperature_last+1 ; compare with last temperature, equal? bra isr_sensor_state2_2 ; NO - temperature has changed bra isr_sensor_state2_3 ; YES to both - no change isr_sensor_state2_2: MOVII temperature_cur,temperature_last ; store current temperature as last temperature for next round bsf trigger_temp_changed ; set flag for temperature change isr_sensor_state2_3: ; reset state counter and set update flag clrf sensor_state_counter ; reset state counter ; bsf trigger_pres_update ; signal a pressure update btfss reset_max_pressure ; shall clear the max pressure? bra isr_sensor_state2_3a ; NO - continue with checking for pressure change bcf reset_max_pressure ; YES - clear request flag CLRI pressure_rel_max ; - clear max. pressure isr_sensor_state2_3a: ; check for pressure change movf pressure_abs+0,W ; get current pressure, low byte cpfseq pressure_abs_last+0 ; compare with last pressure, equal? bra isr_sensor_state2_4 ; NO - pressure has changed movf pressure_abs+1,W ; YES - get current pressure, high byte cpfseq pressure_abs_last+1 ; - compare with last pressure, equal? bra isr_sensor_state2_4 ; NO - pressure has changed bra isr_sensor_state2_5 ; YES - no change isr_sensor_state2_4: MOVII pressure_abs,pressure_abs_last ; store current pressure as last pressure for next round bsf trigger_pres_cur_changed ; signal a pressure change isr_sensor_state2_5: ; compute relative pressure movf pressure_surf+0,W ; get surface pressure, low byte subwf pressure_abs+0,W ; WREG = pressure_abs - pressure_surf (low byte) movwf pressure_rel_cur+0 ; store relative pressure, low byte movf pressure_surf+1,W ; get surface pressure, high byte subwfb pressure_abs+1,W ; WREG = pressure_abs - pressure_surf (high byte) movwf pressure_rel_cur+1 ; store relative pressure, high byte btfss STATUS,N ; relative pressure < 0 ? bra isr_sensor_state2_6 ; NO - OK, keep result CLRI pressure_rel_cur ; YES - set relative pressure to zero isr_sensor_state2_6: ; check for new max relative pressure movf pressure_rel_cur+0,W ; get current relative pressure, low byte subwf pressure_rel_max+0,W ; WREG = pressure_rel_max - pressure_rel_cur (low byte) movf pressure_rel_cur+1,W ; get current relative pressure, high byte subwfb pressure_rel_max+1,W ; WREG = pressure_rel_max - pressure_rel_cur (high byte) btfss STATUS,N ; result < 0, i.e. new max rel pressure? bra isr_sensor_state2_6a ; NO MOVII pressure_rel_cur,pressure_rel_max ; YES - set new max rel pressure bsf trigger_pres_max_changed ; - signal a pressure max change isr_sensor_state2_6a: IFDEF _min_depth_option ; check if min/max pressures shall be reset btfss reset_trip_pressure ; shall reset the resettable min/max pressures? bra isr_sensor_state2_6b ; NO bcf reset_trip_pressure ; YES - clear request flag CLRI pressure_rel_max_trip ; - set max pressure to zero SETI pressure_rel_min_trip ; - set min pressure to biggest value possible isr_sensor_state2_6b: ; check for new resettable max relative pressure movf pressure_rel_cur+0,W ; get current relative pressure, low byte subwf pressure_rel_max_trip+0,W ; WREG = pressure_rel_max - pressure_rel_cur (low byte) movf pressure_rel_cur+1,W ; get current relative pressure, high byte subwfb pressure_rel_max_trip+1,W ; WREG = pressure_rel_max - pressure_rel_cur (high byte) btfss STATUS,N ; result < 0, i.e. new max rel pressure? bra isr_sensor_state2_6c ; NO - continue checking for min depth MOVII pressure_rel_cur,pressure_rel_max_trip ; YES - set new max rel pressure isr_sensor_state2_6c: ; check for new resettable min relative pressure movf pressure_rel_cur+0,W ; get current relative pressure, low byte subwf pressure_rel_min_trip+0,W ; WREG = pressure_rel_min - pressure_rel_cur (low byte) movf pressure_rel_cur+1,W ; get current relative pressure, high byte subwfb pressure_rel_min_trip+1,W ; WREG = pressure_rel_min - pressure_rel_cur (high byte) btfss STATUS,C ; result > 0, i.e. new min rel pressure? bra sensor_int_state_exit ; NO - done MOVII pressure_rel_cur,pressure_rel_min_trip ; YES - set new min rel pressure ENDIF ; _min_depth_option bra sensor_int_state_exit ; done sensor_int_state1_plus_restart: ; clear average registers CLRI pressure_abs_avg CLRI temperature_avg sensor_int_state1: call get_temperature_value ; state 1: get temperature... call get_pressure_start ; ...and start pressure integration bra sensor_int_state_exit sensor_int_state2: call get_pressure_value ; state 2: get pressure (51 us)... call get_temperature_start ; ...and start temperature integration (73.5 us) call calculate_compensation ; .. and calculate temperature compensated pressure (233 us) sensor_int_state_exit: bra isr_adjust_speed ; set/restore CPU speed and return isr_dimm_tft: ; adjust until max_CCPR1L = CCPR1L btfsc screen_type3 ; screen type 3 ? return ; YES - ignore, no dimming function with screen type 3 btfsc tft_is_dimming ; is the display dimming? return ; YES - ignore movf max_CCPR1L,W ; NO - proceed cpfsgt CCPR1L ; - CCPR1L > max_CCPR1L ? bra isr_dimm_tft2 ; NO - dim up decf CCPR1L,F ; YES - dim down return ; - done isr_dimm_tft2: movf max_CCPR1L,W ; sublw ambient_light_min_eco ; cpfsgt CCPR1L ; CCPR1L > max_CCPR1L - ambient_light_min_eco ? bra isr_dimm_tft3 ; NO - dim up slow movlw .10 ; YES - dim up faster (+10) addwf CCPR1L,F ; - add to dimming value isr_dimm_tft3: incf CCPR1L,F ; - dim up (+1) return ; - done ;============================================================================= ; RTC interrupt on every 1/2 second ; isr_rtcc: bcf PIR3,RTCCIF ; clear flag bsf trigger_half_second ; set flag for a new 1/2 second has begun btfsc reset_timebase ; shall reset the timebase? bra isr_rtcc_1 ; YES - warp to new full second btg timebase_0sec ; NO - toggle the 1/2 second timebase btfsc timebase_0sec ; - did it toggled 1 -> 0 ? return ; NO - on half second, done isr_rtcc_1: ; new full second bsf trigger_full_second ; set flag for a new 1/1 second has begun btfsc block_rtc_access ; ISR suspended from accessing the RTC? bra isr_rtcc_2 ; YES banksel RTCCFG ; RTC registers are outside access RAM bsf RTCCFG,RTCPTR1 bsf RTCCFG,RTCPTR0 banksel isr_backup ; back to ISR default bank movff RTCVALL,rtc_year ; read year in BCD movff RTCVALH,rtc_day ; dummy read movff RTCVALL,rtc_day ; read day in BCD movff RTCVALH,rtc_month ; read month in BCD movff RTCVALL,rtc_hour ; read hour in BCD movff RTCVALH,rtc_secs ; dummy read movff RTCVALL,rtc_secs ; read seconds in BCD movff RTCVALH,rtc_mins ; read minutes in BCD ; Convert BCD to DEC and set registers movf rtc_mins,W rcall isr_rtcc_convert_BCD_DEC ; convert to decimal with result in WREG movwf rtc_mins movf rtc_secs,W rcall isr_rtcc_convert_BCD_DEC ; convert to decimal with result in WREG movwf rtc_secs movf rtc_hour,W rcall isr_rtcc_convert_BCD_DEC ; convert to decimal with result in WREG movwf rtc_hour movf rtc_month,W rcall isr_rtcc_convert_BCD_DEC ; convert to decimal with result in WREG movwf rtc_month movf rtc_day,W rcall isr_rtcc_convert_BCD_DEC ; convert to decimal with result in WREG movwf rtc_day movf rtc_year,W rcall isr_rtcc_convert_BCD_DEC ; convert to decimal with result in WREG movwf rtc_year isr_rtcc_2: ; get ambient light level and set max_CCPR1L call get_ambient_level ; get ambient light level and set max_CCPR1L banksel isr_backup ; back to ISR default bank (for safety only) rcall isr_battery_gauge ; calculate the current charge consumption and add it to the battery gauge rcall isr_update_uptime ; increment overall OSTC uptime rcall isr_update_timeout ; process the timeout timer btfsc divemode ; in dive mode? rcall isr_divemode_1sec ; YES - do the every second dive mode tasks btfsc divemode ; in dive mode? btfsc simulatormode ; YES - in simulator mode? rcall isr_update_lastdive_time ; NO - YES - increment the last dive time ; reset the timebase if requested btfss reset_timebase ; shall reset the timebase? bra isr_rtcc_3 ; NO bcf reset_timebase ; YES - clear request flag clrf eventbase ; - clear all pending events clrf timebase ; - clear all timebase flags clrf timebase_secs ; - clear seconds timer clrf timebase_mins ; - clear minutes timer clrf simulator_time ; - clear minutes timer of simulator runtime as well bsf trigger_half_second ; - set flag for a new 1/2 second has begun bsf trigger_full_second ; - set flag for a new 1/1 second has begun return ; - done isr_rtcc_3: ; count-up the 2 seconds timebase timer btg timebase_1sec ; toggle the 1 second timer bit btfss timebase_1sec ; did it toggled 1 -> 0 ? btg timebase_2sec ; YES - toggle the 2 seconds timer bit ; count-up the seconds timer incf timebase_secs,F ; increment seconds timer (may temporary become 60 here) movlw .59 ; max. for seconds timer cpfsgt timebase_secs ; seconds timer > max.? return ; NO - done ; new full minute clrf timebase_secs ; YES - reset timer bsf trigger_full_minute ; - set flag for a new minute has begun btfsc divemode ; - in dive mode? btfsc simulatormode ; YES - in simulator mode? rcall inc_surface_interval ; NO - YES - increment surface interval btfss simulatormode ; - in simulator mode? bra isr_rtcc_4 ; NO infsnz simulator_time,F ; YES - increment real runtime of the simulator, did wrap around (became zero)? setf simulator_time ; YES - disallow wrap-around, keep at 255 instead isr_rtcc_4: incf timebase_mins,F ; - increment minutes timer movlw .59 ; - max. for minutes timer cpfsgt timebase_mins ; - minutes timer > max.? return ; NO - done ; new full hour clrf timebase_mins ; YES - reset timer bsf trigger_full_hour ; - set flag for a new hour has begun return ; - done ; increment overall OSTC uptime isr_update_uptime: incf uptime+0,F clrf WREG addwfc uptime+1,F addwfc uptime+2,F addwfc uptime+3,F return ; increment time since last dive, called every second when not in dive mode (or when in simulator mode) isr_update_lastdive_time: incf lastdive_time+0,F clrf WREG addwfc lastdive_time+1,F addwfc lastdive_time+2,F addwfc lastdive_time+3,F return ; process the timeout timer isr_update_timeout: btfsc reset_timeout ; shall reset the timeout? bra isr_update_timeout_1 ; YES tstfsz isr_timeout_timer ; NO - timeout timer already at zero? decfsz isr_timeout_timer ; NO - decrement timer, reached zero now? return ; YES / NO - nothing further to do bsf trigger_timeout ; YES - set timeout flag return ; - done isr_update_timeout_1: bcf reset_timeout ; clear request flag bcf trigger_timeout ; clear pending timeout trigger, if any movff isr_timeout_reload,isr_timeout_timer ; reload timer return ; done ;============================================================================= ; Calculate charge drawn from the battery ; isr_battery_gauge: btfsc block_battery_gauge ; access to battery gauge suspended? return ; YES - done MOVLI current_sleepmode,isr_mpr ; NO - default to sleep mode with 100ľA/3600 -> nAs btfss sleepmode ; - in sleep mode? rcall isr_battery_gauge2 ; NO - compute current consumption value into isr_lo and isr_hi movf isr_mpr+0,W ; - 48 bit add of isr_mpr:2 with battery_gauge:6 addwf battery_gauge+0,F movf isr_mpr+1,W addwfc battery_gauge+1,F clrf WREG addwfc battery_gauge+2,F addwfc battery_gauge+3,F addwfc battery_gauge+4,F addwfc battery_gauge+5,F return isr_battery_gauge2: ; set consumption rate in nAs - nano Ampere per second ; Example: ; MOVLI .55556,isr_mpr ; 0.2 Ah / 3600 seconds per hour * 1e9s = nAs ; ; Remark: although all the constants are named current_xxxx, in reality they mean charge! ; Calculate current consumption for LED backlight: 47*CCPR1L+272 (according to values in hwos.inc: 115*CCPR1L+216) movf CCPR1L,W ; get CCPR1L into WREG mullw current_backlight_multi ; PRODH:PRODL = k * WREG = current_backlight_multi * CCPR1L ADDLI current_backlight_offset,PRODL ; PRODH:PRODL += current_backlight_offset MOVII PRODL,isr_mpr ; copy result to isr_mpr ; Add current for CPU and GPU ; cpu_speed_state = ECO 3.10 mA -> 861 nAs ; = NORMAL 5.50 mA -> 1528 nAs ; = FASTEST 8.04 mA -> 2233 nAs btfss speed_is_eco ; speed = eco ? bra isr_battery_gauge3 ; NO ADDLI current_speed_eco,isr_mpr ; YES - add current_speed_eco to isr_mpr bra isr_battery_gauge5 isr_battery_gauge3: btfss speed_is_normal ; speed = normal? bra isr_battery_gauge4 ; NO ADDLI current_speed_normal,isr_mpr ; YES - add current_speed_normal to isr_mpr bra isr_battery_gauge5 isr_battery_gauge4: ADDLI current_speed_fastest,isr_mpr ; speed is fastest, add current_speed_fastest to isr_mpr isr_battery_gauge5: btfss ir_power ; IR enabled? bra isr_battery_gauge6 ; NO ADDLI current_ir_receiver,isr_mpr ; YES - add current_ir_receiver to isr_mpr isr_battery_gauge6: btfss compass_enabled ; compass active? bra isr_battery_gauge7 ; NO ADDLI current_compass,isr_mpr ; YES - add current_compass to isr_mpr isr_battery_gauge7: return ;============================================================================= ; Every second tasks while in dive mode ; isr_divemode_1sec: decfsz sampling_timer,F ; decrement sampling timer, became zero? bra isr_divemode_1sec_1 ; NO bsf trigger_sample_divedata ; YES - set trigger flag for sampling dive data movff sampling_rate,sampling_timer; - reload timer isr_divemode_1sec_1: btfss reset_timebase ; shall reset the timebase? (request flag will be cleared later) bra isr_divemode_1sec_2 ; NO CLRI total_divetime_secs ; YES - reset total dive time, seconds (2 byte) clrf counted_divetime_secs ; - reset counted dive time, seconds (1 byte) CLRI counted_divetime_mins ; - reset counted dive time, minutes (2 byte) clrf apnoe_dive_secs ; - reset apnoe dive time, seconds (1 byte) clrf apnoe_dive_mins ; - reset apnoe dive time, minutes (1 byte) bcf apnoe_at_surface ; - apnoe mode starts in submerged state return ; - done isr_divemode_1sec_2: INCI total_divetime_secs ; increase total dive time (regardless of start_dive_threshold) btfss count_divetime ; shall the dive time be counted (regarding start_dive_threshold)? bra isr_divemode_1sec_4 ; NO (too shallow / apnoe at surface) incf counted_divetime_secs,F ; YES - increase dive time (displayed dive time) movlw d'59' ; - 60 seconds make a minute cpfsgt counted_divetime_secs ; - next full minute reached? bra isr_divemode_1sec_3 ; NO - done clrf counted_divetime_secs ; YES - reset seconds to 0 INCI counted_divetime_mins ; - increase dive minutes bsf divetime_longer_1min ; - set flag for dive time exceeding 1 minute ;bra isr_divemode_1sec_3 ; - done isr_divemode_1sec_3: ; submerged btfss FLAG_apnoe_mode ; in apnoe mode? return ; NO - done btfss apnoe_at_surface ; - been at surface before? bra isr_divemode_1sec_3a ; NO - increment the dive time bcf apnoe_at_surface ; YES - a new dive has begun bsf apnoe_new_dive ; - signal a new dive has begun clrf apnoe_surface_secs ; - clear surface seconds clrf apnoe_surface_mins ; - clear surface minutes clrf apnoe_dive_secs ; - clear dive seconds clrf apnoe_dive_mins ; - clear dive minutes MOVII pressure_rel_cur,pressure_rel_max ; - reset max pressure to current pressure bsf trigger_pres_max_changed ; - signal a new maximum pressure isr_divemode_1sec_3a: incf apnoe_dive_secs,F ; increment dive time, seconds movlw d'59' ; 60 seconds make a minute cpfsgt apnoe_dive_secs ; next full minute reached? return ; NO - done clrf apnoe_dive_secs ; YES - reset seconds to 0 incf apnoe_dive_mins,F ; - increment dive time, minutes return ; - done isr_divemode_1sec_4: ; at surface btfss FLAG_apnoe_mode ; in apnoe mode? return ; NO - done bsf apnoe_at_surface ; YES - memorize been at the surface incf apnoe_surface_secs,F ; - increment surface time, seconds movlw d'59' ; - 60 seconds make a minute cpfsgt apnoe_surface_secs ; - next full minute reached? return ; NO - done clrf apnoe_surface_secs ; YES - reset seconds to 0 incf apnoe_surface_mins,F ; - increment surface time, minutes return ; - done isr_divemode_1sec_3_dive: ;============================================================================= ; BCD to Binary conversion ; Input WREG = value in BCD ; Output WREG = value in binary ; isr_rtcc_convert_BCD_DEC: movwf isr_lo swapf isr_lo, W andlw 0x0F ; W = tens rlncf WREG, W ; W = 2 * tens subwf isr_lo, F ; 16 * tens + ones - 2*tens subwf isr_lo, F ; 14 * tens + ones - 2*tens subwf isr_lo, W ; 12 * tens + ones - 2*tens return ;============================================================================= ; Check buttons ; isr_switch_right: bcf INTCON,INT0IE ; disable INT0 btfss flip_screen ; 180° flipped? bsf switch_right ; set flag btfsc flip_screen ; 180° flipped? bsf switch_left ; set flag bra isr_switch_common ; continue... isr_switch_left: bcf INTCON3,INT1IE ; disable INT1 btfss flip_screen ; 180° flipped? bsf switch_left ; set flag btfsc flip_screen ; 180° flipped? bsf switch_right ; set flag ;bra isr_switch_common ; continue... isr_switch_common: clrf TMR1L ; load timer1 for first press movlw TMR1H_VALUE_FIRST ; in steps of 7.8125 ms movwf TMR1H ; ... bsf T1CON,TMR1ON ; start timer 1 bcf INTCON3,INT1IF ; clear flag bcf INTCON,INT0IF ; clear flag return ;============================================================================= ; Button hold-down interrupt ; timer1int: bcf PIR1,TMR1IF ; clear flag bcf INTCON,INT0IF ; clear flag bcf INTCON3,INT1IF ; clear flag ; digital btfss switch_left1 ; left button hold-down? bra timer1int_left ; YES btfss switch_right2 ; right button hold-down? bra timer1int_right ; YES ; analog btfsc analog_sw2_pressed ; left button hold-down? bra timer1int_left ; YES btfsc analog_sw1_pressed ; right button hold-down? bra timer1int_right ; YES ; no button hold-down, stop Timer 1 bcf T1CON,TMR1ON ; stop timer 1 bsf INTCON,INT0IE ; enable INT0 bsf INTCON3,INT1IE ; enable INT1 return timer1int_left: btfss flip_screen ; 180° flipped? bsf switch_left ; (re-)set flag btfsc flip_screen ; 180° flipped? bsf switch_right ; (re-)set flag bra timer1int_common ; continue timer1int_right: btfss flip_screen ; 180° flipped? bsf switch_right ; set flag btfsc flip_screen ; 180° flipped? bsf switch_left ; (re-)set flag ;bra timer1int_common ; continue timer1int_common: ; load timer1 for next pressure clrf TMR1L ; clear timer, low byte movlw TMR1H_VALUE_CONT ; default to surface mode value btfsc divemode ; in dive mode? movlw TMR1H_VALUE_CONT_DIVE ; YES - overwrite with dive mode value movwf TMR1H ; write value to timer, high byte return ; return from timer1int with timer1 kept running ;============================================================================= ; Increment surface interval (counted in minutes) while still in desaturation ; ; int_O_desaturation_time is only computed while in start, surface mode, ; menue_tree or ghostwriter. So the ISR may clock surface_interval past ; the actual surface interval time. But TFT_surface_lastdive will check ; int_O_desaturation_time and in case int_O_desaturation_time is zero it ; will not show surface_interval but lastdive_time instead. Thus the glitch ; will remain invisible. ; inc_surface_interval: ; called every minute when not in dive mode (in banksel common context) btfsc reset_surface_interval ; shall reset the surface interval timer? bra inc_surface_interval_1 ; YES movff int_O_desaturation_time+0,isr_lo ; NO - check desaturation time movff int_O_desaturation_time+1,WREG iorwf isr_lo,W ; - inclusive-or low & high byte, desaturation time = 0 ? bz inc_surface_interval_1 ; YES - reset surface interval timer INCI surface_interval ; NO - increment surface interval return ; - done inc_surface_interval_1: bcf reset_surface_interval ; reset request flag CLRI surface_interval ; reset surface interval timer return ; done ;============================================================================= END