/elec/quadcopter

To get this branch, use:
bzr branch http://bzr.ed.am/elec/quadcopter

« back to all changes in this revision

Viewing changes to test/receiver/pulse-width/main.ino

  • Committer: Tim Marston
  • Date: 2013-10-23 20:08:35 UTC
  • Revision ID: tim@ed.am-20131023200835-zqu4je2gn0y79car
fixed receiver test code which is now working

Show diffs side-by-side

added added

removed removed

test/receiver/pulse-width/main.ino
10
10
//
11
11
 
12
12
 
13
 
// number of signal pulses to average
14
 
#define AVERAGE_SAMPLES 1
15
 
 
16
 
// should average be result, or damping?
17
 
#define AVERAGE_DAMP 1
18
 
 
19
 
// graphic display
20
 
#define GRAPH 1
21
 
#define GRAPH_MIN 1000
22
 
#define GRAPH_MAX 2000
23
 
#define GRAPH_SIZE 30
 
13
// number of signal pulses to average (for damping)
 
14
#define DAMPING_SAMPLES 1
24
15
 
25
16
 
26
17
// set to the time that the last signal pulse was at
48
39
        Serial.begin( 9600 );
49
40
}
50
41
 
51
 
 
52
42
void loop()
53
43
{
54
44
        unsigned long last_pulse_off = 0;
55
 
        unsigned long intervals[ AVERAGE_SAMPLES ];     
 
45
        unsigned long intervals[ DAMPING_SAMPLES ] = {0};
56
46
        int interval_idx = 0;
57
47
 
58
 
        // reset intervals
59
 
        for( int a = 0; a < AVERAGE_SAMPLES; a++ )
60
 
                intervals[ a ] = 0;
61
 
 
62
 
#ifdef GRAPH
63
 
        // init graph
64
 
        char graph[ GRAPH_SIZE + 3 ];
65
 
        for( int a = 1; a < GRAPH_SIZE + 1; a++ )
66
 
                graph[ a ] = '-';
67
 
        graph[ 0 ] = '[';
68
 
        graph[ GRAPH_SIZE + 1 ] = ']';
69
 
        graph[ GRAPH_SIZE + 2 ] = 0;
70
 
#endif // GRAPH
71
 
 
72
48
        while( true )
73
49
        {
74
50
                // detect pulse falling-edge
83
59
                        {
84
60
                                // update interval buffer
85
61
                                intervals[ interval_idx ] = pulse_off - pulse_on;
86
 
                                if( ++interval_idx >= AVERAGE_SAMPLES )
 
62
                                if( ++interval_idx >= DAMPING_SAMPLES )
87
63
                                        interval_idx = 0;
88
64
 
89
65
                                got_pulse = true;
93
69
                }
94
70
 
95
71
                // display average?
96
 
                if( got_pulse &&
97
 
                        ( AVERAGE_DAMP || interval_idx == 0 ) )
 
72
                if( got_pulse )
98
73
                {
99
74
                        // calculate average
100
75
                        unsigned long ave = 0;
101
 
                        for( int a = 0; a < AVERAGE_SAMPLES; a++ )
 
76
                        for( int a = 0; a < DAMPING_SAMPLES; a++ )
102
77
                                ave += intervals[ a ];
103
 
                        ave /= AVERAGE_SAMPLES;
104
 
 
105
 
#ifdef GRAPH
106
 
 
107
 
                        // draw graph
108
 
                        int pos = ( GRAPH_SIZE ) *
109
 
                                ( ave - GRAPH_MIN ) / ( GRAPH_MAX - GRAPH_MIN );
110
 
                        graph[ pos + 1 ] = '|';
111
 
                        Serial.println( graph );
112
 
                        graph[ pos + 1 ] = '-';
113
 
 
114
 
#else // GRAPH
 
78
                        ave /= DAMPING_SAMPLES;
115
79
 
116
80
                        // tell it like it is
117
 
                        Serial.println( ave );
118
 
 
119
 
#endif // GRAPH
 
81
                        Serial.print( ave );
 
82
                        Serial.print( "\r\n" );
120
83
                }               
121
84
        }
122
85
}