// Timer 1 input capture interrupt service routine
interrupt [TIM1_CAPT] void timer1_capt_isr(void)
{
   unsigned char sreg;
   if(TIFR & 0x04)TIFR|=0x04;
   tdiff=ICR1H;
   tdiff<<=8;
   tdiff|=ICR1L;
   /*
   sreg=SREG;   
   #asm("cli")
   TCNT1=0;
   SREG=sreg;
   #asm("sei")
   */
}