Index: firmware/App/Services/SystemCommMessages.c
===================================================================
diff -u -rdd3356035996866e5db7678d352f933fc22ad789 -r611e805a6547ac922154e623a9d79adeae128e81
--- firmware/App/Services/SystemCommMessages.c	(.../SystemCommMessages.c)	(revision dd3356035996866e5db7678d352f933fc22ad789)
+++ firmware/App/Services/SystemCommMessages.c	(.../SystemCommMessages.c)	(revision 611e805a6547ac922154e623a9d79adeae128e81)
@@ -25,6 +25,8 @@
 #include "SystemComm.h"
 #include "RTC.h"
 #include "LoadCell.h"
+#include "TemperatureSensors.h"
+#include "Heaters.h"
 
 // ********** private definitions **********
 
@@ -57,6 +59,13 @@
     F32 loadCellB2inGram;
 } LOAD_CELL_DATA_T;
 
+typedef struct
+{
+    U32 mainPrimayHeaterDC;
+    U32 smallPrimaryHeaterDC;
+    U32 trimmerHeaterDC;
+} HEATERS_DATA_T;
+
 #pragma pack(pop)
 
 // ********** private data **********
@@ -352,8 +361,70 @@
     return result;
 }
 
+/*************************************************************************
+ * @brief
+ * The broadcastHeatersData function sends out DG heaters data
+ * @details
+ * Inputs : heaters data
+ * Outputs : heatears data msg constructed and queued
+ * @param mainPrimaryDC : main primary heater duty cycle
+ * @param smallPrimaryDC : small primary heater duty cycle
+ * @param trimmerDC : trimmer heater duty cycle
+ * @return TRUE if msg successfully queued for transmit, FALSE if not
+ *************************************************************************/
+BOOL broadcastHeatersData ( U32 mainPrimaryDC, U32 smallPrimaryDC, U32 trimmerDC )
+{
+    BOOL result;
+    MESSAGE_T msg;
+    U08 *payloadPtr = msg.payload;
+    HEATERS_DATA_T payload;
 
+    // create a message record
+    blankMessage( &msg );
+    msg.hdr.msgID = MSG_ID_DG_HEATERS_DATA;
+    msg.hdr.payloadLen = sizeof( HEATERS_DATA_T );
+
+    payload.mainPrimayHeaterDC = mainPrimaryDC;
+    payload.smallPrimaryHeaterDC = smallPrimaryDC;
+    payload.trimmerHeaterDC = trimmerDC;
+
+    memcpy( payloadPtr, &payload, sizeof( HEATERS_DATA_T ) );
+
+    // serialize the message (w/ sync, CRC, and appropriate CAN padding) and add serialized message data to appropriate comm buffer
+    result = serializeMessage( msg, COMM_BUFFER_OUT_CAN_DG_BROADCAST, ACK_NOT_REQUIRED );
+
+    return result;
+}
+
 /*************************************************************************
+ * @brief
+ * The broadcastTemperatureSensorsData function sends out DG temperature
+ * sensors data
+ * Inputs : heaters data
+ * Outputs : temperatur sensors data msg constructed and queued
+ * @param sensorsValue : sensors value array
+ * @return TRUE if msg successfully queued for transmit, FALSE if not
+ *************************************************************************/
+BOOL broadcastTemperatureSensorsData ( U08 *sensorsValue, U32 byteLength )
+{
+    BOOL result;
+    MESSAGE_T msg;
+    U08 *payloadPtr = msg.payload;
+
+    // create a message record
+    blankMessage( &msg );
+    msg.hdr.msgID = MSG_ID_DG_TEMPERATURE_DATA;
+    msg.hdr.payloadLen = byteLength;
+
+    memcpy( payloadPtr, sensorsValue, byteLength );
+
+    // serialize the message (w/ sync, CRC, and appropriate CAN padding) and add serialized message data to appropriate comm buffer
+    result = serializeMessage( msg, COMM_BUFFER_OUT_CAN_DG_BROADCAST, ACK_NOT_REQUIRED );
+
+    return result;
+}
+
+/*************************************************************************
  *                       TEST SUPPORT FUNCTIONS
  *************************************************************************/
 
@@ -513,6 +584,45 @@
 DATA_ARRAY_OVERRIDE_HANDLER_FUNC_U32( BOOL, handleTestLoadCellOverrideRequest, testSetLoadCellOverride, testResetLoadCellOverride )
 
 /*************************************************************************
+ * @brief
+ * The handleTestTemperatureSensorsOverrideRequest function handles a
+ * request to override a temperatures sensor's value
+ * @details
+ * Inputs : none
+ * Outputs : message handled
+ * @param message : a pointer to the message to handle
+ * @return none
+ *************************************************************************/
+DATA_ARRAY_OVERRIDE_HANDLER_FUNC_F32( BOOL, handleTestTemperatureSensorsOverrideRequest, \
+                                      testSetMeasuredTemperatureOverride, testResetMeasuredTemperatureOverride )
+
+/*************************************************************************
+* @brief
+* The handleTestTemperatureSensorsDataPublishOverrideRequest function handles \n
+* a request to override the publish interval of temperature sensors data
+* @details
+* Inputs : none
+* Outputs : message handled
+* @param message : a pointer to the message to handle
+* @return none
+*************************************************************************/
+DATA_OVERRIDE_HANDLER_FUNC_U32( BOOL, handleTestTemperatureSensorsDataPublishOverrideRequest, \
+                                testSetTemperatureSensorsPublishIntervalOverride, testResetTemperatureSensorsPublishIntervalOverride )
+
+/*************************************************************************
+ * @brief
+ * The handleTestHeatersDataPublishOverrideRequest function handles \n
+ * a request to override the publish interval of heaters data
+ * @details
+ * Inputs : none
+ * Outputs : message handled
+ * @param message : a pointer to the message to handle
+ * @return none
+ *************************************************************************/
+DATA_OVERRIDE_HANDLER_FUNC_U32( BOOL, handleTestHeatersDataPublishOverrideRequest, \
+                                testSetHeatersPublishIntervalOverride, testResetHeatersPublishIntervalOverride )
+
+/*************************************************************************
  * @brief handleSetRTCTimestamp
  * The handleSetRTCTimestamp function handles a request to write time and
  * date to RTC
@@ -533,11 +643,36 @@
     U32 years;
     memcpy(&years, &message->payload[5], sizeof(U32));
 
-    // TODO: Change setRTCTimestamp to return a boolean for this
-    result = TRUE;
+    result = setRTCTimestamp( seconds, minutes, hours, days, months, years );
 
-    setRTCTimestamp( seconds, minutes, hours, days, months, years );
-
     // respond to request
     sendTestAckResponseMsg( (MSG_ID_T)message->hdr.msgID, result );
 }
+
+/*************************************************************************
+ * @brief
+ * The handleStartStopPrimaryHeater function handles a request start or
+ * stop the primary heater
+ * @details
+ * Inputs : none
+ * Outputs : message handled
+ * @param message : a pointer to the message to handle
+ * @return result
+ *************************************************************************/
+BOOL handleStartStopPrimaryHeater( MESSAGE_T * message )
+{
+    BOOL result;
+    U32 heaterStatus = message->payload[0];
+
+    if ( heaterStatus == 1 )
+    {
+        result = startPrimaryHeater();
+    }
+    else
+    {
+        stopPrimaryHeater();
+        result = TRUE;
+    }
+
+    return result;
+}