Mercurial > mbsePi-apps / file diff

--- a/thermferm/thermferm.c	Sun Feb 15 20:38:54 2015 +0100
+++ b/thermferm/thermferm.c	Sun Feb 15 23:09:00 2015 +0100
@@ -836,7 +836,7 @@
     prof_step		*step;
     int			rc, run = 1, seconds = 0, minutes = 0, piddelay = 0, temp, deviation;
     int			run_seconds, run_minutes, run_hours, tot_minutes;
-    float		err = 0.0, sp, pv, P_err, D_err, Out;
+    float		sp, pv, P_err = 0.0, D_err, Out;
 #ifdef HAVE_WIRINGPI_H
     struct tm		*tm;
     int			row, key;
@@ -1303,7 +1303,7 @@
 	    }
 
 	    piddelay++;
-	    if (piddelay == 15) {
+	    if (piddelay == 5) {
 		piddelay = 0;
 
 		for (unit = Config.units; unit; unit = unit->next) {
@@ -1320,21 +1320,21 @@
 				sp = unit->prof_target;
 			}
 
-//			unit->PID_err_old = err;
-			err = sp - pv;
-			if (err < unit->idle_rangeH && err > unit->idle_rangeL) {
-			    err = 0;
-			    unit->PID_I_err -= unit->PID_err_old;
-			} else {
-			    unit->PID_I_err += unit->PID_err_old;
+			P_err = sp - pv;
+			if (P_err < unit->idle_rangeH && P_err > unit->idle_rangeL) {
+			    P_err = 0.0;
 			}
-			/* Limit intergral error */
-			if (unit->PID_I_err < -10.0)
-			    unit->PID_I_err = -10.0;
-			if (unit->PID_I_err > 10.0)
-			    unit->PID_I_err = 10.0;
-			P_err = err;
-			D_err = err - unit->PID_err_old;
+			unit->PID_I_err += (unit->PID_Ki * P_err);
+//			    unit->PID_I_err -= unit->PID_err_old;
+//			} else {
+//			    unit->PID_I_err += unit->PID_err_old;
+//			}
+			/* Limit integral error */
+			if (unit->PID_I_err < -100.0)
+			    unit->PID_I_err = -100.0;
+			if (unit->PID_I_err > 100.0)
+			    unit->PID_I_err = 100.0;
+			D_err = P_err - unit->PID_err_old;
 
 			/*
 			 * A postive value means heating, a negative value cooling.
@@ -1343,20 +1343,22 @@
 			 * Increase Kd until a little damping.
 			 * Increase Ki after Kp and Kd are set until longterm convergence.
 			 */
-			Out = (10.0*P_err) + (0.0*unit->PID_I_err) + (0.0*D_err);
-			//Out = (10.0*P_err) + (0.1*unit->PID_I_err) + (5*D_err);
-			//     Kp 0.1        Ki 0.3                   Kd 0.02
-			if (err != 0.0) {
+			Out = (unit->PID_Kp * P_err) + unit->PID_I_err - (unit->PID_Kd * D_err);
+			if (Out > 100.0)
+			    Out = 100.0;
+			if (Out < -100.0)
+			    Out = -100.0;
+//			if (P_err != 0.0) {
 			    if (debug)
-			    	fprintf(stdout, "sp=%.2f pv=%.2f err_old=%.2f err=%.2f P_err=%.2f I_err=%.2f D_err=%.2f Out=%.2f\n",
-					sp, pv, unit->PID_err_old, err, P_err, unit->PID_I_err, D_err, Out);
-			    syslog(LOG_NOTICE, "sp=%.2f pv=%.2f err_old=%.2f err=%.2f P_err=%.2f I_err=%.2f D_err=%.2f Out=%.2f",
-					sp, pv, unit->PID_err_old, err, P_err, unit->PID_I_err, D_err, Out);
-			}
-			unit->PID_err_old = err;
+			    	fprintf(stdout, "sp=%.2f pv=%.2f err_old=%.2f P_err=%.2f I_err=%.2f D_err=%.2f Out=%.2f\n",
+					sp, pv, unit->PID_err_old, P_err, unit->PID_I_err, D_err, Out);
+			    syslog(LOG_NOTICE, "sp=%.2f pv=%.2f err_old=%.2f P_err=%.2f I_err=%.2f D_err=%.2f Out=%.2f",
+					sp, pv, unit->PID_err_old, P_err, unit->PID_I_err, D_err, Out);
+//			}
+			unit->PID_err_old = P_err;
 
 			if (unit->heater_address) {
-			    if (Out >= 2) {
+			    if (Out >= 1) {
 				if (unit->heater_wait < unit->heater_delay) {
 				    unit->heater_wait++;
 				    syslog(LOG_NOTICE, "heater_wait + %d/%d", unit->heater_wait, unit->heater_delay);
@@ -1380,7 +1382,7 @@
 			    device_out(unit->heater_address, unit->heater_state);
 			}
 			if (unit->cooler_address) {
-			    if (Out <= -2) {
+			    if (Out <= -1) {
 			    	if (unit->cooler_wait < unit->cooler_delay) {
 				    unit->cooler_wait++;
 				    syslog(LOG_NOTICE, "cooler_wait + %d/%d", unit->cooler_wait, unit->cooler_delay);
@@ -1424,7 +1426,7 @@
 			    device_out(unit->fan_address, unit->fan_state);
 			}
 		    } else {
-			err = 0.0;
+			P_err = 0.0;
 			unit->PID_I_err = 0.0;
 			unit->PID_err_old = 0.0;
 		    }