91美女视频-亚洲免费观看视频-欧美a∨-久热在线视频-日韩黄网站-成av人片在线观看www-久操综合-超碰av在线播放-性欧美欧美巨大69-婷婷二区-av男人的天堂网-中文字幕一区在线播放-玖草在线观看-国产网址在线观看-免费在线不卡av

#include <REGX51.H>
#include <intrins.h>
#include <string.h>
#include <stdio.h>

typedef struct PID {

        double  SetPoint;          

        double  Proportion;        
        double  Integral;        
        double  Derivative;        

        double  LastError;        

        double  PrevError;          

        double  SumError;        

} PID;
double PIDCalc( PID *pp, double NextPoint )
{
    double  dError,
            Error;

        Error = pp->SetPoint -  NextPoint;        

        pp->SumError += Error;                    

        dError = pp->LastError - pp->PrevError;  

        pp->PrevError = pp->LastError;
        pp->LastError = Error;
        return (pp->Proportion * Error        

            +   pp->Integral * pp->SumError      

            +   pp->Derivative * dError            

        );
}
//////////////////////////////////////////////////////////////////////

void PIDInit (PID *pp)
{
    memset ( pp,0,sizeof(PID));
}



double sensor (void)                

    return 100.0;
}

void actuator(double rDelta)        {}

void man(void)
{
    PID         sPID;                  

    double      rOut;                  

    double      rIn;                  

    PIDInit ( &sPID );                

    sPID.Proportion = 0.5;            

    sPID.Integral   = 0.5;
    sPID.Derivative = 0.0;
    sPID.SetPoint   = 0.3;        

    for (;;) {                        

        rIn = adc ();                

        rOut = PIDCalc ( &sPID,rIn );
        actuator ( rOut );            

    }
}