BasicMicro - Forums

Handle_IRQ2:
   toggle p44            ; status LED on arc32...
   
   ; Use hservo
   ;gosub GetCurrentTime - don't want to enable interrupts yet so do inline
#ifdef USER_TIMERA    ; BUGBUG: Convert to B1 if we go this way...
   _lNewPulseTime = lTimerCnt + TCA
   ; see if timer is waiting to process interrupt.
   if IRR1.bit6 then
      _lNewPulseTime = lTimerCnt + 256 + TCA
   endif
#else
   _lNewPulseTime = HServoTime 0;   
#endif      
   ; calculate the pulse width and convert to us and save away the pulse time
   _wPulseWidth = _lNewPulseTime - _lLastPulseTime      ; not scaled yet
   _wPulseWidth = _wPulseWidth / 20;   20mhz clock, convert to 1mhz
   _lLastPulseTIme = _lNewPulseTime;

   ; See if the value appears to be OK.
   if _wPulseWidth > 2500 then
      ; Where were we???
      if _bNextChannel < CNT_PPM_SIGNALS then
         ; We got a long value when we did not expect it...???
         fPPMsValid = 0;
      endif
      _bNextChannel = 0;    // Ok lets assume the next value will be for our first channel
   else
      if _bNextChannel < CNT_PPM_SIGNALS then
         awPPMs(_bNextChannel) = _wPulseWidth
         _bNextChannel = _bNextChannel + 1
         if  _bNextChannel = CNT_PPM_SIGNALS then
            fPPMsValid = 1      ; Let the main line know that we received a complete valid set of values
         endif
      endif
   endif
      
   resume

      .ifdef _DEFHSERVOTIME
_HSERVOTIMECMD:
   .ifdef _DEFENABLEHSERVO2
         mov.b         r0l,r2l                     ;2 save shift count
         ;calc HSERVOTIME
         mov.w         @_HSERVOTIMER:16,e1         ;6 get HSERVOTIME
         mov.w         @TCNT_0:16,r1               ;6 get TimerZ time
         mov.w         @_HSERVOTIMER:16,e0         ;6 get HSERVOTIME again
         cmp.w         e1,e0                        ;2 if HSERVOTIMEs match no int happened
         beq         _hservotime_noint:8         ;4
         mov.w         @TCNT_0:16,r1               ;6 else get TimerZ time again
         mov.w         e0,e1                        ;2 and keep second HSERVOTIME
_hservotime_noint:
         mov.l         er1,er0                     ;2
         mov.l         @_HSERVOTIMERH:16,er1      ;10 get HSERVOTIMEH
            
         and.b         #0x3f,r2l                  ;2 limit to 1:2^63 and calc flags
         beq         _hservotime_finish:8         ;4 if 0 we are done else shift right specified times
_hservotime_shift:
         shlr.l      er1                        ;2
         rotxr.l      er0                        ;2
         dec.b         r2l                        ;2
         bne         _hservotime_shift:8         ;4(10*prescaler)
_hservotime_finish:
   .else
         xor.l         er0,er0
   .endif
         rts                                    ;8(52/60 + (10*prescaler))
      .endif

asm {
;   _lNewPulseTime = HServoTime 0;   
    ;calc HSERVOTIME
   mov.w   @_HSERVOTIMER:16,e1         ;6 get HSERVOTIME
   mov.w   @TCNT_0:16,r1               ;6 get TimerZ time
   bld.b   #4,@TSR_0:16               ; Get the overflow status from TSR
   bcc      _GHST_NOOVERFLOW:8         ; Not overflow
   inc.w   #1, e1                  ; do the add ourself
   mov.w   @TCNT_0:16,r1               ; Neda to reload the timer value to make sure
_GHST_NOOVERFLOW:   
   mov.l   er1, @_LNEWPULSETIME      ; save away the time
}   

Handle_IRQ2:
   enable  ; let other interrupts preempt me...
...