safwan092

Car Robot Bluetooth Control Android

Mar 10th, 2020
113
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
  1. int IN1 = 6;
  2. int IN2 = 5;
  3. int IN3 = 4;
  4. int IN4 = 3;
  5. int ENA = 7;
  6. int ENB = 2;
  7.  
  8. String str;
  9. int blueToothVal;
  10.  
  11.  
  12. void setup()
  13. {
  14.   Serial.begin(9600);
  15.   pinMode(IN1, OUTPUT);
  16.   pinMode(IN2, OUTPUT);
  17.   pinMode(IN3, OUTPUT);
  18.   pinMode(IN4, OUTPUT);
  19.   pinMode(ENA, OUTPUT);
  20.   pinMode(ENB, OUTPUT);
  21. }
  22. void loop()
  23. {
  24.   bluetooth();
  25. }
  26.  
  27.  
  28.  
  29.  
  30. void bluetooth()
  31. {
  32.   while (Serial.available())                             // Read bluetooth commands over Serial1 // Warning: If an error with Serial1 occurs, make sure Arduino Mega 2560 is Selected
  33.   {
  34.     {
  35.       str = Serial.readStringUntil('\n');               // str is the temporary variable for storing the last sring sent over bluetooth from Android device
  36.       //Serial.print(str);
  37.     }
  38.  
  39.     blueToothVal = (str.toInt());                        //  convert the string 'str' into an integer and assign it to blueToothVal
  40.  
  41.     switch (blueToothVal)
  42.     {
  43.       case 1:
  44.         FRONT();
  45.         delay(10);
  46.         break;
  47.  
  48.       case 2:
  49.         BACKWARDS();
  50.         delay(10);
  51.         break;
  52.  
  53.       case 3:
  54.         LEFTT();
  55.         delay(10);
  56.         //STOP();
  57.         break;
  58.  
  59.       case 4:
  60.         RIGHTT();
  61.         delay(10);
  62.         //STOP();
  63.         break;
  64.  
  65.       case 5:
  66.         STOP();
  67.         break;
  68.  
  69.     }                                                              // end of switch case
  70.  
  71.   }                                                              // end of while loop Serial1 read
  72.  
  73.  
  74. }
  75.  
  76. void STOP() {
  77.   digitalWrite(IN1, 0);
  78.   digitalWrite(IN2, 0);
  79.  
  80.   digitalWrite(IN3, 0);
  81.   digitalWrite(IN4, 0);
  82.  
  83.   digitalWrite(ENA, LOW);
  84.   digitalWrite(ENA, LOW);
  85. }
  86.  
  87. void FRONT() {
  88.   digitalWrite(IN1, 0);
  89.   digitalWrite(IN2, 1);
  90.  
  91.   digitalWrite(IN3, 1);
  92.   digitalWrite(IN4, 0);
  93.  
  94.   digitalWrite(ENA, HIGH);
  95.   digitalWrite(ENB, HIGH);
  96. }
  97.  
  98. void BACKWARDS() {
  99.   digitalWrite(IN1, 1);
  100.   digitalWrite(IN2, 0);
  101.  
  102.   digitalWrite(IN3, 0);
  103.   digitalWrite(IN4, 1);
  104.  
  105.   digitalWrite(ENA, HIGH);
  106.   digitalWrite(ENB, HIGH);
  107. }
  108.  
  109. void RIGHTT() {
  110.   digitalWrite(IN1, 0);
  111.   digitalWrite(IN2, 1);
  112.  
  113.   digitalWrite(IN3, 0);
  114.   digitalWrite(IN4, 1);
  115.  
  116.   digitalWrite(ENA, HIGH);
  117.   digitalWrite(ENB, HIGH);
  118.   //delay(100);
  119. }
  120.  
  121. void LEFTT() {
  122.   digitalWrite(IN1, 1);
  123.   digitalWrite(IN2, 0);
  124.  
  125.   digitalWrite(IN3, 1);
  126.   digitalWrite(IN4, 0);
  127.  
  128.   digitalWrite(ENA, HIGH);
  129.   digitalWrite(ENB, HIGH);
  130.   //delay(100);
  131. }
RAW Paste Data