https://github.com/lemonpi/pid

general PID control for volatile input (interrupt driven)
https://github.com/lemonpi/pid

Last synced: 6 days ago
JSON representation

general PID control for volatile input (interrupt driven)

• Host: GitHub
• URL: https://github.com/lemonpi/pid
• Owner: LemonPi
• Created: 2015-02-13T00:12:57.000Z (almost 10 years ago)
• Default Branch: master
• Last Pushed: 2015-02-14T04:41:41.000Z (over 9 years ago)
• Last Synced: 2024-04-14T07:49:52.955Z (7 months ago)
• Language: C++
• Size: 105 KB
• Stars: 5
• Watchers: 3
• Forks: 1
• Open Issues: 0
• Metadata Files:
  • Readme: README.md

Awesome Lists containing this project

README

        
# PID

General PID control for volatile input (interrupt driven).

Based on Brett Beauregard's [PID_V1 library](https://github.com/br3ttb/Arduino-PID-Library/),

but with a more efficient compute (mainly by getting rid of his liberal use of doubles).

# Purpose

When you have an input (PWM to an H-bridge) that affects an output (speed of wheel) that is subject to additional factors (different motor, different terrain, non-linearity of driving current to speed, different wheel size), some feedback from the actual output is required to modulate the input so the output meets target. One closed loop technique that's commonly used in industry because of its simplicity and effectiveness is a PID controller - modulation on instant proportional error, integral of error over time, and the rate change of error/derivative.

An example of a output response curve with the target velocity as a white line, actual velocity of left wheel as purple and right wheel as red, and with each PID cycle (set at 50ms) being 2 pixels wide:

![example](http://imgur.com/GK4ILUi.png)

# Instructions

For arduino users, place directory inside My Documents/Arduino/libraries

```C++

#include 

// volatile input (interrupt driven) that you want to listen to

volatile int tick_l = 0;

// can use non-volatile, but need to remove all mention of volatile in the source

// interrupt ISR

void tick_left() {++tick_l;}

// target of 100 ticks per PID cycle (100ms by default), for example from your rotary encoder

int target_l = 100;

// PWM output to adjust input level

int motor_level = 0;

// templated on input, setpoint, and output type

PID motor_control_left(tick_l, target_l, motor_level);

// can be more specific and assign tuning parameters and output/input relations

PID motor_control_alt(tick_l, target_l, motor_level, 2.0, 0, 0.5, NEGATIVE);

// negative relation means as output increases input should be expected to decrease

void setup() {

  // listen on pin 2 (interrupt 0, Arduino logic...) for a falling clockedge

  attachInterrupt(0, tick_left, FALLING);

  // start monitoring input and give output feedback

  motor_control_left.start();

  

  // set cycle time to be 50ms = 20Hz (by default 100ms)

  motor_control_left.set_cycle(50);

  

  // tune with different parameters

  motor_control_left.tune(2.0, 0, 0.5);

}

void loop() {

  

  // simultaneously run PID and check if clock cycle occured

  if (motor_control_left.compute()) {

    // I don't recommend serially printing a volatile variable, use a temporary instead and clear right away

    Serial.println(tick_l);

    tick_l = 0;

  }

}