Drehen mit Halt und offset um zum Klotz zurück drehen. (Kann nur ein klotz aufheben)

Dependencies:   Servo mbed

Fork of DrehungMitStopp by kings

LowpassFilter.h

Committer:
freunjor
Date:
2017-05-18
Revision:
4:85b8b4aa97a3
Parent:
1:d40ff07e2fe0

File content as of revision 4:85b8b4aa97a3:

#ifndef LOWPASS_FILTER_H_
#define LOWPASS_FILTER_H_

#include <cstdlib>
#include <cmath>

//E. Hess
//LowpassFilter.cpp

/**
 * This class implements a time-discrete 2nd order low-pass filter for a series of data values.
 * This filter can typically be used within a periodic task that takes measurements that need
 * to be filtered, like speed or position values.
 */
class LowpassFilter {
    
    public:
    
                LowpassFilter();
        virtual ~LowpassFilter();
        void    reset();
        void    reset(float value);
        void    setPeriod(float period);
        void    setFrequency(float frequency);
        float   getFrequency();
        float   filter(float value);
        
    private:
        
        float   period;
        float   frequency;
        float   a11, a12, a21, a22, b1, b2;
        float   x1, x2;
};

#endif