DCfilter.h

/*
 * DCfilter.h
 *
 * This file is part of Mozzi.
 *
 * Copyright 2012-2024 Tim Barrass and the Mozzi Team
 *
 * Mozzi is licensed under the GNU Lesser General Public Licence (LGPL) Version 2.1 or later.
 *
 */
 
#ifndef DCFILTER_H
#define DCFILTER_H
 
/*
tb2010 adapted from:
robert bristow-johnson, DSP Trick: Fixed-Point DC Blocking Filter with Noise-Shaping
http://www.dspguru.com/book/export/html/126
 
y[n] = x[n] - x[n-1] + a * y[n-1]
 
Where y[n] is the output at the current time n, and x[n] is the input at the current time n.
 
also, see DC Blocker Algorithms, http://www.ingelec.uns.edu.ar/pds2803/materiales/articulos/04472252.pdf
 */
 
class DCfilter
{
public:
    DCfilter(float pole):acc(0),prev_x(0),prev_y(0)
    {
        A = (int)(32768.0*(1.0 - pole));
    }
 
/*  almost original
    // timing: 20us
    int next(int x)
    {
        setPin13High();
        acc   -= prev_x;
        prev_x = (long)x<<15;
        acc   += prev_x;
        acc   -= A*prev_y;
        prev_y = acc>>15;               // quantization happens here
        int filtered = (int)prev_y;
        // acc has y[n] in upper 17 bits and -e[n] in lower 15 bits
        setPin13Low();
        return filtered;
    }
    */
 
    // timing :8us
    inline
    int next(int x)
    {
        acc += ((long)(x-prev_x)<<16)>>1;
        prev_x = x;
        acc   -= (long)A*prev_y;    // acc has y[n] in upper 17 bits and -e[n] in lower 15 bits
        prev_y = (acc>>16)<<1; // faster than >>15 but loses bit 0
        if (acc & 32784) prev_y += 1; // adds 1 if it was in the 0 bit position lost in the shifts above
        return prev_y;
    }
 
private:
    long acc;
    int prev_x, prev_y,A;
};
 
#endif        //  #ifndef DCFILTER_H