Colony

#include <dragonfly_lib.h>

int count;

unsigned int testf(int);

void setf(int);

int main(void)

{

        int loops;

        unsigned int val;

        char i = 0 | _BV(ADPS2) | _BV(ADPS1) | _BV(ADPS0);

        sei();

        analog_init(ADC_STOP);

        usb_init();

        range_init();

        usb_puts("STARTING ANALOG CLOCK SCALE TEST\n\r");

        usb_puts("ADC10\tACD8\tCount\n\r");

        for(;i >= 0; i--) {

                ADCSRA &= ~7;

                ADCSRA |= i;

                usb_puts("\n\rClock Prescalar: 2^");

                usb_puti(i);

                usb_puts("\n\r");

                for(loops = 0; loops < 10; loops++) {

                        val = testf(WHEEL_PORT);

                        usb_puti(val);

                        usb_puts("\t");

                        usb_puti(val>>2);

                        usb_puts("\t");                

                        usb_puti(count);

                        usb_puts("\n\r");

                        delay_ms(500);

                }        

        }

        usb_puts("done");

        return 0;

}

unsigned int testf(int which) {

        int adc_h;

        int adc_l;

        // Let any previous conversion finish

        while (ADCSRA & _BV(ADSC));

        if(which < EXT_MUX) {

                ADMUX = ADMUX_OPT + which;

        } else {

                ADMUX = ADMUX_OPT + EXT_MUX;

                setf(which - 8);

        }

        // Start the conversion

        ADCSRA |= _BV(ADSC);

        count = 0;

        // Wait for the conversion to finish

        while (ADCSRA & _BV(ADSC)) {

                count++;

        }

        adc_l = ADCL;

        adc_h = ADCH;

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

}

void setf(int which) {  

  // mask so only proper bits are possible.  

  PORTG = (PORTG & 0xE3) | ((which & 0x03) << 3) | (which & 0x04);

}