Diff: main.cpp

Branch:

?????

Revision:

51:8a579a19a4ff

Parent:

50:b582ed334d3a

Child:

52:a9d23be503c6

--- a/main.cpp	Sun Jun 04 16:25:43 2017 +0000
+++ b/main.cpp	Wed Jun 07 14:14:09 2017 +0000
@@ -81,16 +81,24 @@
 
 void InputControlValues()
 {
+    char floatValues[sizeof(float)];
     double pitch =GetAve( pitchPin.read());
     double roll = GetAve(rollPin.read());
     double normedPitch = pitchIC.Processing(pitch);
     double normedRoll = rollIC.Processing(rollPin.read());
-    // pc.printf("pitch:%4.3f  roll:%4.3f\n\r",normedPitch,normedRoll);
-    SyntheRollAndPitch(normedPitch,normedRoll,(float*)inputDatas_R,(float *)inputDatas_L);
-    pc.printf("R:%8.8f  L:%8.8f\n\r",*(float*)inputDatas_R,*(float *)inputDatas_L);
-    // pc.printf("R:%d     L:%d    show Both Right %d %d\n\r",*(int *)inputDatas_R,*(int *)inputDatas_L,drug_R.read(), drug_L.read());
-    inputDatas_R[sizeof(float)+ 2] = (char)drug_R;
-    inputDatas_L[sizeof(float)+2] = (char)drug_L;
+    float inputR = 0.0;
+    float inputL = 0.0;
+
+    SyntheRollAndPitch(normedPitch,normedRoll,&inputR,&inputL);
+    sprintf(inputDatas_R,"%5.2f%d",inputR,(int)drug_R);
+    sprintf(inputDatas_L,"%5.2f%d",inputL,(int)drug_L);
+
+    //inputDatas_R[sizeof(float)] = (char)drug_R;
+    //inputDatas_L[sizeof(float)] = (char)drug_L;
+    for(int i = 0; i< 7; i++)
+        pc.printf("%c",inputDatas_R[i]);
+ pc.printf("\n\r");
+
     led4 =! led4;
 }