Colony » Colony Scout » Colony Scout OS

extern "C"

{

#include <avr/io.h>

#include <avr/interrupt.h>

}

#include "range.h"

/* Ultrasonic Sensor:

 * -if RX pin is left open, it will continuously take readings

 * -PW output is 147us/in.

 * -PW will be high for a maximum of 37.5ms if no target is detected

 * 

 * 37.5ms * 8 MHz / 8 prescaler = 37500 max wait

 * 37.5ms * 16 MHz / 8 prescaler = problem

 */

struct range_t {

  unsigned int start; // timer value on rising edge

  unsigned int value; // last measured range

} range[2];

static void on_edge(int which)

{

  unsigned char int_high;

  unsigned int time = TCNT5;

  if (which)

  {

    int_high = PIN_SONAR_PWM & _BV(P_SONAR_PWM1);

  }

  else

  {

    int_high = PIN_SONAR_PWM & _BV(P_SONAR_PWM0);

  }

  if (int_high)

  {

    range[which].start = time;

  }

  else

  {

    // if timer overflowed since start, this arithmetic should still work out

    range[which].value = time - range[which].start;

  }

}

ISR(INT3_vect)

{

  on_edge(0);

}

ISR(INT2_vect)

{

  on_edge(1);

}

void range_init()

{

  // ISCx = 1, edge triggered

  EICRA |= _BV(ISC20) | _BV(ISC30);

  // enable INT2 and INT3

  EIMSK |= _BV(INT2) | _BV(INT3);

  // CS1 = 2, 1/8 prescaler

  // if this is changed, remember to change recv_edge in bom.cpp!

  TCCR5B = _BV(CS51);

  range[0].value = RANGE_ERR;

  range[1].value = RANGE_ERR;

}

unsigned int range_get(int which)

{

  unsigned int ret;

  if (0 <= which && which <= 1)

  {

    cli();

    ret = range[which].value;

    sei();

    return ret;

  }

  else return RANGE_ERR;

}