BLUETOOTH CONTROLLED CAR CODE

#include <AFMotor.h>
AF_DCMotor motor1(1); 
AF_DCMotor motor2(2); 
AF_DCMotor motor3(3);
AF_DCMotor motor4(4);
char command;
int emp = 13; 

void setup() 
{       
  Serial.begin(9600);
  pinMode(emp,OUTPUT);
}



void forward()
{
  motor1.setSpeed(255);
  motor1.run(FORWARD); 
  motor2.setSpeed(240);
  motor2.run(FORWARD);
  motor3.setSpeed(255);
  motor3.run(FORWARD);
  motor4.setSpeed(240);
  motor4.run(FORWARD);
}

void back()
{
  motor1.setSpeed(170); 
  motor1.run(BACKWARD);
  motor2.setSpeed(170); 
  motor2.run(BACKWARD);
  motor3.setSpeed(170);
  motor3.run(BACKWARD);
  motor4.setSpeed(170);
  motor4.run(BACKWARD);
}

void left()
{
  motor1.setSpeed(240);
  motor1.run(FORWARD); 
  motor2.setSpeed(255);
  motor2.run(FORWARD);
  motor3.setSpeed(240);
  motor3.run(BACKWARD);
  motor4.setSpeed(240);
  motor4.run(BACKWARD); 
}

void right()
{
  motor1.setSpeed(240);
  motor1.run(BACKWARD); 
  motor2.setSpeed(240);
  motor2.run(BACKWARD);
  motor3.setSpeed(255);
  motor3.run(FORWARD);
  motor4.setSpeed(255);
  motor4.run(FORWARD); 
  
}

void deviceon()
  {
    digitalWrite(emp,HIGH);
  }
void deviceoff()
  {
    digitalWrite(emp, LOW);
  }
  

void Stop()
{
  motor1.setSpeed(0);
  motor2.run(RELEASE);
  motor2.setSpeed(0);
  motor2.run(RELEASE);
  motor3.setSpeed(0);
  motor3.run(RELEASE);
  motor4.setSpeed(0);
  motor4.run(RELEASE);
}



void loop(){
  if(Serial.available() > 0){ 
    command = Serial.read(); 
    Stop();
    switch(command){
    case 'F':  
      forward();
      break;
    case 'B':  
       back();
      break;
    case 'L':  
      left();
      break;
    case 'R':
      right();
      break;
    case 'X':
      deviceon();
      break;  
    case 'x':
      deviceoff();
      break;  
    }
  } 
}

Comments

Popular posts from this blog

EMP JAMMER

BLUETOOTH CONTROLLED ROBOT