Buat agip

Dependencies:   Motor_1 encoderKRAI mbed millis

Fork of Robo_Taker_Nasional_2018 by KRAI 2018

Revision:
4:3c890389e256
Parent:
3:b1403fcdaeb1
--- a/main.cpp	Thu Mar 01 11:02:03 2018 +0000
+++ b/main.cpp	Sat Mar 03 06:28:39 2018 +0000
@@ -225,44 +225,51 @@
     }
     
     // Linier
-    Vr = 0.5;
     if ((stick.atas)&&(!stick.bawah)&&(!stick.kanan)&&(!stick.kiri)){
         a = -90/RAD_TO_DEG; // Maju
+        Vr = 0.8;
     //    x_s = 0;// Maju
     //    y_s = 10000;
     }
     else if ((!stick.atas)&&(stick.bawah)&&(!stick.kanan)&&(!stick.kiri)){
         a = 90/RAD_TO_DEG; // Mundur
+        Vr = 0.8;
     //    x_s = 0; // Mundur
     //    y_s = -10000;
     }
     else if ((stick.atas)&&(!stick.bawah)&&(!stick.kiri)&&(stick.kanan)){
         a = -135/RAD_TO_DEG; // Serong Atas Kanan
+        Vr = 0.7;
     //    x_s = 50000; // Maju+Kanan
     //    y_s = 50000;
     }
     else if ((!stick.atas)&&(stick.bawah)&&(!stick.kiri)&&(stick.kanan)){
         a = 135/RAD_TO_DEG; // Serong Bawah Kanan
+        Vr = 0.7;
     //    x_s = 50000; // Mundur+Kanan
     //    y_s = -50000;
     }
     else if ((stick.atas)&&(!stick.bawah)&&(stick.kiri)&&(!stick.kanan)){
         a = -45/RAD_TO_DEG; // Serong Atas Kiri
+        Vr = 0.7;
     //    x_s = 50000; // Maju+Kiri
     //    y_s = -50000;
     }
     else if ((!stick.atas)&&(stick.bawah)&&(stick.kiri)&&(!stick.kanan)){
         a = 45/RAD_TO_DEG; // Serong Bawah Kiri
+        Vr = 0.7;
     //    x_s = -50000; // Mundur+Kiri
     //    y_s = -50000;
     }
     else if ((!stick.atas)&&(!stick.bawah)&&(stick.kanan)&&(!stick.kiri)){
         a = 180/RAD_TO_DEG; // Kanan
+        Vr = 0.5;
     //    x_s = 50000; // Kanan
     //    y_s = 0;
     }
     else if ((!stick.atas)&&(!stick.bawah)&&(!stick.kanan)&&(stick.kiri)){
         a = 0/RAD_TO_DEG; // Kiri
+        Vr = 0.5;
     //    x_s = -50000; // Kiri
     //    y_s = 0;
     }