WavePacket.h

/*
 * WavePacket.h
 *
 * This file is part of Mozzi.
 *
 * Copyright 2013-2024 Tim Barrass and the Mozzi Team
 *
 * Mozzi is licensed under the GNU Lesser General Public Licence (LGPL) Version 2.1 or later.
 *
 */
 
 
#ifndef WAVEPACKET_H
#define WAVEPACKET_H
 
#include "MozziHeadersOnly.h"
#include "Oscil.h"
#include "tables/cos8192_int8.h"
#include "mozzi_fixmath.h"
#include "Phasor.h"
#include "Line.h"
#include "meta.h"
 
 
enum algorithms {SINGLE,DOUBLE};
 
template <int8_t ALGORITHM>
class WavePacket
{
public:
 
    WavePacket():AUDIO_STEPS_PER_CONTROL(MOZZI_AUDIO_RATE / MOZZI_CONTROL_RATE)
    {
        aCos.setTable(COS8192_DATA);
    }
    
    
    inline
    void set(int fundamental, int bandwidth, int centrefreq)
    {
        setFundamental(fundamental);
        setBandwidth(bandwidth);
        setCentreFreq(centrefreq);
    }
 
 
    inline
    void setFundamental(int fundamental)
    {
        aPhasor.setFreq(fundamental);
        invFreq = Q8n24_FIX1 / fundamental;
    }
 
 
 
    inline
    void setBandwidth(int bandwidth)
    {
        Q15n16 bw = invFreq*bandwidth;
        bw >>= 9;
        bw = max(bw, Q15n16_FIX1>>3);
        aBandwidth.set(bw, AUDIO_STEPS_PER_CONTROL);
    }
 
 
 
    inline
    void setCentreFreq(int centrefreq)
    {
        Q15n16 cf = invFreq * centrefreq;
        cf >>= 3;
        aCentrefreq.set(cf, AUDIO_STEPS_PER_CONTROL);
    }
 
 
    inline
    int next()
    {
        gcentrefreq = aCentrefreq.next();
        gbandwidth = aBandwidth.next();
        int phase1 = aPhasor.next()>>16; // -0.5 to 0.5, 0n15
        if (ALGORITHM == DOUBLE) {
            return (signalPath(params1, phase1)+signalPath(params2, phase1+32768))>>1;
        } else {
            return signalPath(params1, phase1);
        }
    }
 
    
    
private:
    //Q15n16 fundamental; // range 4 to 6271 in pd patch, 13 integer bits
    Q8n24 invFreq;
    Q15n16 gcentrefreq;   // range 0 to 3068, 12 integer bits
    Q15n16 gbandwidth;   // range 1 to 3068, 12 integer bits
 
    // Lines to interpolate controls at audio rate
    Line <Q15n16> aCentrefreq;
    Line <Q16n16> aBandwidth;
    Line <Q16n16> aFreq;
 
    // different sets of params for each audio phase stream
    struct parameters
    {
        int previous_phase;
        Q15n16 centrefreq;
        Q23n8 bandwidth;
    }
    params1,params2;
 
    // the number of audio steps the line has to take to reach the next control value
    const unsigned int AUDIO_STEPS_PER_CONTROL;
 
    Oscil <COS8192_NUM_CELLS, MOZZI_AUDIO_RATE> aCos;
    Phasor <MOZZI_AUDIO_RATE> aPhasor;
 
 
    inline
    int signalPath(struct parameters &param, int phase) // 25us?  * 2
    {
        //setPin13High();
        int index;
 
        if(phase<param.previous_phase)
        {
            param.centrefreq = gcentrefreq>>8;
            param.bandwidth = Q15n16_to_Q23n8(gbandwidth);
        }
        param.previous_phase = phase;
 
        // oscillation
        index = (param.centrefreq * phase)>>16;
        // hack to make peak in middle of packet, otherwise it centres around a zero-crossing.. 
        index += COS8192_NUM_CELLS>>1; 
        index &= COS8192_NUM_CELLS-1;
        int8_t sig1 = aCos.atIndex(index);
 
        // packet envelope
        Q23n8 bwphase = (param.bandwidth * phase)>>8;
        bwphase += COS8192_NUM_CELLS>>1;
        index = constrain(bwphase, 0, (COS8192_NUM_CELLS-1));
        uint8_t packet_width = 128 + aCos.atIndex(index);
        // if (AUDIO_MODE == HIFI){
            // return ((int) sig1 * packet_width)>>3; // scaled to fit HIFI updateAudio output
        // }else{
            // return ((int) sig1 * packet_width)>>8; // scaled to fit STANDARD updateAudio output
        // }
        
        return ((int) sig1 * packet_width);
    }
 
};
 
#endif        //  #ifndef WAVEPACKET_H