123123123123123123123123123

Dependencies:   mbed

Revision:
3:4306d042af6f
Parent:
2:442902ec3aa1
--- a/main.cpp	Thu Jul 03 10:59:37 2014 +0000
+++ b/main.cpp	Thu Jul 03 14:52:44 2014 +0000
@@ -40,34 +40,42 @@
         buzzer.time_out_init();
         if(com.getInfoOK(0) == 1) //car
         {
+            printf("main(). Car action starting...\r\n");
             com.forwardMessage();
             com.ACK(&lifter, &camera_platform);
             com.resetInfoOK(0);
             com.resetInfoOK(1);
+            printf("main(). Car action ended...\r\n");
         }
         else if(com.getInfoOK(0) == 2) //lifter
         {
+            printf("main(). Lifter action starting...\r\n");
             lifter.lifterMove(com.getMoveDis(), com.getMoveDir(), com.getRotateDis(), com.getRotateDir());
             com.ACK(&lifter, &camera_platform);
             com.resetInfoOK(0);
             com.resetInfoOK(1);
+            printf("main(). Lifter action ended...\r\n");
         }
         else if(com.getInfoOK(0) == 3) //camera_platform
         {
+            printf("main(). camera_platform action starting...\r\n");
             camera_platform.cameraPlatformMove(com.getMoveDis(), com.getMoveDir(), com.getRotateDis(), com.getRotateDir());
             com.ACK(&lifter, &camera_platform);
             com.resetInfoOK(0);
             com.resetInfoOK(1);
+            printf("main(). Camera_platform action ended...\r\n");
         }
         else if(com.getInfoOK(0) == 4) //compass
         {
+            printf("main(). Compass action starting...\r\n");
             com.ACK(&lifter, &camera_platform);
             com.resetInfoOK(0);
             com.resetInfoOK(1);
+            printf("main(). Compass action ended...\r\n");
         }
-        
-         else if(com.getInfoOK(0) == 5) //compass
+        else if(com.getInfoOK(0) == 5) //buzzer
         {
+            printf("main(). Buzzer action starting...\r\n");
             buzzer.ON();
             wait(0.1);
             buzzer.OFF();
@@ -78,6 +86,7 @@
             com.ACK(&lifter, &camera_platform);
             com.resetInfoOK(0);
             com.resetInfoOK(1);
+            printf("main(). Buzzer action ended...\r\n");
         }
         
         buzzer.cleanFlag();