main.cpp

00001 #include "mbed.h"
00002 #include "ColorSensor.h"
00003 
00004 ColorSensor color(p20, p17, p18, p19, 10);
00005 //ColorSensor color = ColorSensor();
00006 Serial pc(USBTX, USBRX); // tx, rx
00007 
00008 int main()
00009 {
00010   unsigned R, G, B;
00011   double color_sum;
00012   double redp,greenp,bluep;
00013   //pc.baud(115200);
00014   while(1)
00015   {
00016     color.getRGB(R, G, B);
00017     
00018     color_sum = (R * 0.65) + G + (B * 1.3);
00019     
00020     redp = (double)(R * 0.65)/color_sum * 100;
00021     greenp = (double)G/color_sum * 100;
00022     bluep = (double)(B * 1.3)/color_sum * 100;
00023     
00024     pc.printf("%lf %lf %lf\n", redp, greenp, bluep);
00025     /*
00026     switch(color.judge()){
00027       case RED: pc.printf("RED\n"); break;
00028       case GREEN: pc.printf("GREEN\n"); break;
00029       case BLUE: pc.printf("BLUE\n"); break;
00030       default: break;
00031     }
00032     */
00033     //wait_ms(5);
00034   }
00035 }