Index: source/sys_main.c
===================================================================
diff -u -r765d2c35118e202444e737c66c77faf9678cc87e -radd7eb956a7d2c124434541e1f06ca5ae158716f
--- source/sys_main.c	(.../sys_main.c)	(revision 765d2c35118e202444e737c66c77faf9678cc87e)
+++ source/sys_main.c	(.../sys_main.c)	(revision add7eb956a7d2c124434541e1f06ca5ae158716f)
@@ -56,6 +56,7 @@
 #include "rti.h"
 
 #include "Common.h"
+#include "Timers.h"
 #include "OperationModes.h"
 #include "CPLD.h"
 #include "SafetyShutdown.h"
@@ -81,12 +82,12 @@
 {
 /* USER CODE BEGIN (3) */
 
-   initHardware();
-   initSoftware();
-   initTasks();
+    initHardware();
+    initSoftware();
+    initTasks();
 
-   // start task background (will no return)
-   taskBackground();
+    // start task background (will no return)
+    taskBackground();
 
 /* USER CODE END */
 
@@ -98,23 +99,24 @@
 
 static void initSoftware( void )
 {
-   initSafetyShutdown();
-   initCPLD();
-   initOperationModes();
+    initTimers();
+    initSafetyShutdown();
+    initCPLD();
+    initOperationModes();
 }
 
 static void initHardware( void )
 {
-   gioInit();
-   linInit(); // re-purposing LIN Rx & Tx pins as GPIO
+    gioInit();
+    linInit();  // re-purposing LIN Rx & Tx pins as GPIO
 }
 
 static void initTasks( void )
 {
-   _enable_IRQ();
-   rtiInit();
-   rtiEnableNotification( rtiNOTIFICATION_COMPARE0 | rtiNOTIFICATION_COMPARE1 | rtiNOTIFICATION_COMPARE3 );
-   rtiStartCounter( rtiCOUNTER_BLOCK0 );
+    _enable_IRQ();
+    rtiInit();
+    rtiEnableNotification( rtiNOTIFICATION_COMPARE0 | rtiNOTIFICATION_COMPARE1 | rtiNOTIFICATION_COMPARE3 );
+    rtiStartCounter( rtiCOUNTER_BLOCK0 );
 }
 
 /* USER CODE END */