wb_fft_frequencies.h

Go to the documentation of this file.

 
#ifndef wb_fft_frequencies_h_
#define wb_fft_frequencies_h_
 
#ifdef __cplusplus
#include <cstdarg>
#endif
 
#include <gu_util.h>
 
#pragma clang diagnostic push
#pragma clang diagnostic ignored "-Wvarargs"
 
#ifdef GU_SIMPLE_WHITEBOARD_BUFSIZE
#define FFT_DOMINANT_NUMFREQ    ((GU_SIMPLE_WHITEBOARD_BUFSIZE - sizeof(struct rms_strength) - sizeof(struct fsk_frequencies)) / sizeof(struct fft_frequency_level_pair))
#else
#define FFT_DOMINANT_NUMFREQ    0   
#endif
 
#define FSK_DEFAULT_HI  320     
#define FSK_DEFAULT_LO  200     
 
struct fft_frequency_level_pair
{
    PROPERTY(int16_t, left)
    PROPERTY(int16_t, right)
 
#ifdef __cplusplus
    fft_frequency_level_pair(int16_t l = 0, int16_t r = 0): _left(l), _right(r) {}
#endif
};
 
struct rms_strength
{
    PROPERTY(int16_t, left)
    PROPERTY(int16_t, right)
 
#ifdef __cplusplus
    rms_strength(int16_t l = 0, int16_t r = 0): _left(l), _right(r) {}
#endif
};
 
struct fsk_frequencies
{
    unsigned _hi_freq: 12;      
    unsigned _lo_freq: 12;      
    unsigned _hi_percentage: 7; 
    unsigned _unused_pad: 1;    
 
#ifdef __cplusplus
    fsk_frequencies(uint16_t hi = FSK_DEFAULT_HI, uint16_t lo = FSK_DEFAULT_LO, uint16_t fsk = 0): _hi_freq(hi/2), _lo_freq(lo/2), _hi_percentage(fsk), _unused_pad(0) {}
 
    uint16_t hi_freq() const { return _hi_freq * 2; }
 
    uint16_t lo_freq() const { return _lo_freq * 2; }
 
    uint16_t hi_percentage() const { return _hi_percentage; }
 
    float hi_ratio() const { return static_cast<float>(_hi_percentage) / 100.f; }
 
    void set_hi_freq(uint16_t hi = FSK_DEFAULT_HI) { _hi_freq = hi/2; }
 
    void set_lo_freq(uint16_t lo = FSK_DEFAULT_LO) { _lo_freq = lo/2; }
 
    void set_hi_percentage(uint16_t percent = 0) { _hi_percentage = percent; }
    
    void set_hi_ratio(float r) { _hi_percentage = static_cast<unsigned>(100.f * r); }
#endif
};
 
 
struct fft_dominant_frequency
{
    PROPERTY(struct rms_strength, rms)
 
    
    PROPERTY(struct fsk_frequencies, fsk)
 
    
    ARRAY_PROPERTY(struct fft_frequency_level_pair, frequencies, FFT_DOMINANT_NUMFREQ)
 
#ifdef __cplusplus
#if 0
    fft_dominant_frequency(int16_t lrms, int16_t rrms, uint16_t hi, uint16_t lo, uint16_t fsk, va_list freqs): _rms(lrms, rrms), _fsk(hi, lo, fsk)
    {
        int16_t *freqp = &_frequencies->left();
        const int16_t * const start = freqp;
        int16_t freq = static_cast<int16_t>(va_arg(freqs, int));
        while (freq) { *freqp++ = freq; freq = static_cast<int16_t>(va_arg(freqs, int)); }
        const size_t n = static_cast<const size_t>(freqp - start);
        if (n < FFT_DOMINANT_NUMFREQ/2)
        {
            freqp[0] = 0;
            freqp[1] = 0;
        }
    }
#endif
    fft_dominant_frequency(int16_t lrms = 0, int16_t rrms = 0, uint16_t hi = FSK_DEFAULT_HI, uint16_t lo = FSK_DEFAULT_LO, uint16_t fsk = 0, ...): _rms(lrms, rrms), _fsk(hi, lo, fsk)
    {
        if (!rrms) return;
 
        va_list freqs;
        va_start(freqs, fsk);
        int16_t freq = static_cast<int16_t>(va_arg(freqs, int));
        int16_t *freqp = &_frequencies->left();
        while (freq) { *freqp++ = freq; freq = static_cast<int16_t>(va_arg(freqs, int)); }
        va_end(freqs);
    }
#endif
};
 
#pragma clang diagnostic pop
 
#endif //#_wb_fft_frequencies_h_