Robot sigue Linea

[zarkius]

Hola buenas!, miren necesito para clase un robot sigue linea, osea un robot que leyendo mediante una camara lea la linea roja de la pantalla y la siga sin salirse, el codigo que el profesor nos proporciona es el siguiente:

Código:

int prueba = 0;
void yourcode_iteration(void)
{

float r,g,b;

int i=0,j=0;

if (prueba==0)

{

for (i=240*319*3;i<240*320*3;i=i+3)

{

b = (float)(unsigned int)(unsigned char)imagenRGB[i];
g = (float)(unsigned int)(unsigned char)imagenRGB[i+1];
r = (float)(unsigned int)(unsigned char)imagenRGB[i+2];

printf("Pixel %d >r = %f, g=%f, b=%f\n", j,r,g,b);

j=j+1;

}

prueba=prueba+1;
}
}

Este codigo lee toda la pantalla y muestra la cantidad de rojo, blanco y verde que existe, mi tarea es crear estados por (estado 0 = moverse, estado 1 = gira a la derecha...) si alguien supiera mas o menos como va el tema le estaria muy agradecido.

Un Saludo!