ESP8266/Arduino-pid: Difference between revisions

From Playful Exploration
Jump to navigation Jump to search
No edit summary
 
(7 intermediate revisions by 3 users not shown)
Line 1: Line 1:
[[category:ESP]]
== PID control on ESP8266 or other Arduino compatible chips ==
== PID control on ESP8266 or other Arduino compatible chips ==


<pre>
<syntaxhighlight lang=cpp>
void loop() {
void loop() {


Line 31: Line 32:
   Last = Actual; // save current value for next time
   Last = Actual; // save current value for next time
}
}
</pre>
</syntaxhighlight>


Source: http://www.maelabs.ucsd.edu/mae156alib/control/PID-Control-Ardunio.pdf
Source: http://www.maelabs.ucsd.edu/mae156alib/control/PID-Control-Ardunio.pdf


== Or use an Arudino library: ==
=== Or use an Arudino library: ===
* [http://playground.arduino.cc/Code/PIDLibrary Arduino PID Library]
* [http://playground.arduino.cc/Code/PIDLibrary Arduino PID Library]
== PID Refactored ==
This is attempt to make the pid code readable and understandable:
<syntaxhighlight lang=cpp>
float prev;        // previous value, initialize with first current value
float inte = 0;    // integral memory, initialize to zero
float kkkP = 1;    // coefficient for proportional term
float kkkI = 1;    // coefficient for integral term
float kkkD = 1;    // coefficient for differential term
float high = 100;  // output high limit
float loww =-100;  // output low limit
float pid(float setp, float inpu)
{
    float erro, prop, diff, outp;
    // calulate the error
    erro = setp - inpu;
    // calulate the P, I and D term
    prop = kkkP * erro;
    inte = kkkI * erro + inte;
    diff = kkkD * (inpu - prev);
    // limit the integral to combat integral windup
    if (inte > high) inte = high;
    else if (inte < loww) inte = loww;
    // calulate the response
    outp = prop + inte + diff;
    // limit the response
    if (outp > high) outp = high;
    else if (outp < loww) outp = loww;
    // store the last value for the next run
    prev = inpu;
    return outp;
}
</syntaxhighlight>

Latest revision as of 06:47, 22 July 2016

PID control on ESP8266 or other Arduino compatible chips

void loop() {

  //-------------------- Calculates the PID drive value --------------------

  Actual = analogRead(Position);
  Error = SetPt - Actual;
  
  if (abs(Error) < IntThresh){ // prevent integral 'windup'
    Integral = Integral + Error; // accumulate the error integral
  } else {
    Integral=0; // zero it if out of bounds
  }
  P = Error*kP; // calc proportional term
  I = Integral*kI; // integral term
  D = (Last-Actual)*kD; // derivative term
  Drive = P + I + D; // Total drive = P+I+D
  Drive = Drive*ScaleFactor; // scale Drive to be in the range 0-255

  if (Drive < 0){ // Check which direction to go.
    digitalWrite (Direction,LOW); // change direction as needed
  } else { // depending on the sign of Error
    digitalWrite (Direction,HIGH);
  }
  if (abs(Drive)>255) {
    Drive=255;
  }
  analogWrite (Motor,Drive); // send PWM command to motor board
  Last = Actual; // save current value for next time
}

Source: http://www.maelabs.ucsd.edu/mae156alib/control/PID-Control-Ardunio.pdf

Or use an Arudino library:

PID Refactored

This is attempt to make the pid code readable and understandable:

float prev;        // previous value, initialize with first current value
float inte = 0;    // integral memory, initialize to zero
float kkkP = 1;    // coefficient for proportional term
float kkkI = 1;    // coefficient for integral term
float kkkD = 1;    // coefficient for differential term
float high = 100;  // output high limit
float loww =-100;  // output low limit

float pid(float setp, float inpu)
{
    float erro, prop, diff, outp;

    // calulate the error
    erro = setp - inpu;

    // calulate the P, I and D term
    prop = kkkP * erro;
    inte = kkkI * erro + inte;
    diff = kkkD * (inpu - prev);

    // limit the integral to combat integral windup
    if (inte > high) inte = high;
    else if (inte < loww) inte = loww;

    // calulate the response
    outp = prop + inte + diff;

    // limit the response
    if (outp > high) outp = high;
    else if (outp < loww) outp = loww;

    // store the last value for the next run
    prev = inpu;

    return outp;
}