Hallo, brauche wieder einmal euren Tipp!
Für mein Schulprojekt (Tennisball-Wurf-Maschine) die 2 gegenläufige DC-Motoren hat, welche über Logic-MOS-FETs via PWM von einem Arduino angesteuert werden, versuche ich gerade den Regler einzustellen.
Ein entsprechendes Programm habe ich mir aus dem Internet #include <PID_v1.h> besorgt.
Momentan versuche ich, die Drehzahl eines Motors stabil zu halten. Leider nicht mit dem gewünschten Erfolg.
Die Soll-Drehzahl "Setpoint" kommt über einen analogen Input (Poti) herein.
Die IST-Drehzahl "Input" kommt von einer Gabellichtschranke, die die Impuls von einer 4-Lochscheibe an der Motorachse bekommt.
Die Regelung läuft zwar, aber der Motor läuft hörbar unruhig, speziell im unteren Drehzahlbereich.
Da ich kein Mathematiker bin und auch mit Regelungen nichts am Hut habe, würde ich doch gerne den Regler optimieren.
Wo ich Probleme habe:
- Ist die Loopzeit mit 1ms schnell genug für 2 Regelungen (hier nur eine zum Testen)
- Müsste der IST-WERT (Input) schneller zur Verfügung gestellt werden wie der
Output(Stellgröße)? Gibt es Faustformeln oder Anhaltspunkte, in welchem Verhältnis die
zueinander stehen müssen - sollten ...? - 2-Regelungen parallel laufen lassen in einem Sketch, ich das möglich?
habe leider keine Ahnung ...
Hoffe auf eure Hilfe danke
Mad
Hier mein Code:
#include <stdio.h>
#include <PID_v1.h>
static int drehz_zaehler = 0;
//*******************************
// Funktionen deklarieren
//*******************************
float drehz_ermitteln(int ms);
float drehz_ausgabe(int ms);
void blink_led(int ms);
void DREHZAHL_SENSOR();
//Define Variables we'll be connecting to
double Setpoint, Input, Output;
//Define the aggressive and conservative Tuning Parameters
double aggKp = 4, aggKi = 0.2, aggKd = 1;
double consKp = 1, consKi = 0.05, consKd = 0.25;
//Specify the links and initial tuning parameters
PID myPID(&Input, &Output, &Setpoint, consKp, consKi, consKd, DIRECT);
void setup()
{
Serial.begin(38400);
attachInterrupt(0, DREHZAHL_SENSOR, FALLING); // Encoder-Pin an Interrupt 0 (Pin 2)
Input = 40; // Solldrehzahl zu beginn
Setpoint = 50; // Führungsgröße
//turn the PID on
myPID.SetMode(AUTOMATIC);
pinMode(2, INPUT); // IR als Input
pinMode(7, INPUT); // Schalter für Start
digitalWrite(2, HIGH); // IR Pullup EIN
digitalWrite(7, HIGH); // Pullup
}
void loop()
{
delayMicroseconds(100);
//delay(1); // Loop-Zeit vorgeben (1ms)
if (digitalRead(7) == HIGH) // Motor start/stopp
{
analogWrite(3, 0); // PWM auf 0 --> stopp Motor
}
else
{
Setpoint = analogRead(0) / 4; // Führungsgröße w vom Poti --> 1024 / 4 = 256 --> für das "analogeWrite" 8 bit --> max 0-255 !!!
drehz_ermitteln(30); // Drehzahl ermitteln alle 30 ms (Loopzeit 1 ms * 30 = 30 ms)
//*******************************
// *** SW-Regelung ***
//*******************************
double gap = abs(Setpoint - Input); //distance away from setpoint
// *** default 10 ***
if (gap < 10) //we're close to setpoint, use conservative tuning parameters
{
myPID.SetTunings(consKp, consKi, consKd);
}
else //we're far from setpoint, use aggressive tuning parameters
{
myPID.SetTunings(aggKp, aggKi, aggKd);
}
myPID.Compute();
drehz_ausgabe(1); // Wert setzen alle 1 ms (Loopzeit 0,1 ms * 1 = 1 ms)
// analogWrite(3, Output); // Output max 255 (8 bit)
}
}
// *****************************
// Drehzahl Ermittlung/Amsgabe
// *****************************
void DREHZAHL_SENSOR() {
drehz_zaehler++;
}
Hier meine Unterfunktionen:
// *****************************
// Drehzahl Ermittlung
// *****************************
float drehz_ermitteln(int ms) {
static int i_zaehler = 0;
if (i_zaehler >= ms) {
Input = drehz_zaehler*30; // Umrechung auf Minuten
drehz_zaehler = 0; // IR-Zählvariable zurücksetzen
i_zaehler = 0;
Serial.print("Setpoint: "); // Serial Monitor
Serial.print(Setpoint);
Serial. print(" --> Input: ");
Serial.print(Input);
Serial.print(" --> Output: ");
Serial.println(Output); // Serial Plotter
}
i_zaehler++;
}
// *****************************
// Drehzahl Ausgabe
// *****************************
float drehz_ausgabe(int ms) {
static int i_zaehler = 0;
if (i_zaehler >= ms) {
i_zaehler = 0;
analogWrite(3, Output); // Output max 255 (8 bit)
//Serial.println(Output); // Serial Plotter
}
i_zaehler++;
}