Diff: PC_Comms/PC_Comms.cpp

Revision:

20:d93f0af76c7a

Parent:

19:bf64727d5b0e

Child:

21:ab49231d1479

diff -r bf64727d5b0e -r d93f0af76c7a PC_Comms/PC_Comms.cpp
--- a/PC_Comms/PC_Comms.cpp	Thu Feb 11 16:37:02 2016 +0000
+++ b/PC_Comms/PC_Comms.cpp	Mon Feb 15 15:22:58 2016 +0000
@@ -124,23 +124,24 @@
 
 void PC_Comms::PC_WritePosition(char _servo){
     
-//    char _returnToPC[4];
-//    int pos_data;
+    char _returnToPC[4];
+    int pos_data;
+
+       pos_data = my_AX12.GetPosition();
+    _returnToPC[0] = 'S';
+    _returnToPC[1] = 'D';
+    _returnToPC[2] = '1';
+    _returnToPC[3] = _servo;
+    
+     if(pos_data >= 1000){
+    _PCbus.printf("%s%i",_returnToPC, pos_data);
+    }else if(pos_data < 1000 && pos_data >= 100){
+        _PCbus.printf("%s0%i\n", _returnToPC, pos_data);
+    }else if(pos_data < 100 && pos_data >= 10){
+        _PCbus.printf("%s00%i\n", _returnToPC, pos_data);
+    }else{
+        _PCbus.printf("%s000%i\n", _returnToPC, pos_data);
+    }
+}
 //
-//       pos_data = my_AX12.GetPosition();
-//    _returnToPC[0] = 'S';
-//    _returnToPC[1] = 'D';
-//    _returnToPC[2] = '1';
-//    _returnToPC[3] = _servo;
-//    
-//     if(pos_data >= 1000){
-//    _PCbus.printf("%s%i",_returnToPC, pos_data);
-//    lcd->printf("%i",pos_data);
-//    }else if(pos_data < 1000 && pos_data >= 100){
-//        _PCbus.printf("%s0%i\n", _returnToPC, pos_data);
-//    }else if(pos_data < 100 && pos_data >= 10){
-//        _PCbus.printf("%s00%i\n", _returnToPC, pos_data);
-//    }else{
-//        _PCbus.printf("%s000%i\n", _returnToPC, pos_data);
-//    }
-}
\ No newline at end of file
+//void PC_Comms::PC_Human
\ No newline at end of file