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

Dependencies:   Servo mbed

Fork of DrehungMitStopp by kings

Committer:
freunjor
Date:
Thu May 18 13:25:31 2017 +0000
Revision:
4:85b8b4aa97a3
Parent:
1:d40ff07e2fe0
fdasdf

Who changed what in which revision?

UserRevisionLine numberNew contents of line
EHess 1:d40ff07e2fe0 1 #ifndef LOWPASS_FILTER_H_
EHess 1:d40ff07e2fe0 2 #define LOWPASS_FILTER_H_
EHess 1:d40ff07e2fe0 3
EHess 1:d40ff07e2fe0 4 #include <cstdlib>
EHess 1:d40ff07e2fe0 5 #include <cmath>
EHess 1:d40ff07e2fe0 6
EHess 1:d40ff07e2fe0 7 //E. Hess
EHess 1:d40ff07e2fe0 8 //LowpassFilter.cpp
EHess 1:d40ff07e2fe0 9
EHess 1:d40ff07e2fe0 10 /**
EHess 1:d40ff07e2fe0 11 * This class implements a time-discrete 2nd order low-pass filter for a series of data values.
EHess 1:d40ff07e2fe0 12 * This filter can typically be used within a periodic task that takes measurements that need
EHess 1:d40ff07e2fe0 13 * to be filtered, like speed or position values.
EHess 1:d40ff07e2fe0 14 */
EHess 1:d40ff07e2fe0 15 class LowpassFilter {
EHess 1:d40ff07e2fe0 16
EHess 1:d40ff07e2fe0 17 public:
EHess 1:d40ff07e2fe0 18
EHess 1:d40ff07e2fe0 19 LowpassFilter();
EHess 1:d40ff07e2fe0 20 virtual ~LowpassFilter();
EHess 1:d40ff07e2fe0 21 void reset();
EHess 1:d40ff07e2fe0 22 void reset(float value);
EHess 1:d40ff07e2fe0 23 void setPeriod(float period);
EHess 1:d40ff07e2fe0 24 void setFrequency(float frequency);
EHess 1:d40ff07e2fe0 25 float getFrequency();
EHess 1:d40ff07e2fe0 26 float filter(float value);
EHess 1:d40ff07e2fe0 27
EHess 1:d40ff07e2fe0 28 private:
EHess 1:d40ff07e2fe0 29
EHess 1:d40ff07e2fe0 30 float period;
EHess 1:d40ff07e2fe0 31 float frequency;
EHess 1:d40ff07e2fe0 32 float a11, a12, a21, a22, b1, b2;
EHess 1:d40ff07e2fe0 33 float x1, x2;
EHess 1:d40ff07e2fe0 34 };
EHess 1:d40ff07e2fe0 35
EHess 1:d40ff07e2fe0 36 #endif