Diff: main.cpp

Revision:

19:bb304933a9f8

Parent:

18:23412e950394

--- a/main.cpp	Wed Jan 18 10:28:01 2017 +0000
+++ b/main.cpp	Wed Jan 18 14:08:37 2017 +0000
@@ -42,7 +42,7 @@
 float speed2=0.6;
 float speed3=0.6;
 float speed4=0.6;
-float speedB=0.43 ;
+float speedB=0.23 ;
 float speedL=0.4;
 
 
@@ -65,7 +65,7 @@
 
 // Inisialisasi  Pin TX-RX Joystik dan PC
 joysticknucleo joystick(PA_0,PA_1);
-Serial pc(USBTX,USBRX);
+Serial pc(PA_2,PA_3);
 
 //encoder variable
 float errX, errY, errT, Vt, Vx, Vy;
@@ -647,7 +647,7 @@
 {
     // Set baud rate - 115200
     joystick.setup();
-    pc.baud(115200);
+    pc.baud(57600);
     wait_ms(500);
     
     pc.printf("Ready...\n");
@@ -677,6 +677,9 @@
             if (joystick.lingkaran_click){
                 ServoGo = true;
                 }  
+            if (joystick.silang) {
+                pc.printf("Depan  = %.3f \t Belakang = %.3f \n",speedB,speedL);
+                }
             speedLauncher();
          
         } else {