Index: firmware/App/Modes/ModeService.c
===================================================================
diff -u -r025612ad77fe630889a364586de54bffe5262d56 -rca42d4bb2bde856750630050d393d6ae26a4e957
--- firmware/App/Modes/ModeService.c	(.../ModeService.c)	(revision 025612ad77fe630889a364586de54bffe5262d56)
+++ firmware/App/Modes/ModeService.c	(.../ModeService.c)	(revision ca42d4bb2bde856750630050d393d6ae26a4e957)
@@ -52,7 +52,12 @@
  *************************************************************************/
 U32 transitionToServiceMode( void )
 {
-    return 0;
+    deenergizeActuators();
+
+    initServiceMode();
+
+    return serviceState;
+
 }
 
 /*********************************************************************//**
@@ -71,7 +76,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;
     }