PID-functions

Set of helper functions to initiate and update a PID control loop

Description

PID_new( pid[], Float:set, Float:out ) // set up new PID
PID_dir( pid[], direction ) // set direction of control
PID_set( pid[], Float:set ) // adjust the target value
PID_tune( pid[], Float:Kp, Float:Ki, Float:Kd ) // set the P, I, D parameters
PID_limits( pid[], Float:min, Float:max ) // set the control range
PID_update( pid[], Float:in ) // update PID with feedback, and return new control value

Parameters

set setpoint / target
out Initial output value
direction 1 (normal) or -1 (reverse)
Kp Proportional component
Ki Integral response component
Kd Derivative response component
min Smallest output value allowed
max Largest output value allowed

Return value

The PID_update function returns the calculated output value.

Example usage

 
   new p[PID];  // create a PID 
 
   main() 
   {
      // Initialize the PID with target and no output
      PID_new(p, 50.0, 0.0);
 
      // Limit output to +/- 10
      PID_limits(p, -10.0, 10.0); 
 
      // Set the tuning parameters 
      PID_tune(p, 0.2, 0.04, 0.01);
 
      // Set update speed to 100ms
      SetTickInterval( 100 );
   }
 
   @Tick(uptime) 
   {
      new Float:psi;      
      new Float:v;
 
      // Read and scale a sensor input (0-100psi from 4-20mA sensor)
      psi = 100.0 * ((GetInputValue(1, INVAL_RAW)-4000)/16000);
 
      // Update the PID with the feedback value
      v = PID_update(p, psi);
 
      // Apply to output
      SetOutput(4, fround(v+50));
   }
 

NOTE: The values used in the above example are not from a real world setup. Please make sure you understand how PID works and how to correctly tune the variables if you use any of the PID functions.