osc.cpp

説明を見る。

/** \file
* 発振器クラスの定義 
*/

#include "osc.h"
namespace osc{
        // すべての発振器クラスが共用するコンストラクタ
    COscillator::COscillator( int freq )
    {
        this->setFreq( freq );
        this->setPhase( 0 );
    }
    
        // すべての発振器クラスが共用する周波数設定プログラム
    void COscillator::setFreq( int freq )
    {
        this->frequency = freq;
    }
    
        // すべての発振器クラスが共用する位相設定プログラム 
    void COscillator::setPhase( unsigned int phase )
    {
        this->phase = phase;
    }



    void CTableLookup::run( shortfract i[], shortfract q[], int count )
    {
        for ( int j=0; j<count; j++ ){
                // 32bitの位相の内、上位16bitのみを使う。
            unsigned int hi = ( this->phase >> 24 ) & 0xFF;     // 16bit位相の上位8bit
            unsigned int lo = ( this->phase >> 16 ) & 0xFF;     //  8bit位相の下位8bit
#if 0       
                // 加法定理 cos(A+B) = cos(A)cos(B) - sin(A)sin(B)
            i[j] = co_h[hi]*co_l[lo] - si_h[hi]*si_l[lo];
                // 加法定理 sin(A+B) = sin(A)cos(B) + cos(A)sin(B)
            q[j] = si_h[hi]*co_l[lo] + co_h[hi]*si_l[lo];
#else           
                    // アセンブリ言語による実装
            asm(    "a0 = %2*%3;\n"         // cos_h*cos_l
                    "%0=(a0-=%4*%5);\n"     // sin_h*sin_l
                    "a0 = %4*%3;\n"         // sin_h*cos_l
                    "%1=(a0+=%2*%5);\n"     // cos_h*sin_l
                    : "=&l"(i[j].v), "=&l"(q[j].v)
                    : "l"(co_h[hi].v), "l"(co_l[lo].v), "l"(si_h[hi].v), "l"(si_l[lo].v)
                    : "a0"
                    );  
#endif  
                // 位相の更新
            this->phase += this->frequency;
        }
    }

    void CTableLookup::run( shortfract i[], int count )
    {
        for ( int j=0; j<count; j++ ){
                // 32bitの位相の内、上位16bitのみを使う。
            unsigned int hi = ( this->phase >> 24 ) & 0xFF;     // 16bit位相の上位8bit
            unsigned int lo = ( this->phase >> 16 ) & 0xFF;     //  8bit位相の下位8bit
            
                // 加法定理 cos(A+B) = cos(A)cos(B) - sin(A)sin(B)
#if 0
            i[j] = co_h[hi]*co_l[lo] - si_h[hi]*si_l[lo];
#else
                    // アセンブリ言語による実装
            asm(    "a0 = %1*%2;\n" 
                    "%0=(a0-=%3*%4);\n" 
                    : "=l"(i[j].v)
                    : "l"(co_h[hi].v), "l"(co_l[lo].v), "l"(si_h[hi].v), "l"(si_l[lo].v)
                    : "a0"
                    );      
#endif  
                // 位相の更新
            this->phase += this->frequency;

        }
    }

    void CTableLookup::run( shortfract i[], int deviation[], int count )
    {
        for ( int j=0; j<count; j++ ){
                // 32bitの位相の内、上位16bitのみを使う。
            unsigned int hi = ( this->phase >> 24 ) & 0xFF;     // 16bit位相の上位8bit
            unsigned int lo = ( this->phase >> 16 ) & 0xFF;     //  8bit位相の下位8bit
            
                // 加法定理 cos(A+B) = cos(A)cos(B) - sin(A)sin(B)
                    // アセンブリ言語による実装
            asm(    "a0 = %1*%2;\n" 
                    "%0=(a0-=%3*%4);\n" 
                    : "=l"(i[j].v)
                    : "l"(co_h[hi].v), "l"(co_l[lo].v), "l"(si_h[hi].v), "l"(si_l[lo].v)
                    : "a0"
                    );      
                // 位相の更新
            this->phase += this->frequency + deviation[j];

        }
    }
};

---