求助怎么将取色模块和变色LED相连，使LED正常发光？

肆风

今天尝试将tcs3200取色模块和变色LED相连，通过tsc3200模块取色，LED发取色模块取到的颜色，但是失败了。自己怀疑是代码上出了问题，有些弄不懂的地方，我把代码放在下面，求大神们帮我看看哪里有问题~

1. #include <TimerOne.h>
   
2. #define S0     6   // Please notice the Pin's define
   
3. #define S1     5
   
4. #define S2     4
   
5. #define S3     3
   
6. #define OUT    2
   
7. 
   
8. int   g_count = 0;    // count the frequecy
   
9. int   g_array[3];     // store the RGB value
   
10. int   g_flag = 0;     // filter of RGB queue
    
11. float g_SF[3];        // save the RGB Scale factor
    
12. int   f[3];
    
13. int   y[3];
    
14. 
    
15. void TSC_Init()
    
16. {
    
17.   pinMode(S0, OUTPUT);
    
18.   pinMode(S1, OUTPUT);
    
19.   pinMode(S2, OUTPUT);
    
20.   pinMode(S3, OUTPUT);
    
21.   pinMode(OUT, INPUT);
    
22.   digitalWrite(S0, LOW);// OUTPUT FREQUENCY SCALING 2%
    
23.   digitalWrite(S1, HIGH);
    
24.   pinMode(9, OUTPUT);
    
25.   pinMode(10, OUTPUT);
    
26.   pinMode(11, OUTPUT);
    
27.   pinMode(12, OUTPUT);
    
28.   digitalWrite(12, LOW);
    
29.   //12 pin as gnd
    
30.   // 打开13脚led作为电源指示:
    
31. }
    
32. 
    
33. // Select the filter color
    
34. void TSC_FilterColor(int Level01, int Level02)
    
35. {
    
36.   if(Level01 != 0)
    
37.     Level01 = HIGH;
    
38.    
    
39.   if(Level02 != 0)
    
40.     Level02 = HIGH;
    
41.    
    
42.   digitalWrite(S2, Level01);
    
43.   digitalWrite(S3, Level02);
    
44. }
    
45. void TSC_Count()
    
46. {
    
47.   g_count ++ ;
    
48. }
    
49. void TSC_Callback()
    
50. {
    
51.   switch(g_flag)
    
52.   {
    
53.     case 0:
    
54.       Serial.println("->WB Start");
    
55.       TSC_WB(LOW, LOW);              //Filter without Red         
    
56.       break;
    
57.     case 1:
    
58.       Serial.print("->Frequency R=");
    
59.       Serial.println(g_count);
    
60.       g_array[0] = g_count;
    
61.       TSC_WB(HIGH, HIGH);            //Filter without Green        
    
62.       break;   
    
63.     case 2:
    
64.       Serial.print("->Frequency G=");        
    
65.       Serial.println(g_count);
    
66.       g_array[1] = g_count;
    
67.       TSC_WB(LOW, HIGH);             //Filter without Blue
    
68.       break;
    
69.     case 3:
    
70.       Serial.print("->Frequency B=");
    
71.       Serial.println(g_count);
    
72.       Serial.println("->WB End");
    
73.       g_array[2] = g_count;
    
74.       TSC_WB(HIGH, LOW);             //Clear(no filter)   
    
75.       break;
    
76.     default:     
    
77.       g_count = 0;        
    
78.       break;
    
79.   }
    
80. }
    
81. 
    
82. void TSC_WB(int Level0, int Level1)  //White Balance
    
83. {
    
84.    g_count = 0;
    
85.    g_flag ++;
    
86.    TSC_FilterColor(Level0, Level1);
    
87.    Timer1.setPeriod(1000000);
    
88. }
    
89. void setup()
    
90. {
    
91.    TSC_Init();
    
92.   pinMode(13, OUTPUT);
    
93.   digitalWrite(13, HIGH);
    
94.    Serial.begin(9600);
    
95.    Timer1.initialize();             // defaulte is 1s
    
96.    Timer1.attachInterrupt(TSC_Callback);  
    
97.    attachInterrupt(0, TSC_Count, RISING);   
    
98.    delay(4000);
    
99.    for(int i=0; i<3; i++)
    
100.    Serial.println(g_array[i]);
     
101.    g_SF[0] = 255.0/ g_array[0];     //R Scale factor
     
102.    g_SF[1] = 255.0/ g_array[1] ;    //G Scale factor
     
103.    g_SF[2] = 255.0/ g_array[2] ;    //B Scale factor
     
104.    Serial.println(g_SF[0]);
     
105.    Serial.println(g_SF[1]);
     
106.    Serial.println(g_SF[2]);
     
107. }
     
108. void loop()
     
109. {
     
110.    g_flag = 0;
     
111.    delay(4000);
     
112.    for(int i=0; i<3; i++)
     
113.    {
     
114.     f[i]=g_array[i] * g_SF[i];
     
115.    Serial.println(f[i]);
     
116.    }
     
117.   analogWrite(9,g_array[0] * g_SF[0] );
     
118.   analogWrite(10,g_array[1] * g_SF[1] );
     
119.   analogWrite(11,g_array[2] * g_SF[2] );
     
120. 
     
121. }

复制代码