PPM信号程序 ppm输出不对

NWm

程序如下:

1. 
   
2. #define PPMCH                 8
   
3. 
   
4. #define LED 13
   
5. #define PPMOUT 8
   
6. 
   
7. unsigned int ppm1[PPMCH+1] = {
   
8.   0, 1500, 1500, 1500, 1900, 1500, 1500, 1500, 1500};
   
9. unsigned int ppm2[PPMCH+1] = {
   
10.   0, 1500, 1500, 1500, 1900, 1500, 1500, 1500, 1500};
    
11. unsigned int ppmout[PPMCH+1] = {
    
12.   0, 1500, 1500, 1500, 1900, 1500, 1500, 1500, 1500};
    
13. 
    
14. 
    
15. void PPM_ISR0(void)
    
16. {
    
17.   volatile static char ch;
    
18.   static unsigned lastmicros;  
    
19.   unsigned mic = micros();
    
20.   if(digitalRead(2) == HIGH)
    
21.   {
    
22.     if(mic - lastmicros>3000)
    
23.     {
    
24.       ch = 0;
    
25.     }
    
26.     ppm1[ch] = mic - lastmicros;
    
27.     lastmicros = mic;
    
28.     ch = (++ch)%(PPMCH+1);
    
29.   }
    
30. }
    
31. void PPM_ISR1(void)
    
32. {
    
33.   volatile static char ch;
    
34.   static unsigned lastmicros;  
    
35.   unsigned mic = micros();
    
36.   if(digitalRead(3) == HIGH)
    
37.   {
    
38.     if(mic - lastmicros>3000)
    
39.     {
    
40.       ch = 0;
    
41.     }
    
42.     ppm2[ch] = mic - lastmicros;
    
43.     lastmicros = mic;
    
44.     ch = (++ch)%(PPMCH+1);
    
45.   }
    
46. }
    
47. void setup(void)
    
48. {
    
49.   Serial.begin(57600);
    
50.   pinMode(2, INPUT_PULLUP);
    
51.   pinMode(3, INPUT_PULLUP);
    
52.   pinMode(PPMOUT, OUTPUT);
    
53.   digitalWrite(PPMOUT, HIGH);
    
54.   attachInterrupt(0, PPM_ISR0, CHANGE);
    
55.   attachInterrupt(1, PPM_ISR1, CHANGE);
    
56. }
    
57. void loop(void)
    
58. {
    
59.   unsigned int timecount = 0;
    
60.   for(int i=0; i<=PPMCH; i++)
    
61.   {
    
62.    
    
63.     if(i < 6)
    
64.     {
    
65.       if(ppm1[i] > 900 && ppm1[i] < 2100)
    
66.         ppmout[i] = (ppm1[i] + ppmout[i])/2;
    
67.     }
    
68.    
    
69.    
    
70. else
    
71.     {
    
72.       if(ppm2[i] > 900 && ppm2[i] < 2100)
    
73.         ppmout[i] = (ppm2[i] + ppmout[i])/2;
    
74.     }
    
75.    
    
76.     ppmout[i] = 1900;
    
77.   }
    
78.   timecount = 0;
    
79.   for(int i=1; i<=PPMCH; i++)
    
80.   {
    
81.    
    
82.     digitalWrite(PPMOUT, LOW);
    
83.     delayMicroseconds(300);
    
84.     digitalWrite(PPMOUT, HIGH);
    
85.     delayMicroseconds((ppmout[i]/3)*2);
    
86.     timecount += ppmout[i];
    
87.     //*/
    
88.   }
    
89.   
    
90.   digitalWrite(PPMOUT, LOW);
    
91.   delayMicroseconds(300);
    
92.   digitalWrite(PPMOUT, HIGH);
    
93.   delay((23000-timecount)/1000);
    
94. 
    
95. }
    
96. 
    

复制代码