atoombom
Dependencies: Encoder HIDScope mbed
Fork of EMG by
LowPassFilter.cpp@20:4fe3cab02341, 2015-09-28 (annotated)
- Committer:
- Bartvaart
- Date:
- Mon Sep 28 10:25:22 2015 +0000
- Revision:
- 20:4fe3cab02341
- Parent:
- 18:4ebf5e640f0c
Hoi Richard hier is een zeer geheim bestand over het filteren van EMG signalen
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
Bartvaart | 18:4ebf5e640f0c | 1 | #include "encoder.h" |
Bartvaart | 20:4fe3cab02341 | 2 | #include "LowPassFilter.h" |
Bartvaart | 18:4ebf5e640f0c | 3 | |
Bartvaart | 18:4ebf5e640f0c | 4 | // Define a Ticker, variables for storage, input and output |
Bartvaart | 18:4ebf5e640f0c | 5 | Ticker biquadTicker; |
Bartvaart | 18:4ebf5e640f0c | 6 | double v1 = 0, v2 = 0, u = 0, y = 0; |
Bartvaart | 18:4ebf5e640f0c | 7 | const double a1 = 1.2, a2 = 2.3, b0 = 1.2, b1 = 2.2, b2 = 0.3; |
Bartvaart | 18:4ebf5e640f0c | 8 | // Implement the computation function |
Bartvaart | 20:4fe3cab02341 | 9 | double computeBiquad() |
Bartvaart | 18:4ebf5e640f0c | 10 | { |
Bartvaart | 20:4fe3cab02341 | 11 | double v = u - a1*v1 - a2*v2; |
Bartvaart | 20:4fe3cab02341 | 12 | y = b0*v + b1*v1 + b2*2; |
Bartvaart | 18:4ebf5e640f0c | 13 | v2 = v1; |
Bartvaart | 18:4ebf5e640f0c | 14 | v1 = v; |
Bartvaart | 20:4fe3cab02341 | 15 | return y; |
Bartvaart | 18:4ebf5e640f0c | 16 | } |