Hallöchen,
ich möchte gerne einen Brushless DC Motor mittels einem PID-Regler auf eine gewünschte Drehzahl regeln. (PWM 1ms-2ms)
Die Drehzahl wird über eine Lichtschranke gemessen, die soweit auf +/-20 1/min genau misst.
Leider schwingt meine Drehzahl beim regelen doch recht stark um ca 500/min um die Soll-Drehzahl rum.
Angefangen habe ich mal lediglich mit dem P-Glied, und habe Kp soweit erhöht, bis ich am ehesten im Bereich meiner Soll-Drehzahl von 3.500 liege.
Anschließend wollte ich das I- und D-Glied anhängen. Leider ändert das so gut wie gar nichts, egal welche Werte ich für Ki und Kd verwende. (0,01-10) DIe Drehzahl wird nicht ruhiger und nähert sich auch nicht weiter an die 3.500 Soll an.
Ki und Kd scheinen irgendwie fast völlig ignoriert zu werden ![]()
Ich weiß momentan einfach nicht weiter, habe ich einen Fehler im Code, hab ich was vergessen oder völlig falsche Vorstellungen von einer sauberen Drehzahlregelung und genauer geht es nicht?
Ich wäre unendlich dankbar, wenn mir jemand weiterhelfen könnte.
Liebe Grüße
#include <Servo.h>
#include <Wire.h>
Servo ESC;
//------------------
int sollDrehzahl = 3500;
double kp = 5.3;
double ki =0.075;
double kd = 0.05;
//------------------
const int lichtschranke = 3;
long zeitAnfang, zeitEnde, zeitDifferenz;
float istDrehzahl, error, alterError, pid_p, pid_i, pid_d, pid_pid;
void setup() {
// put your setup code here, to run once:
Serial.begin(9600);
ESC.attach(6);
ESC.write(25);
delay(2000);
pinMode(lichtschranke, INPUT_PULLUP); //PinMode konfiguieren(Eingang)
}
void loop() {
while (millis() < 15000) { //15 Sekunden lang folgendes machen....
zeitAnfang = micros(); //Startzeit nehmen
istDrehzahl = messen(); //Aktuelle Drehzahl messen
error = sollDrehzahl - istDrehzahl; //Fehler bzw. Abweichung von Soll-Drehzahl berechnen
pid_p = error * kp; //P-Regler = Fehler*Kp
pid_i = pid_i + (ki * error); //I-Regler = pid_i + (Fehler*Ki)
zeitDifferenz = zeitAnfang - zeitEnde; //Laufzeit eines Messdurchgangs (=dt)
pid_d = kd * ((error - alterError) / zeitDifferenz); //D-Regler = Kd * ((Fehlerdifferenz/Laufzeit)
alterError = error; //Aktueller Fehler wird als alter Fehler gespeichert
pid_pid = pid_p + pid_i + pid_d; //PID-Regler = (P+I+D) Regler
if (pid_pid > 1800) { //PID auf max. mögliches PWM-Signal begrenzen
pid_pid = 1800;
}
if (pid_pid < 1035) { //PID auf minimal mögliches PWM-Signal begrenzen
pid_pid = 1035;
}
Serial.println(istDrehzahl); //Aktuelle Drehzahl ausgeben
zeitEnde = micros(); //Endzeit eines Durchgangs speichern
ESC.writeMicroseconds(pid_pid); //Motor mit neuem PID-Wert(=PWM) ansteuern
}
ESC.writeMicroseconds(1000); //Nach 15s den Motor stoppen
}
float messen() {
long zeit;
zeit = pulseIn(lichtschranke, LOW); //zeit = Dauer bis
zeit = zeit * 2;
istDrehzahl = 1000000.0 / zeit * 60.0;
if (zeit == 0) {
return 0;
} else {
return istDrehzahl;
}
}


