Use the new fetch functions in the test service

inc/Services/TestService.hpp

@@ -15,14 +15,14 @@ public:
 	/**
 	 * TC[17,1] perform an are-you-alive connection test
 	 */
-	void areYouAlive(const Message & request);
+	void areYouAlive(Message & request);
 
 	/**
 	 * TC[17,3] perform an on-board connection test
 	 *
 	 * @todo Only respond if we have the correct APID
 	 */
-	void onBoardConnection(const Message & request);
+	void onBoardConnection(Message & request);
 };
 
 

src/Services/TestService.cpp

 #include "Services/TestService.hpp"
 
-void TestService::areYouAlive(const Message &request) {
+void TestService::areYouAlive(Message &request) {
 	// TM[17,2] are-you-alive connection test report
 	Message report = createTM(2);
 
 	storeMessage(report);
 }
 
-void TestService::onBoardConnection(const Message &request) {
+void TestService::onBoardConnection(Message &request) {
 	// TM[17,4] on-board connection test report
 	Message report = createTM(4);
 
-	// TODO: This is not the correct way to do this! Fetching functions will be added later
-	report.appendUint8(request.data[1]);
+	report.appendUint16(request.readUint16());
 
 	storeMessage(report);
 }