Colony

int count;

unsigned int testf(int);

void setf(int);

	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);

}