Mirror actuator for RT2 lab

Dependencies:   FastPWM

Library_Cntrl/PI_Cntrl.h

Committer:
altb2
Date:
2021-05-02
Revision:
15:9f32f64eee5b

File content as of revision 15:9f32f64eee5b:

class PI_Cntrl
{
public:

    PI_Cntrl(float Kp, float Tn, float Ts);
    PI_Cntrl(float Kp, float Tn, float Ts, float uMax);
    PI_Cntrl(float Kp, float Tn, float Ts, float uMax, float uMin);

    float operator()(float error) {
        return doStep((double)error);
    }

    virtual     ~PI_Cntrl();

    void        reset(float initValue);
    float       doStep(double error);

private:

    double b0;
    double b1;
    double b2;
    double s;
    double uMax;
    double uMin;
    
    void        setCoefficients(float Kp, float Tn, float Ts);

};