Index: firmware/source/sys_main.c
===================================================================
diff -u -rf5f00981805e265ce63058f650d784f06db4d188 -r7190eb2aaf022b35456edb233ece489c1533a5f2
--- firmware/source/sys_main.c	(.../sys_main.c)	(revision f5f00981805e265ce63058f650d784f06db4d188)
+++ firmware/source/sys_main.c	(.../sys_main.c)	(revision 7190eb2aaf022b35456edb233ece489c1533a5f2)
@@ -64,6 +64,7 @@
 
 #include "HDCommon.h"
 #include "Accel.h"
+#include "AirPump.h"
 #include "AirTrap.h"
 #include "AlarmLamp.h"
 #include "Battery.h"
@@ -73,6 +74,7 @@
 #include "Buttons.h"
 #include "CommBuffers.h"
 #include "CPLD.h"
+#include "DGInterface.h"
 #include "DialInFlow.h"
 #include "DialOutFlow.h"
 #include "Fans.h"
@@ -81,6 +83,7 @@
 #include "Integrity.h"
 #include "InternalADC.h"
 #include "Interrupts.h"
+#include "ModeTreatmentParams.h"
 #include "MsgQueues.h"
 #include "NVDataMgmt.h"
 #include "OperationModes.h"
@@ -124,9 +127,7 @@
     initTasks();        // Setup and start the scheduled tasks
 
     // Start task background (will not return)
-#ifndef _VECTORCAST_
     taskBackground();
-#endif
 
 /* USER CODE END */
 
@@ -173,6 +174,7 @@
  *************************************************************************/
 static void initSoftware( void )
 {
+    initSemaphores();
     // Initialize ms timer counter
     initTimers();
     // Initialize alarm manager
@@ -183,8 +185,12 @@
     initInternalADC();
     initBattery();
     initRTC();
+    // Initialize async interrupt handlers
+    initInterrupts();
     // Initialize services
+    initTestConfigs();
     initCommBuffers();
+    initDGInterface();
     initIntegrity();
     initFPGA();
     initMsgQueues();
@@ -202,6 +208,7 @@
     initTemperatures();
     initSwitches();
     // Initialize controllers
+    initAirPump();
     initAirTrap();
     initAlarmLamp();
     initBloodFlow();
@@ -212,8 +219,7 @@
     initFans();
     // Initialize modes
     initOperationModes();
-    // Initialize async interrupt handlers
-    initInterrupts();
+    initTreatParamsMode();
 }
 
 /*************************************************************************