Index: firmware/App/Modes/ModeService.c
===================================================================
diff -u -ra89d6b091874136d75a9bfbdbbc1ff00f42467b3 -r497aa8998a8d3c84e735747e2d10596abdf36cf7
--- firmware/App/Modes/ModeService.c	(.../ModeService.c)	(revision a89d6b091874136d75a9bfbdbbc1ff00f42467b3)
+++ firmware/App/Modes/ModeService.c	(.../ModeService.c)	(revision 497aa8998a8d3c84e735747e2d10596abdf36cf7)
@@ -52,8 +52,11 @@
  *************************************************************************/
 U32 transitionToServiceMode( void )
 {
-    // TODO Deenergize all the actuators
-    return 0;
+    deenergizeActuators();
+
+    initServiceMode();
+
+    return serviceState;
 }
 
 /*********************************************************************//**
@@ -72,7 +75,7 @@
             break;
 
         default:
-            // TODO - s/w fault
+            SET_ALARM_WITH_2_U32_DATA( ALARM_ID_DG_SOFTWARE_FAULT, SW_FAULT_ID_SERVICE_MODE_INVALID_EXEC_STATE, serviceState )
             serviceState = DG_SERVICE_STATE_START;
             break;
     }