talofer99 icon

shaked

talofer99 | PRO | 06/18/18 05:41:00 PM UTC | 0 ⭐ | 647 👁️ | Never ⏰ | []
C |

3.84 KB

|

None

|

0 👍

/

0 👎

#include<SoftwareSerial.h>
SoftwareSerial mySerial(10, 11);
char data = 0;
 
#define IN1 2
#define IN2 4
#define IN3 6
#define IN4 7
#define EN1 5
#define EN2 3
 
 
// constants won't change. Used here to set a pin number:
const int ledPin =  LED_BUILTIN;// the number of the LED pin
 
// Variables will change:
int ledState = LOW;             // ledState used to set the LED
 
// Generally, you should use "unsigned long" for variables that hold time
// The value will quickly become too large for an int to store
unsigned long previousMillis = 0;        // will store last time LED was updated
 
// constants won't change:
const long interval = 1000;           // interval at which to blink (milliseconds)
 
 
void setup() {
  // put your setup code here, to run once:
  Serial.begin(9600);
  mySerial.begin(9600);
 
  pinMode(IN1, OUTPUT);
  pinMode(IN2, OUTPUT);
  pinMode(IN3, OUTPUT);
  pinMode(IN4, OUTPUT);
  pinMode(EN1, OUTPUT);
  pinMode(EN2, OUTPUT);
 
  // set the digital pin as output:
  pinMode(ledPin, OUTPUT);
 
 
}
 
void loop()
{
  unsigned long currentMillis = millis();
 
  if (currentMillis - previousMillis >= interval) {
    // save the last time you blinked the LED
    previousMillis = currentMillis;
 
    // if the LED is off turn it on and vice-versa:
    if (ledState == LOW) {
      ledState = HIGH;
    } else {
      ledState = LOW;
    }
 
    // set the LED with the ledState of the variable:
    digitalWrite(ledPin, ledState);
  }
  if (mySerial.available() )
  {
    data = mySerial.read();
    Serial.println(data);
    if (data == 'F')
    {
      Forward();
      
    }
    else if (data == 'B')
    {
      Back();
    }
    else if (data == 'L')
    {
      Left();
    }
    else if (data == 'R')
    {
      Right();
    }
    else if (data == 'G')
    {
      ForwardLeft();
    }
    else if (data == 'I')
    {
      ForwardRight();
    }
    else if (data == 'H')
    {
      BackLeft();
    }
    else if (data == 'J')
    {
      BackRight();
    }
    else {
      Stop();
    }
 
  }
 
}
 
void Forward() {
  digitalWrite(IN1, HIGH);
  digitalWrite(IN2, LOW);
  digitalWrite(IN3, HIGH);
  digitalWrite(IN4, LOW);
  digitalWrite(EN1, HIGH);
  digitalWrite(EN2, HIGH);
 
 
}
 
void Back() {
  digitalWrite(IN1, LOW);
  digitalWrite(IN2, HIGH);
  digitalWrite(IN3, LOW);
  digitalWrite(IN4, HIGH);
  digitalWrite(EN1, HIGH);
  digitalWrite(EN2, HIGH);
}
 
void Left() {
  digitalWrite(IN1, HIGH);
  digitalWrite(IN2, LOW);
  digitalWrite(IN3, LOW);
  digitalWrite(IN4, HIGH);
  digitalWrite(EN1, HIGH);
  digitalWrite(EN2, HIGH);
}
 
void Right() {
  digitalWrite(IN1, LOW);
  digitalWrite(IN2, HIGH);
  digitalWrite(IN3, HIGH);
  digitalWrite(IN4, LOW);
  digitalWrite(EN1, HIGH);
  digitalWrite(EN2, HIGH);
 
}
void Stop() {
  digitalWrite(IN1, LOW);
  digitalWrite(IN2, LOW);
  digitalWrite(IN3, LOW);
  digitalWrite(IN4, LOW);
  digitalWrite(EN1, LOW);
  digitalWrite(EN2, LOW);
}
 
void ForwardLeft() {
  analogWrite(EN1, 255); //speed 0 - 255
  analogWrite(EN2, 50); //speed 0 - 255
  digitalWrite(IN1, HIGH);
  digitalWrite(IN2, LOW);
  digitalWrite(IN3, HIGH);
  digitalWrite(IN4, LOW);
}
void ForwardRight() {
  analogWrite(EN1, 50); //speed 0 - 255
  analogWrite(EN2, 255); //speed 0 - 255
  digitalWrite(IN1, HIGH);
  digitalWrite(IN2, LOW);
  digitalWrite(IN3, HIGH);
  digitalWrite(IN4, LOW);
}
void BackLeft() {
  analogWrite(EN1, 50); //speed 0 - 255
  analogWrite(EN2, 255); //speed 0 - 255
  digitalWrite(IN1, LOW);
  digitalWrite(IN2, HIGH);
  digitalWrite(IN3, LOW);
  digitalWrite(IN4, HIGH);
}
void BackRight() {
  analogWrite(EN1, 255); //speed 0 - 255
  analogWrite(EN2, 50); //speed 0 - 255
  digitalWrite(IN1, LOW);
  digitalWrite(IN2, HIGH);
  digitalWrite(IN3, LOW);
  digitalWrite(IN4, HIGH);
}

Comments