filtering.h

/*
Part of prius3charger_buck
Copyright (c) 2020 Perttu "celeron55" Ahola

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 3 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, see <https://www.gnu.org/licenses/>.
*/

#pragma once

template<const int LIM_FALL, const int LIM_RISE>
struct DigitalNoiseFilter
{
	int c = 0;
	bool filtered_v = false;

	bool feed(bool v)
	{
		if(v){
			if(c < 0)
				c = 0;
			if(c < LIM_RISE)
				c++;
			if(c == LIM_RISE)
				filtered_v = true;
		} else {
			if(c > 0)
				c = 0;
			if(c > -LIM_FALL)
				c--;
			if(c == -LIM_FALL)
				filtered_v = false;
		}
		return filtered_v;
	}

	bool get()
	{
		return filtered_v;
	}

	void reset(bool value)
	{
		c = 0;
		filtered_v = value;
	}
};