InputCapture.cpp

Go to the documentation of this file.

#include "Cosa/InputCapture.hh"

#if !defined(BOARD_ATTINY)

InputCapture* InputCapture::s_capture = NULL;

InputCapture::InputCapture(InterruptMode mode)
{
  // This is the active input capture
  s_capture = this;

  // Use no prescale; timer runs at system clock frequency
  TCCR1B = _BV(CS10);

  // Set trigger on rising or falling on input capture pin
  if (mode == ON_RISING_MODE)
    TCCR1B |= _BV(ICES1);
  else
    TCCR1B &= ~_BV(ICES1);
}

void
InputCapture::on_interrupt(uint16_t arg)
{
  UNUSED(arg);
}

void
InputCapture::enable()
{
  // Enable input capture interrupt
  TIMSK1 |= _BV(ICIE1);
}

void
InputCapture::disable()
{
  // Disable input capture interrupt
  TIMSK1 &= ~_BV(ICIE1);
}

void
InputCapture::clear()
{
  // Clear input capture interrupt flag if set
  TIFR1 = _BV(ICF1);
}

ISR(TIMER1_CAPT_vect)
{
  if (UNLIKELY(InputCapture::s_capture == NULL)) return;
  InputCapture::s_capture->on_interrupt(ICR1);
}
#endif