datenfilter.cpp

来自「this the code of bootstation」· C++ 代码 · 共 39 行

#include "stdafx.h"

#include "Datenfilter.h"

//schiebt die Daten eines i Arrays um eins weiter ([0]->[1] etc.)
void DatenShift(float* Daten, int i)
{
	i--;
	for(; i>0; i--)
    {
		Daten[i] = Daten[i-1];
	}
}



//speichert den mittleren Wert aus Daten in MittelwertGefiltert[0] (rest verschiebt sich [0]->[1])
void MittelwertFilter(float* Daten, float* MittelwertGefiltert)
{
	int i;
	int k;
	float Mittelwert[5] = {0, 0, 0, 0, 0};	
	for(i=0; i<5; i++)
	{
		int j=0;
		while(Daten[i] <= Mittelwert[j] && j<4)
		{
			j++;
		}					
		for(k=4; k>j; k--)
		{
			Mittelwert[k]	= Mittelwert[k-1];
		}
		Mittelwert[j] = Daten[i];
	}
	DatenShift(MittelwertGefiltert, 5);
	MittelwertGefiltert[0] = Mittelwert[2];
}