着陸wait版9/16

Dependencies:   HCSR04_2 MPU6050_2 mbed SDFileSystem3

Fork of Autoflight2018_17 by 航空研究会

pid/pid.h

Committer:
TUATBM
Date:
2018-09-17
Revision:
15:43427b0241d9
Parent:
0:17f575135219

File content as of revision 15:43427b0241d9:

#ifndef PID_MBED_H
#define PID_MBED_H


#include "mbed.h"

class PID
{
public:
    double kp, ki, kd, max, min, dt; 

    //コンストラクタ
    PID();
    PID(double Pgain, double Igain, double Dgain);
    PID(double Pgain, double Igain, double Dgain, double Max, double Min);
    //デストラクタ
    ~PID();

    void initialize(void);
    void setPIDgain(double Pgain, double Igain, double Dgain);
    void setMaxMin(double Max, double Min);
    void switchMaxMin(bool Maxcheck, bool Mincheck);
    double calcPID(double nowval, double targetval, double dt);


private:
    double integral;
    double oldval[2], diff[2];
    bool maxcheck, mincheck;
};

#endif