templates/5_fir_differentiator.cpp


1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30

/**
 * 5_fir_differentiator.cpp
 * Written by Clyne Sullivan.
 *
 * Does an FIR differentiation on the incoming signal, so that the output is representative of the
 * rate of change of the input.
 * A scaling factor is applied so that the output's form is more clearly visible.
 */

Sample *process_data(Samples samples)
{
    constexpr int scaling_factor = 4;
	static Sample output[samples.size()];
    static Sample prev = 2048;

    // Compute the first output value using the saved sample.
    output[0] = 2048 + ((samples[0] - prev) * scaling_factor);

	for (unsigned int i = 1; i < samples.size(); i++) {
        // Take the rate of change and scale it.
        // 2048 is added as the output should be centered in the voltage range.
		output[i] = 2048 + ((samples[i] - samples[i - 1]) * scaling_factor);
    }

	// Save the last sample for the next iteration.
    prev = samples[samples.size() - 1];

    return output;
}