adcinc_1int.asm

二轴陀螺仪IDG300源程序

;;*****************************************************************************
;;*****************************************************************************
;;  FILENAME: ADCINC_1INT.asm
;;  Version: 1.1, Updated on 2005/09/29 at 13:17:03
;;
;;  DESCRIPTION: Assembler interrupt service routine for the ADCINC
;;               A/D Converter User Module. This code works for both the
;;               first and second-order modulator topologies.
;;-----------------------------------------------------------------------------
;;  Copyright (c) Cypress MicroSystems 2000-2003. All Rights Reserved.
;;*****************************************************************************
;;*****************************************************************************

include "m8c.inc"
include "memory.inc"
include "ADCINC_1.inc"


;-----------------------------------------------
;  Global Symbols
;-----------------------------------------------

export _ADCINC_1_ADConversion_ISR

export _ADCINC_1_iResult
export  ADCINC_1_iResult
export _ADCINC_1_fStatus
export  ADCINC_1_fStatus
export _ADCINC_1_bState
export  ADCINC_1_bState
export _ADCINC_1_fMode
export  ADCINC_1_fMode
export _ADCINC_1_bNumSamples
export  ADCINC_1_bNumSamples

;-----------------------------------------------
; Variable Allocation
;-----------------------------------------------
AREA InterruptRAM(RAM,REL)
 ADCINC_1_iResult:
_ADCINC_1_iResult:                         BLK  2 ;Calculated answer
  iTemp:                                   BLK  2 ;internal temp storage
 ADCINC_1_fStatus:
_ADCINC_1_fStatus:                         BLK  1 ;ADC Status
 ADCINC_1_bState:
_ADCINC_1_bState:                          BLK  1 ;State value of ADC count
 ADCINC_1_fMode:
_ADCINC_1_fMode:                           BLK  1 ;Integrate and reset mode.
 ADCINC_1_bNumSamples:
_ADCINC_1_bNumSamples:                     BLK  1 ;Number of samples to take.

;-----------------------------------------------
;  EQUATES
;-----------------------------------------------

;@PSoC_UserCode_INIT@ (Do not change this line.)
;---------------------------------------------------
; Insert your custom declarations below this banner
;---------------------------------------------------

;------------------------
;  Constant Definitions
;------------------------


;------------------------
; Variable Allocation
;------------------------


;---------------------------------------------------
; Insert your custom declarations above this banner
;---------------------------------------------------
;@PSoC_UserCode_END@ (Do not change this line.)


AREA UserModules (ROM, REL)

;-----------------------------------------------------------------------------
;  FUNCTION NAME: _ADCINC_1_ADConversion_ISR
;
;  DESCRIPTION: Perform final filter operations to produce output samples.
;
;-----------------------------------------------------------------------------
;
;    The decimation rate is established by the PWM interrupt. Four timer
;    clocks elapse for each modulator output (decimator input) since the
;    phi1/phi2 generator divides by 4. This means the timer period and thus
;    it's interrupt must equal 4 times the actual decimation rate.  The
;    decimator is ru  for 2^(#bits-6).
;
_ADCINC_1_ADConversion_ISR:
    dec  [ADCINC_1_bState]
if1:
    jc endif1 ; no underflow
    reti
endif1:
    cmp [ADCINC_1_fMode],0
if2: 
    jnz endif2  ;leaving reset mode
    push A                            ;read decimator
    mov  A, reg[DEC_DL]
    mov  [iTemp + LowByte],A
    mov  A, reg[DEC_DH]
    mov  [iTemp + HighByte], A
    pop A
    mov [ADCINC_1_fMode],1
    mov [ADCINC_1_bState],((1<<(ADCINC_1_bNUMBITS- 6))-1)
    reti
endif2:
    ;This code runs at end of integrate
    ADCINC_1_RESET_INTEGRATOR_M
    push A
    mov  A, reg[DEC_DL]
    sub  A,[iTemp + LowByte]
    mov  [iTemp +LowByte],A
    mov  A, reg[DEC_DH]
    sbb  A,[iTemp + HighByte]
    asr  A
    rrc  [iTemp + LowByte]

       ;Covert to Unipolar
IF  ADCINC_1_9_OR_MORE_BITS
    add  A, (1<<(ADCINC_1_bNUMBITS - 9))
ELSE
    add [iTemp + LowByte], (1<<(ADCINC_1_bNUMBITS - 1)) ;work on lower Byte
    adc A,0 
ENDIF
       ;check for overflow
IF     ADCINC_1_8_OR_MORE_BITS
    cmp A,(1<<(ADCINC_1_bNUMBITS - 8))
if3: 
    jnz endif3 ;overflow
    dec A
    mov [iTemp + LowByte],ffh
endif3:
ELSE
    cmp [iTemp + LowByte],(1<<(ADCINC_1_bNUMBITS))
if4: 
    jnz endif4 ;overflow
    dec [iTemp + LowByte]
endif4:
ENDIF
IF ADCINC_1_SIGNED_DATA
IF ADCINC_1_9_OR_MORE_BITS
    sub A,(1<<(ADCINC_1_bNUMBITS - 9))
ELSE
    sub [iTemp +LowByte],(1<<(ADCINC_1_bNUMBITS - 1))
    sbb A,0
ENDIF
ENDIF
    mov  [ADCINC_1_iResult + LowByte],[iTemp +LowByte]
    mov  [ADCINC_1_iResult + HighByte],A
    mov  [ADCINC_1_fStatus],1
ConversionReady:
    ;@PSoC_UserCode_BODY@ (Do not change this line.)
    ;---------------------------------------------------
    ; Insert your custom code below this banner
    ;---------------------------------------------------
    ;  Sample data is now in iResult
    ;
    ;  NOTE: This interrupt service routine has already
    ;  preserved the values of the A CPU register. If
    ;  you need to use the X register you must preserve
    ;  its value and restore it before the return from
    ;  interrupt.
    ;---------------------------------------------------
    ; Insert your custom code above this banner
    ;---------------------------------------------------
    ;@PSoC_UserCode_END@ (Do not change this line.)
    pop A
    cmp [ADCINC_1_bNumSamples],0
if5: 
    jnz endif5 ; Number of samples is zero
    mov [ADCINC_1_fMode],0
    mov [ADCINC_1_bState],0
    ADCINC_1_ENABLE_INTEGRATOR_M
    reti       
endif5:
    dec [ADCINC_1_bNumSamples]
if6:
    jz endif6  ; count not zero
    mov [ADCINC_1_fMode],0
    mov [ADCINC_1_bState],0
    ADCINC_1_ENABLE_INTEGRATOR_M
    reti       
endif6:
    ;All samples done
    ADCINC_1_STOPADC_M
 reti 
; end of file ADCINC_1INT.asm