TSC3200 颜色传感器

萧芸凤

1. #include <TimerOne.h>
   
2. 
   
3. #define COLOR_S0     6   
   
4. #define COLOR_S1     5
   
5. #define COLOR_S2     4
   
6. #define COLOR_S3     3
   
7. #define COLOR_OUT    2
   
8. int frequencecount = 0;    // 计数频率
   
9. int RGB_arr[4];
   
10. float RGB_scale_factor[4];
    
11. ////////////////////// 初始化///////////////////////////////////////
    
12. void color_Init()
    
13. {
    
14.         pinMode(COLOR_S0, OUTPUT);
    
15.         pinMode(COLOR_S1, OUTPUT);
    
16.         pinMode(COLOR_S2, OUTPUT);
    
17.         pinMode(COLOR_S3, OUTPUT);
    
18.         pinMode(COLOR_OUT, INPUT);
    
19. 
    
20.         digitalWrite(COLOR_S0, LOW);                // 输出频率设定， 2%
    
21.         digitalWrite(COLOR_S1, HIGH);
    
22. 
    
23.        
    
24.         //Timer1.attachInterrupt(colorRead);  
    
25.         //attachInterrupt(0, frequence, RISING);  
    
26. }
    
27. 
    
28. /////////////////// RGB色彩滤镜选择 //////////////////////////////////////////////
    
29. void color_Filter(char color)
    
30. {
    
31.         byte s2,s3;
    
32.         if ( color == 'R' || color == 'r')
    
33.         {
    
34.                 s2 = 0;
    
35.                 s3 = 0;
    
36.         }
    
37.         if ( color == 'G' || color == 'g')
    
38.         {
    
39.                 s2 = 1;
    
40.                 s3 = 1;
    
41.         }
    
42.         if ( color == 'B' || color == 'b')
    
43.         {
    
44.                 s2 = 0;
    
45.                 s3 = 1;
    
46.         }
    
47.         if ( color == 'C' || color == 'c')
    
48.         {
    
49.                 s2 = 1;
    
50.                 s3 = 0;
    
51.         }
    
52.        
    
53.         digitalWrite(COLOR_S2, s2);
    
54.         digitalWrite(COLOR_S3, s3);
    
55. }
    
56. ////////////////////////////频率函数，中断函数 //////////////////////////////////////////
    
57. void frequence()
    
58. {
    
59.   frequencecount ++ ;
    
60. }
    
61. 
    
62. void colorRead( )
    
63. {       
    
64.         //int RGB_arr[4]
    
65.         byte  RGB_flag;
    
66.         RGB_flag = 0;
    
67.         while(RGB_flag >= 0 && RGB_flag <= 3 )
    
68.         {
    
69.                 switch(RGB_flag)
    
70.                 {
    
71.                         case 0:
    
72.                                         color_Filter('R');
    
73.                                         frequencecount = 0;
    
74.                                         RGB_flag++;
    
75.                                         Timer1.setPeriod(1000000);
    
76.                                         RGB_arr[0] = frequencecount;   
    
77.                                         break;
    
78.                         case 1:
    
79.                                         color_Filter('G');
    
80.                                         frequencecount = 0;
    
81.                                         RGB_flag++;
    
82.                                         Timer1.setPeriod(1000000);
    
83.                                         RGB_arr[1] = frequencecount;            //绿色
    
84.                                         break;
    
85.                         case 2:
    
86.                                         color_Filter('G');
    
87.                                         frequencecount = 0;
    
88.                                         RGB_flag++;
    
89.                                         Timer1.setPeriod(1000000);
    
90.                                         RGB_arr[2] = frequencecount;   
    
91.                                         break;
    
92.                         case 3:
    
93.                                         color_Filter('C');
    
94.                                         frequencecount = 0;
    
95.                                         RGB_flag++;
    
96.                                         Timer1.setPeriod(1000000);
    
97.                                         RGB_arr[3] = frequencecount;            //清除   
    
98.                                         break;
    
99.                         default:
    
100.                                         frequencecount = 0;
     
101.                                 break;
     
102.                 }
     
103. 
     
104.         }
     
105. }
     
106. /////////////////白平衡设置/////////////////////////////////////
     
107. void color_WB_set( )     
     
108. {
     
109.         //int RGB_arr[4];
     
110.         //float *RGB_scale_factor
     
111.         colorRead();
     
112.         for ( byte i = 0 ; i < 4 ; i ++)
     
113.         {
     
114.                 RGB_scale_factor[i] = 255 / RGB_arr[i];
     
115.         }
     
116. }
     
117. 
     
118. void setup()
     
119. {
     
120.         color_Init();
     
121.         Serial.begin(9600);
     
122.         Timer1.initialize();                                // 定时器初始化，缺省计时周期1s
     
123.         //Timer1.attachInterrupt(colorRead);  
     
124.         attachInterrupt(0, frequence, RISING);  
     
125.        
     
126. }
     
127. 
     
128. void loop()
     
129. {
     
130.         float sf[4];
     
131.         int RGB_arr[4];
     
132.         int RGB_out[4];
     
133.         color_WB_set();
     
134.         while(1)
     
135.         {
     
136.                 colorRead();
     
137.                 for ( byte i = 0 ; i < 4 ; i ++)
     
138.                 {
     
139.                         RGB_out[i] = RGB_arr[4] * RGB_scale_factor[i];
     
140.                 }
     
141. 
     
142.                 for ( byte i = 0 ; i < 4 ; i ++)
     
143.                 {
     
144.                         Serial.print(RGB_out[i]);
     
145.                         Serial.print("  |  ");
     
146.                 }
     
147.                 Serial.println();
     
148.         }
     
149. 
     
150. }

复制代码

keyosa

能问下内置的那4个白色LED怎么点亮吗

hdxabout

我都想知道楼上的问题如何解决

Mr.Dante

这个编程看起来比R大的好。对于我的项目，由于是外部光源透射采光，所以也不用点亮自带的灯了。

Mr.Dante

经实践 该程序实现不了测量。串口无输出。在认真修改中。应该是在中断的地方出错了。

hongshimizi

怎么用啊，不能用啊，串口输出的都是啥啊