Colony

#include <dragonfly_lib.h>

//A6

#define RED_LED PIN_ADC4

//A8

#define GREEN_LED PIN_ADC5

//A7

#define BLUE_LED PIN_ADC6

int main(void) {

	dragonfly_init(ALL_ON);

	//range_init();

	int rgb[3] = {0,0,0};

	long int distance_red;

	long int distance_green;

	long int distance_blue;

	int blue[3] = {255,245,249};

	int red[3] = {190,122,126};

	int green[3] = {118, 80, 86};

	//Turn each pin on in sequential order

	analog_init(ADC_START);

	while(1)

	{

		digital_output(BLUE_LED, 1);

		delay_ms(1);

		analog_stop_loop();

		rgb[2] = analog8(AN9);

		analog_start_loop();

		digital_output(BLUE_LED,0);

		digital_output(RED_LED, 1);

		delay_ms(1);

		analog_stop_loop();

		rgb[0] = analog8(AN9);

		analog_start_loop();

		digital_output(RED_LED, 0);

		digital_output(GREEN_LED,1);

		delay_ms(1);

		analog_stop_loop();

		rgb[1] = analog8(AN9);

		analog_start_loop();

		digital_output(GREEN_LED,0);

		distance_red = 1;

		distance_green = rgb[1] - rgb[0];

		distance_blue = rgb[2] - rgb[0];

		distance_blue = distance_blue * rgb[0]/255;

		distance_green = distance_green * rgb[0]/255;

		usb_puti(distance_red);

		usb_puts("\t");

		usb_puti(distance_green;

		usb_puts("\t");

		usb_puti(distance_blue);

		usb_puts("\n");

		/*

		distance_red = 0;

		distance_green = 0;

		distance_blue = 0;

		{

			for(int i = 0; i < 3; i++)

			{

				distance_red += (red[i]-rgb[i])*(red[i]-rgb[i]);

				distance_green += (green[i]-rgb[i])*(green[i]-rgb[i]);

				distance_blue += (blue[i]-rgb[i])*(blue[i]-rgb[i]);

			}

			if(distance_red < distance_blue)

			{

				if(distance_red < distance_green)

				{

					usb_puti(distance_red);

					usb_puts(" BROWN\n");

				}

				else

				{

					usb_puti(distance_green);

					usb_puts(" GREEN\n");

				}

			}

			else

			{

				if(distance_blue < distance_green)

				{

					usb_puti(distance_blue);

						usb_puts(" ORANGE\n");

				}

				else

				{

					usb_puti(distance_green);

					usb_puts(" GREEN\n");

				}

			}

		}

		*/

		delay_ms(50);

	}

}