LowPassFilter.nxc

Go to the documentation of this file.

/* -*- Mode: C; indent-tabs-mode: t; c-basic-offset: 4; tab-width: 4 -*- */
/*
    LowPassFilter.nxc
    Copyright (C) 2008 Naba Kumar   <naba@gnome.org>

    This program is free software; you can redistribute it and/or modify
    it under the terms of the GNU General Public License as published by
    the Free Software Foundation; either version 2 of the License, or
    (at your option) any later version.

    This program is distributed in the hope that it will be useful,
    but WITHOUT ANY WARRANTY; without even the implied warranty of
    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
    GNU General Public License for more details.

    You should have received a copy of the GNU General Public License
    along with this program; if not, write to the Free Software
    Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301  USA
*/
#ifndef __LOW_PASS_FILTER_H
#define __LOW_PASS_FILTER_H

struct LowPassFilterContext
{
   int RC;         
   int alpha1000;  
   int lastOutput; 
};

void
LowPassFilterInit (LowPassFilterContext &context, int RC, int samplingRate)
{
    context.RC = RC;
    /* alpha scaled by 1000 for int ops */
    context.alpha1000 = (RC * samplingRate * 1000)/(RC * samplingRate + 1);
    context.lastOutput = -1;
}

int
LowPassFilter (LowPassFilterContext &context, int sampleInput)
{
    if (context.lastOutput < 0)
        context.lastOutput = sampleInput;
    else
        context.lastOutput = context.lastOutput + context.alpha1000 * (sampleInput - context.lastOutput);
    context.lastOutput /= 1000; /* Scaled down from int ops */
    return context.lastOutput;
}

#endif