不韋 呂
/
UIT2_TwoPhaseGenerator
Two-phase sinusoidal wave generator using digital filter for ST Nucleo F401RE.
TwoPhaseGenerator.hpp@0:5b53b74d1fb7, 2014-10-23 (annotated)
- Committer:
- MikamiUitOpen
- Date:
- Thu Oct 23 00:41:02 2014 +0000
- Revision:
- 0:5b53b74d1fb7
1
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
MikamiUitOpen | 0:5b53b74d1fb7 | 1 | //-------------------------------------------------------------- |
MikamiUitOpen | 0:5b53b74d1fb7 | 2 | // Two phase sin generator class |
MikamiUitOpen | 0:5b53b74d1fb7 | 3 | // 2014/10/22, Copyright (c) 2014 MIKAMI, Naoki |
MikamiUitOpen | 0:5b53b74d1fb7 | 4 | //-------------------------------------------------------------- |
MikamiUitOpen | 0:5b53b74d1fb7 | 5 | |
MikamiUitOpen | 0:5b53b74d1fb7 | 6 | #ifndef TWO_PHASE_GENERATOR_HPP |
MikamiUitOpen | 0:5b53b74d1fb7 | 7 | #define TWO_PHASE_GENERATOR_HPP |
MikamiUitOpen | 0:5b53b74d1fb7 | 8 | |
MikamiUitOpen | 0:5b53b74d1fb7 | 9 | #include "mbed.h" |
MikamiUitOpen | 0:5b53b74d1fb7 | 10 | |
MikamiUitOpen | 0:5b53b74d1fb7 | 11 | namespace Mikami |
MikamiUitOpen | 0:5b53b74d1fb7 | 12 | { |
MikamiUitOpen | 0:5b53b74d1fb7 | 13 | class TwoPhaseGenerator |
MikamiUitOpen | 0:5b53b74d1fb7 | 14 | { |
MikamiUitOpen | 0:5b53b74d1fb7 | 15 | public: |
MikamiUitOpen | 0:5b53b74d1fb7 | 16 | // Constructor |
MikamiUitOpen | 0:5b53b74d1fb7 | 17 | TwoPhaseGenerator(float f0, float fs) |
MikamiUitOpen | 0:5b53b74d1fb7 | 18 | : a1_(cosf(6.283185f*f0/fs)), |
MikamiUitOpen | 0:5b53b74d1fb7 | 19 | b1_(sinf(6.283185f*f0/fs)), |
MikamiUitOpen | 0:5b53b74d1fb7 | 20 | xn1_(1.0f), yn1_(0.0f) {} |
MikamiUitOpen | 0:5b53b74d1fb7 | 21 | |
MikamiUitOpen | 0:5b53b74d1fb7 | 22 | // -1.0f <= x1, x2 <= 1.0f |
MikamiUitOpen | 0:5b53b74d1fb7 | 23 | void Generate(float& xn, float& yn) |
MikamiUitOpen | 0:5b53b74d1fb7 | 24 | { |
MikamiUitOpen | 0:5b53b74d1fb7 | 25 | yn = a1_*yn1_ + b1_*xn1_; // sin |
MikamiUitOpen | 0:5b53b74d1fb7 | 26 | xn = -b1_*yn1_ + a1_*xn1_; // cos |
MikamiUitOpen | 0:5b53b74d1fb7 | 27 | |
MikamiUitOpen | 0:5b53b74d1fb7 | 28 | float c1 = 1.5f - 0.5f*(xn*xn + yn*yn); |
MikamiUitOpen | 0:5b53b74d1fb7 | 29 | |
MikamiUitOpen | 0:5b53b74d1fb7 | 30 | xn1_ = c1*xn; |
MikamiUitOpen | 0:5b53b74d1fb7 | 31 | yn1_ = c1*yn; |
MikamiUitOpen | 0:5b53b74d1fb7 | 32 | } |
MikamiUitOpen | 0:5b53b74d1fb7 | 33 | |
MikamiUitOpen | 0:5b53b74d1fb7 | 34 | private: |
MikamiUitOpen | 0:5b53b74d1fb7 | 35 | const float a1_, b1_; |
MikamiUitOpen | 0:5b53b74d1fb7 | 36 | float xn1_, yn1_; |
MikamiUitOpen | 0:5b53b74d1fb7 | 37 | |
MikamiUitOpen | 0:5b53b74d1fb7 | 38 | TwoPhaseGenerator(const TwoPhaseGenerator&); |
MikamiUitOpen | 0:5b53b74d1fb7 | 39 | TwoPhaseGenerator& operator=(const TwoPhaseGenerator&); |
MikamiUitOpen | 0:5b53b74d1fb7 | 40 | }; |
MikamiUitOpen | 0:5b53b74d1fb7 | 41 | } |
MikamiUitOpen | 0:5b53b74d1fb7 | 42 | #endif // TWO_PHASE_GENERATOR_HPP |