Index: firmware/App/Controllers/Heaters.c
===================================================================
diff -u -r542755e62be20cbdd396053c5568ef8a13efad05 -rdb7a07277014e802f582716c4215044ff905266b
--- firmware/App/Controllers/Heaters.c	(.../Heaters.c)	(revision 542755e62be20cbdd396053c5568ef8a13efad05)
+++ firmware/App/Controllers/Heaters.c	(.../Heaters.c)	(revision db7a07277014e802f582716c4215044ff905266b)
@@ -57,7 +57,7 @@
 #define ADJ_DELTA_TEMP_STEP                                        2.0F                                                            ///< Adjust target temperature based on D28 feedback per cycle.
 #define MAX_ADJ_DELTA_TEMP_C                                       7.0F                                                            ///< Maximum adjusted delta temperature to add/remove from calculated target temperature
 #define D5_HEAT_TX_INIT_FEED_FORWARD                               0.0F                                                            ///< Initial Feed forward term for heater control
-#define D5_HEAT_TX_P_COEFFICIENT                                   0.005F                                                          ///< P Term for AC primary heater control during treatment mode.
+#define D5_HEAT_TX_P_COEFFICIENT                                   0.034F                                                          ///< P Term for AC primary heater control during treatment mode.
 #define D5_HEAT_TX_I_COEFFICIENT                                   0.001F                                                          ///< I Term for AC primary heater control during treatment mode.
 
 #define D45_HEAT_P_COEFFICIENT                                     0.01F                                                           ///< P Term for trimmer heater control.
@@ -939,31 +939,31 @@
             // assign the feed forward control
             control[ heater ].data = d5_cap_final_FF;
 #endif
-//#ifdef __HEATERS_DEBUG__
-//            U32 i;
-//
-//            for ( i = 0; i < NUM_OF_CONTROLLER_SIGNAL; i++ )
-//            {
-//                pIControlSignal[ i ] = getPIControllerSignals( PI_CONTROLLER_ID_D5_HEAT_OUTER_LOOP, (PI_CONTROLLER_SIGNALS_ID)i );
-//            }
-//#endif
-        }
-        else
-        {
-            measuredTemperature = getFilteredTemperatureValue( D50_TEMP );
-
-            ctrl = runPIController( PI_CONTROLLER_ID_D45_HEAT, targetTemperature, measuredTemperature );
-            control[ heater ].data = ctrl;
 #ifdef __HEATERS_DEBUG__
             U32 i;
 
             for ( i = 0; i < NUM_OF_CONTROLLER_SIGNAL; i++ )
             {
-                pIControlSignal[ i ] = getPIControllerSignals( PI_CONTROLLER_ID_D45_HEAT, (PI_CONTROLLER_SIGNALS_ID)i );
+                pIControlSignal[ i ] = getPIControllerSignals( PI_CONTROLLER_ID_D5_HEAT_OUTER_LOOP, (PI_CONTROLLER_SIGNALS_ID)i );
             }
 #endif
         }
+        else
+        {
+            measuredTemperature = getFilteredTemperatureValue( D50_TEMP );
 
+            ctrl = runPIController( PI_CONTROLLER_ID_D45_HEAT, targetTemperature, measuredTemperature );
+            control[ heater ].data = ctrl;
+//#ifdef __HEATERS_DEBUG__
+//            U32 i;
+//
+//            for ( i = 0; i < NUM_OF_CONTROLLER_SIGNAL; i++ )
+//            {
+//                pIControlSignal[ i ] = getPIControllerSignals( PI_CONTROLLER_ID_D45_HEAT, (PI_CONTROLLER_SIGNALS_ID)i );
+//            }
+//#endif
+        }
+
         heatersStatus[ heater ].hasTargetTempChanged   = FALSE;
         heatersStatus[ heater ].controlIntervalCounter = 0;