Diff: NetCentricApp.cpp

Revision:

3:0229ad4f2db1

Parent:

1:3cde55629b1d

Child:

4:eabd917e3353

--- a/NetCentricApp.cpp	Wed Jan 06 13:33:14 2016 +0000
+++ b/NetCentricApp.cpp	Thu Jan 07 09:08:48 2016 +0000
@@ -4,6 +4,34 @@
 #include "MotorController.h"
 #include "PcControls.h"
 
+// in the getto
+
+DigitalOut myled1(LED1);
+DigitalOut myled2(LED2);
+DigitalOut myled3(LED3);
+DigitalOut myled4(LED4);
+
+int* intToFourBits (int number) {
+    int bits [4] = {};
+    
+    for (int i = 0; i < 4; i++) {
+        bits[i] = number & (1 << i) ? 1 : 0;
+    }
+    
+    return bits;
+}
+
+void setLeds (int number) {
+    DigitalOut leds [] = {myled1, myled2, myled3, myled4};
+    
+    int* bits = intToFourBits(number);
+    
+    for (int i = 0; i < 4; i++) {
+        leds[i] = bits[i];
+    }
+}
+// end in the getto
+
 // Process commands here.
 MbedResponse *NetCentricApp::getResponse(MbedRequest *request) {
     if (request->commandId == COMMAND_SUM) {
@@ -92,20 +120,11 @@
 
 // Move the motor
 MbedResponse *NetCentricApp::motorCommand(MbedRequest *request) {
-    // HBridge, AnalogIn
-    AnalogIn motorInput(p16);
-    DigitalOut outSignal(p18);
-
-    HBridge motor(p18,p15,p22);
-
-    // MotorController, PcControls
-    MotorController motorController(motor, motorInput);
-    MotorControlsPc pcControls(motorController);
+    setLeds((int) request->args[0]);
+    char c = (char) request->args[0];
+    this->motorControlsPc.ProcessPcInput(c);
     
-    // process the input 
-    char c = (char) request->args[0];
-    pcControls.ProcessPcInput(c);
-
+    
     // generate response
     MbedResponse *r = new MbedResponse();
     r->requestId = request->id;