Diff: NetCentricApp.cpp

Revision:

4:eabd917e3353

Parent:

3:0229ad4f2db1

Child:

6:b5072fb695f2

--- a/NetCentricApp.cpp	Thu Jan 07 09:08:48 2016 +0000
+++ b/NetCentricApp.cpp	Thu Jan 07 16:20:07 2016 +0000
@@ -123,14 +123,22 @@
     setLeds((int) request->args[0]);
     char c = (char) request->args[0];
     this->motorControlsPc.ProcessPcInput(c);
-    
-    
+
     // generate response
     MbedResponse *r = new MbedResponse();
     r->requestId = request->id;
     r->commandId = request->commandId;
     r->error = NO_ERROR;
-    r->n = 5;
+    
+    if (c == MotorControlsPc::MOTOR_POSITION) {
+        r->n = 2;
+        r->values = new float[r->n];
+        r->values[1] = this->motorControlsPc.getMotorController().getPosition();
+    } else {
+        r->n = 1;
+        r->values = new float[r->n];
+    }
+    r->values[0] = request->args[0];
     
     return r;
 }