Wheel Encoders

 Wheels Encoders Code


#define rightMotorFor 5

#define rightMotorRev 4

#define leftMotorFor 6

#define leftMotorRev 7

#define encoderPin 2

volatile long encoderValue = 0;




void setup()

{

  Serial.begin(9600);

  pinMode (rightMotorFor, OUTPUT);

  pinMode (rightMotorRev, OUTPUT);

  pinMode (leftMotorFor, OUTPUT);

  pinMode (leftMotorRev, OUTPUT);

  pinMode (encoderPin, INPUT_PULLUP);

  attachInterrupt(digitalPinToInterrupt(encoderPin), AdvanceEncoderValue, RISING);

}


void loop()

{

  //make sure car is pointing forward

  //right hand side of figure 8

  for(int i =0; i< 4; i++){

  rightTurn();

  goForward();

  }

  

  //left hand side of the figure 8

  for(int i =0; i< 4; i++){

  leftTurn();

  goForward();

  }

  

  //all done with the code

  allStop();

  

  

  

}


void goForward()

{

  encoderValue = 0;

  digitalWrite(rightMotorRev, LOW);

  digitalWrite(leftMotorRev, LOW);

  digitalWrite(rightMotorFor, HIGH);

  digitalWrite(leftMotorFor, HIGH);

  Serial.println("starting forward");

  while(encoderValue<8560){

  }

  Serial.println(encoderValue);

  Serial.println("Finished 30.48 cm");

}

void rightTurn(){

  

  encoderValue = 0;

  digitalWrite(rightMotorFor, LOW);

  digitalWrite(leftMotorRev, LOW);

  digitalWrite(leftMotorFor, HIGH);

  digitalWrite(rightMotorRev, HIGH);

  Serial.println("starting rightTurn");

  while(encoderValue<3310){

  }

   Serial.println(encoderValue);

  Serial.println("Finished righTurn");

}

void leftTurn(){

  

  encoderValue = 0;

  digitalWrite(leftMotorFor, LOW);

  digitalWrite(rightMotorRev, LOW);

  digitalWrite(leftMotorRev, HIGH);

  digitalWrite(rightMotorFor, HIGH);

  Serial.println("starting lefTurn");

  while(encoderValue<3310){

  }

  Serial.println(encoderValue);

  Serial.println("Finished leftTurn");

  

}

void allStop(){

  

  encoderValue = 10;

  digitalWrite(leftMotorFor, LOW);

  digitalWrite(rightMotorRev, LOW);

  digitalWrite(leftMotorRev, LOW);

  digitalWrite(rightMotorFor, LOW);

  Serial.println("all stop");

  while(encoderValue>1){

  }

  

}

        

void AdvanceEncoderValue(){

  encoderValue++;

}    

        

        

        

Comments

Post a Comment

Popular posts from this blog

Ultra Sonic Sensor

 Ultra Sonic Sensor Code int trigPin = 12; /* Trig pin of the sensor is connected to the 6th pin of Arduino */ int echoPin = 11;  /* The echo pin of the sensor is connected to the 7th Pin of the Arduino */ long Duration; //Duration   long Distance; //Distance   int leftMotor_1=3;  //motor 1 the first data entry is HIGH OR LOW int leftMotor_2=2;  //motor 1 the second data entry is HIGH OR LOW int rightMotor_1=4; //motor 2 the first data entry is HIGH OR LOW int rightMotor_2=5; //motor 2 the second data entry is HIGH OR LOW int leftMotor_pwm=6;  // motor 1 Speed ​​control is done with pwm input for                       // 0-255 analog PWM signal is sent in range int rightMotor_pwm=9; // motor 2 Speed ​​control is done with pwm input for                        // 0-255 analog PWM signal is sent in range void setup() {   for(in...
Read more

Arduino Motor Control Car

 Arduino Motor Control Car Using L293H Bridge //This will run only one time. void steup () {     pinMode (3, OUTPUT);      pinMode (4, OUTPUT);      pinMode (5, OUTPUT);      Serial.begin (9600) } void loop() {     int reading = analogRead(A0);     Serial.println (reading);     int output = reading/100;     digitalWrite (3, HIGH);     digitalWrite (4, LOW);     digitalWrite (5, output);     delay (2000); }
Read more

Simple Simon

 Arduino Code for Simple Simon Game int LEDPins [4] = {2,3,4,5}; int buttonPins [4] = {6,7,8,9}; int LEDSequence [32]; void setup () {   Serial.begin(9600);   for(int i =0; i<4; i++){   pinMode(LEDPins[i], OUTPUT);   pinMode(buttonPins[i], INPUT);   } // setting the randomizer for game randomSeed(analogRead(A0)); } void loop () {   bool lose = false;      //line bellow will be the random sequence for the lights   for (int i =0; i<32; i++)   {     LEDSequence[i] = random(4);     Serial.println(LEDSequence[i]);     delay(250);   }       //begining of the Simon game   //doing a loop for the level   for (int level =0; level <32; level++){            //show loop here      for (int i =0; i < level; i++){         digitalWrite(LEDPins[LEDSequence[i]], HIGH);   ...
Read more