Zrobiłem na stykówce zasilacz podobny do tego LINK, regulacja napięcia poprzez potencjometry.
Chciałem sobie zrobić pseudo ogranicznik prądowy, nóżkę układu LM723 Currrent sens podpiołem do masy a do current limit do wyjscia układu DAC MCP4726 poprzez dzielnik napiecia tak ze 5V na dac to 0,8V na wyjściu z dzielnika.
Problem jest taki ze zakres pracy tego tranzystora to 0,5-0,7V pełne otwarcie. Co daje około 400 poziomów kwantyzacji z MCP4726 z 12 bitów (4065) trochę mało. Ciężko jakoś sensownie wyregulować PID bo przez długi czas nic się nie dzieje
(miedzy 0-0,5V MCP4726 [0-3200 p.k]) a później mała zmiana ma duży wpływ (0,5-0,7V MCP4726 [3200-3600 p.k]). Czyli z dostępnych 12 bitów wykorzystuje niespełna 5. Jak w miarę prosty sposób mieć regulacje w pełnym zakresie czyli na MCP4726 napięcie zmienia się 0-5V a do układu dostarczam 0,5-0,8V. Albo jak sprawić żeby charakterystyka tranzystora była bardziej liniowa.
Regulacja Setpoint = 1A
Wartosci Kp, Ki, Kd, lewa oś odnosi się do Ki
Algorytmu PID : LINK
Main
[syntax=c]void setup() {
// STOP INTEROUPTS FOR INITIALIZATION
PID_Parameters(30,10,4);// zdefiniowanie Kp,Ki.Kd
PID_MinMax(3200,3600);
Wire.begin(); // start i2c jako master
Serial.begin(9600);
}
void loop() {
// put your main code here, to run repeatedly:
AnalogRead();
if (millis() - Timer02 > UTd02){
Timer02 = millis();
PID_Compute();
setVoltage(output_i);
}
if (millis() - Timer01 > UTd01){
Timer01 = millis();
Serial.print(Timer01);
Serial.print(" A: ");
Serial.print(A);
Serial.print(" V: ");
Serial.print(V);
Serial.print(" Set: ");
Serial.print(setpoint);
Serial.print(" Out: ");
Serial.print(output);
Serial.print(" Out_i: ");
Serial.print(output_i);
Serial.print(" Uchyb: ");
Serial.print(error);
Serial.print(" Kp: ");
Serial.print(Kp_P);
Serial.print(" Ki: ");
Serial.print(Ki_P);
Serial.print(" Kd: ");
Serial.println(Kd_P);
}[/syntax]
Funkcje
[syntax=c]void PID_Parameters(float KpU, float KiU, float KdU) {
Kp=KpU;
Ki=KiU;
Kd=KdU;
}
void PID_MinMax(float Min, float Max) {
limitMAX = Max;
limitMIN = Min;
}
void PID_Compute() {
error = -(setpoint - A);
ITerm += (Ki * error);
if (ITerm > limitMAX) { ITerm = limitMAX;}
if (ITerm < limitMIN) { ITerm = limitMIN;}
dErr = (error - lastErr);
lastErr = error;
output = Kp * error + ITerm - Kd * dErr; // czesc rozniczkowa moze byc z minusem
Kp_P = Kp * error;
Ki_P = ITerm;
Kd_P = Kd * dErr;
if (output > limitMAX) { output = limitMAX;}
if (output < limitMIN) { output = limitMIN;}
output_i = output;
}
void setVoltage( uint16_t output){
Wire.beginTransmission(MCP_ADDR);
Wire.write((uint8_t) ((output_i >> 8) & 0x0F)); // MSB: (D11, D10, D9, D8)
Wire.write((uint8_t) (output_i)); // LSB: (D7, D6, D5, D4, D3, D2, D1, D0)
Wire.endTransmission();
}
void AnalogRead() {
// srednia ruchoma
odczyt_A0 = analogRead(PRAD);
odczyt_A2 = analogRead(NAPIECIE);
sred_A = ((sred_A * dt)+odczyt_A0)/(dt+1); // srednia kroczaca pradu
A = ((sred_A-512)*0.05859375); // podmienic na rownanie po kalibracji
sred_V = ((sred_V * dt)+odczyt_A2)/(dt+1); // srednia kroczaca napiecia
V = (sred_V * 0.0048828125)/(0.167); // podmienic na rownanie po kalibracji
}[/syntax]Statystyki: Napisane przez Ekstrapolator — 12 wrz 2014, o 14:09
]]>
