Colony

/*

 * analog.c - Contains the function implementations for manipulating the ADC

 * on the firefly+ board

 * 

 * author:  CMU Robotics Club, Colony Project

 * code mostly taken from fwr analog file (author: Tom Lauwers)

 */

#include <util/delay.h>

#include <avr/interrupt.h>

#include "analog.h"

void analog_init(void)

{

        /*

   * ADC Status Register A

   * Bit 7 - ADEN is set (enables analog)

   * Bit 6 - Start conversion bit is set (must be done once for free-running 

   * mode)

   * Bit 5 - Enable Auto Trigger (for free running mode)

   * Bit 3 - Enable ADC Interrupt (required to run free-running mode)

   * Bits 2-0 - Set to create a clock divisor of 128, to make ADC clock = 

   * 16,000,000/128

   */

        ADCSRA |= 0xEF;

        /*

   * ADMUX register

   * Bit 7,6 - Set voltage reference to AVcc (0b01)

   * Bit 5 - Set ADLAR bit for left adjust to do simple 8-bit reads

   * Bit 4 - X

   * Bit 3:0 - Sets the current channel

   */

        ADMUX = 0x67;

#ifdef FFPP

        DDRA |= 0x70;

        set_adc_mux(0x07);

#endif

}        

#ifdef FFPP

void set_adc_mux(int which)

{

  // A4..A6 set mux to port 0-7 via binary selection

  // mask so only proper bits are possible.

  which &= 0x07;

  PORTA &= 0x8F;

  PORTA |= which << 4;

}

void enable_analog(int analog_setting)        //why do we need this?

{

        // Digital input disable - don't disable any of them

        // Set any of the lower six bits to a 1 to disable that bit

        DDRF = 0x00; //ALL_ANALOG;

}

#endif

unsigned int analog8(int which)

{

#ifdef FFPP

        if(which < EXT_MUX){

      ADMUX = 0x60 + which;

  }else if(which == EXT_MUX){                //Why dont we combine this and the above?

    return 0;

  }else{

    ADMUX = 0x60 + EXT_MUX;

    set_adc_mux(which - 8);

    _delay_ms(10);

  }

#else

        ADMUX = 0x60 + which;

#endif

        _delay_ms(1); 

  // need at least 130 us between conversions (for fwr robot, how much for 

  //new avr?)

        return ADCH;

}

unsigned int analog10(int which)

{

        unsigned int adc_h = 0;

        unsigned int adc_l = 0;

#ifdef FFPP

        if(which < EXT_MUX){

    ADMUX = 0x60 + which;

  }else if(which == EXT_MUX){                //Why dont we combine this and the above?

    return 0;

  }else{

    ADMUX = 0x60 + EXT_MUX;

    set_adc_mux(which - 8);

    _delay_ms(10);

  }

#else

        ADMUX = 0x60 + which;

#endif

        _delay_ms(1);

        adc_l = ADCL; /* highest 2 bits of ADCL -> least 2 bits of analog val */

        adc_h = ADCH; /* ADCH -> 8 highest bits of analog val */

        return (adc_h << 2) | (adc_l >> 6);

}

int wheel(void)

{

        return analog8(WHEEL_PORT);

}

int battery(void)

{

  /* 5 volts is the max, 255 is the max 8bit number , *2 for the divider */

        return analog8(BATT_PORT) * 500 >>7;

}

SIGNAL (SIG_ADC)

{

        // This is just here to catch ADC interrupts because ADC is free running.  

        // No code needs to be in here.

}