#include <stdio.h>

// Konfiguration für den Mittelwertfilter
#define N 5
#define FILTER_SAMPLES  (1<<N)  // Anzahl der Messungen, die gemittelt werden
int messwerte[FILTER_SAMPLES];  // Das Ringpuffer-Array für die Messungen
int index = 0;                  // Der aktuelle Index im Array
int messwertSumme = 0;          // Laufende Summe der Messwerte
int geglaetteterWert;

// Variablen für die Hysterese-Steuerung
int aktuelleStufe;
const int HYSTERESE = 15;      // Toleranzbereich (ca. 0,07V). Bei Bedarf erhöhen.

void magicblock(int adc) {
    messwertSumme -= messwerte[index];
    messwerte[index] = adc;
    messwertSumme += messwerte[index];
    index = (index + 1) % FILTER_SAMPLES;
    geglaetteterWert = (messwertSumme + (FILTER_SAMPLES>>1)) >> N;
    int zielStufe = geglaetteterWert >> 6;
    if (zielStufe != aktuelleStufe) {
        int schwellenWert = zielStufe * 64;
        if ((zielStufe > aktuelleStufe && geglaetteterWert > (schwellenWert + HYSTERESE))
        || (zielStufe < aktuelleStufe && geglaetteterWert < (schwellenWert + HYSTERESE)))
            aktuelleStufe = zielStufe;
    }
}

int main(void) {
    // int initial_adc = analogRead(ANALOG_IN_PIN);
    int initial_adc = 300; // analogRead(ANALOG_IN_PIN);

    for (int i = 0; i < FILTER_SAMPLES; i++)
        messwerte[i] = initial_adc;
    messwertSumme = initial_adc << N;
    geglaetteterWert = initial_adc;

    for (int adc = initial_adc; adc < 1024; adc++) {
        //magicblock(analogRead(ANALOG_IN_PIN));
        magicblock(adc);
        printf("%6d %6d %2d\n", adc, geglaetteterWert, aktuelleStufe);
    }
    for (int i = 0; i < 50; i++) {
        magicblock(1023);
        printf("%6d %6d %2d\n", 1023, geglaetteterWert, aktuelleStufe);
    }
    for (int adc= 1023; adc >= 0; adc--) {
        magicblock(adc);
        printf("%6d %6d %2d\n", adc, geglaetteterWert, aktuelleStufe);
    }
    for (int i = 0; i < 50; i++) {
        magicblock(0);
        printf("%6d %6d %2d\n", 0, geglaetteterWert, aktuelleStufe);
    }
    return 0;
}