1333 unit->PID_I_err = -10.0; |
1333 unit->PID_I_err = -10.0; |
1334 if (unit->PID_I_err > 10.0) |
1334 if (unit->PID_I_err > 10.0) |
1335 unit->PID_I_err = 10.0; |
1335 unit->PID_I_err = 10.0; |
1336 P_err = err; |
1336 P_err = err; |
1337 D_err = err - unit->PID_err_old; |
1337 D_err = err - unit->PID_err_old; |
1338 unit->PID_err_old = err; |
|
1339 |
1338 |
1340 /* |
1339 /* |
1341 * A postive value means heating, a negative value cooling. |
1340 * A postive value means heating, a negative value cooling. |
1342 */ |
1341 */ |
1343 Out = (10.0*P_err) + (0.1*unit->PID_I_err) + (5*D_err); |
1342 Out = (10.0*P_err) + (0.1*unit->PID_I_err) + (5*D_err); |