Last active
March 29, 2024 07:15
-
-
Save ivanseidel/b1693a3be7bb38ff3b63 to your computer and use it in GitHub Desktop.
Simple PID Class for Arduino Projects
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
// (Really Simple) PID Class by Ivan Seidel | |
// GitHub.com/ivanseidel | |
// Use as you want. Leave credits | |
class PID{ | |
public: | |
double error; | |
double sample; | |
double lastSample; | |
double kP, kI, kD; | |
double P, I, D; | |
double pid; | |
double setPoint; | |
long lastProcess; | |
PID(double _kP, double _kI, double _kD){ | |
kP = _kP; | |
kI = _kI; | |
kD = _kD; | |
P = 0; | |
I = 0; | |
D = 0; | |
lastProcess = -1; | |
} | |
void addNewSample(double _sample){ | |
sample = _sample; | |
} | |
void setSetPoint(double _setPoint){ | |
setPoint = _setPoint; | |
} | |
double process(){ | |
if (lastProcess == -1) { | |
lastSample = sample; | |
lastProcess = millis(); | |
} | |
// Implementação P ID | |
error = setPoint - sample; | |
float deltaTime = (millis() - lastProcess) / 1000.0; | |
lastProcess = millis(); | |
//P | |
P = error * kP; | |
//I | |
I = I + (error * kI) * deltaTime; | |
//D | |
D = (lastSample - sample) * kD / deltaTime; | |
lastSample = sample; | |
// Soma tudo | |
pid = P + I + D; | |
return pid; | |
} | |
}; | |
#define pSENSOR A1 | |
#define pCONTROLE 3 | |
PID meuPid(1.0, 0, 0); | |
void setup() { | |
Serial.begin(9600); | |
pinMode(pSENSOR, INPUT); | |
pinMode(pCONTROLE, OUTPUT); | |
} | |
int controlePwm = 50; | |
void loop() { | |
// Lê temperatura | |
double temperature = map(analogRead(pSENSOR), 0, 1023, 0, 100); | |
// Manda pro objeto PID! | |
meuPid.addNewSample(temperature); | |
// Converte para controle | |
controlePwm = (meuPid.process() + 50); | |
// Saída do controle | |
analogWrite(pCONTROLE, controlePwm); | |
} |
Sign up for free
to join this conversation on GitHub.
Already have an account?
Sign in to comment
Fala professor, estou reprogramando uma estação de solda que o stm veio a queimar, esse codigo, modificando com os botoes, e display 7 segmentos, seria possivel utilizar ?? claro fazendo os ajustes nos valores do PID