Diff: main.cpp

Revision:

7:66c6e14a1d97

Parent:

6:0b79b90b83a2

--- a/main.cpp	Wed Jun 16 10:10:57 2021 +0000
+++ b/main.cpp	Wed Jun 16 10:36:50 2021 +0000
@@ -88,7 +88,7 @@
     }*/
     if( cam_msg.data > 0 && auto_shooting)
     {
-        int outValue[3] = [cam_msg.data/100, cam_msg.data/10%10, cam_msg.data%10];
+        int outValue[3] = {cam_msg.data/100, cam_msg.data/10%10, cam_msg.data%10};
         if(auto_shooting)
         {
             memset(msg2, 0, sizeof(msg2));
@@ -99,10 +99,17 @@
     //        sprintf("Cam distance: %d, %.4f", data, aout.read());
             responser2.publish(&str_msg2);
             for(int i = 0; i<3; i++){
-                outValue[i]/8;
-                (outValue[i]/4)%2;
-                (outValue[i]/2
-                (outValue[i]%2;
+                int val[4] = {outValue[i]/8, outValue[i]/4%2, outValue[i]/2%2, outValue[i]%2};
+                aout = val[0];
+                pin3 = val[1];
+                pin2= val[2];
+                pin1 = val[3];
+                wait(0.1);
+                aout = 1;
+                pin3 = 1;
+                pin2 = 1;
+                pin1 = 1;
+                wait(0.1);
             }
         }
     }