gaku takasawa / Mbed 2 deprecated 2017_Robocon_mother

Dependencies:   mbed omuni solenoid

Files at this revision

API Documentation at this revision

Comitter:
gaku_sigu
Date:
Wed Oct 11 04:33:26 2017 +0000
Parent:
4:14d5b744505c
Child:
6:f5f0b60cd380
Commit message:
2017/10/11;

Changed in this revision

main.cpp Show annotated file Show diff for this revision Revisions of this file
--- a/main.cpp	Tue Oct 10 12:51:10 2017 +0000
+++ b/main.cpp	Wed Oct 11 04:33:26 2017 +0000
@@ -1,9 +1,9 @@
-
 #include "mbed.h"
 #include "omuni.h"
-#include "mbed.h"
 #include "solenoid.h"
 
+//#define DEBUG
+
 I2C i2c(p28, p27);
 omuni omu(&i2c, 0x10, 0x14, 0x16);
 solenoid sol(&i2c, 0x20);
@@ -12,7 +12,7 @@
 Serial master(p13,p14);
 Serial pc(USBTX, USBRX);
 
-int ConData[2][12];
+char ConData[2][12];
 
 
 void GetData()
@@ -50,7 +50,11 @@
             
             char MotorData[] = {'H', ConData[0][1]-1, ConData[0][2]-6, ConData[1][1]+1, ConData[1][2]-8};
             omu.out(MotorData);
-            
+
+            char soldata = ((ConData[0][3] << 2) + ConData[1][3]) << 4;
+            sol = soldata;
+
+            #ifdef DEBUG 
             for(int i = 0; i < 12; i++)
             {
                     pc.printf("%3d ",ConData[0][i]);
@@ -61,8 +65,8 @@
             }
             pc.printf("\n\r");
             
-            char soldata = ((ConData[0][3] << 2) + ConData[1][3]) << 4;
-            //printf("%d\n",soldata);
-            sol = soldata;
+            printf("%d\n",soldata);
+            #endif
+
         }  
 }