controller.h

00001 #include "mbed.h"
00002 
00003 
00004 
00005 class PID
00006 {
00007 public:
00008 
00009 
00010     float de_kp;
00011     float de_ip;
00012     float de_dp;
00013 
00014 
00015 
00016     float  de_output;
00017 
00018 
00019     /*
00020     * Constructeur
00021     * Sets default limits, calculates tuning parameters, and sets manual mode with no bias.
00022     * @param Kc - Tuning parameter
00023     * @param tauI - Tuning parameter
00024     * @param tauD - Tuning parameter
00025     * @param interval PID calculation performed every interval seconds.
00026     */
00027     PID(float in_min,float in_max,float out_min,float out_max,float Kc, float tauI, float tauD, float interval);
00028 
00029     /*
00030     * Scale from inputs to 0-100%.
00031     * @param InMin The real world value corresponding to 0%.
00032     * @param InMax The real world value corresponding to 100%.
00033     */
00034     void setInputLimits(float inMin, float inMax);
00035 
00036     /*
00037     * Scale from outputs to 0-100%.
00038     * @param outMin The real world value corresponding to 0%.
00039     * @param outMax The real world value corresponding to 100%.
00040     */
00041     void setOutputLimits(float outMin, float outMax);
00042 
00043     /*
00044     * Calculate PID constants.
00045     * Allows parameters to be changed on the fly without ruining calculations.
00046     * @param Kc - Tuning parameter
00047     * @param tauI - Tuning parameter
00048     * @param tauD - Tuning parameter
00049     */
00050     void setTunings(float Kc, float tauI, float tauD);
00051 
00052     /*
00053     * Reinitializes controller internals. Automatically
00054     * called on a manual to auto transition.
00055     */
00056 //   void reset(void);
00057 
00058     /*
00059     * Set how fast the PID loop is run.
00060     * @param interval PID calculation peformed every interval seconds.
00061     */
00062 //   void setInterval(float interval);
00063 
00064     /*
00065     * Set the bias.
00066     * @param bias The bias for the controller output.
00067     */
00068 //    void setBias(float bias);
00069 
00070     /*
00071     * PID calculation.
00072     * @return The controller output as a float between outMin and outMax.
00073     */
00074     float compute(float pv, float sp);
00075 
00076     //Getters.
00077     float getInMin();
00078     float getInMax();
00079     float getOutMin();
00080     float getOutMax();
00081     float getInterval();
00082     float getPParam();
00083     float getIParam();
00084     float getDParam();
00085 
00086 private:
00087 
00088     //  bool usingFeedForward;
00089 
00090     //Actual tuning parameters used in PID calculation.
00091     float Kc_;
00092     float tauI_;
00093     float tauD_;
00094 
00095 
00096 
00097     float pParam_;
00098     float iParam_;
00099     float dParam_;
00100 
00101     float accError_;
00102 
00103     //Raw tuning parameters.
00104 
00105     //The point we want to reach.
00106     float setPoint_;
00107     //The thing we measure.
00108     float processVariable_;
00109     float prevProcessVariable_;
00110     //The output that affects the process variable.
00111     float controllerOutput_;
00112     float prevControllerOutput_;
00113 
00114     //We work in % for calculations so these will scale from
00115     //real world values to 0-100% and back again.
00116     float inMin_;
00117     float inMax_;
00118     float inSpan_;
00119 
00120     float outMin_;
00121     float outMid_;
00122     float outMax_;
00123     float outSpan_;
00124 
00125     float ctrl_Lbound;
00126     float ctrl_Ubound;
00127 
00128 
00129 
00130 
00131     //The accumulated error, i.e. integral.
00132     //float accError_;
00133     //The controller output bias.
00134     // float bias_;
00135 
00136     //The interval between samples.
00137     float tSample_;
00138 
00139     //Controller output as a real world value.
00140     // volatile float realOutput_;
00141 
00142 };