Scribd Logo
Upload

Welcome to Scribd!

  • Doiufiegrtg

    Uploaded by

    Jsjs Ne
    4 views2 pages
    The document defines variables for motor pins, PWM pins, and speeds. It sets the pins as outputs in setup. In loop, it reads analog sensors, prints their values, and controls the motors differently depending on the sensor values - forward if both low, left if left low and right high, right if left high and right low, and stopped if both high.

    Original Description:

    Original Title

    doiufiegrtg

    Copyright

    © © All Rights Reserved

    Available Formats

    TXT, PDF, TXT or read online from Scribd

    Did you find this document useful?

    Is this content inappropriate?

    Report this Document
    The document defines variables for motor pins, PWM pins, and speeds. It sets the pins as outputs in setup. In loop, it reads analog sensors, prints their values, and controls the motors differently depending on the sensor values - forward if both low, left if left low and right high, right if left high and right low, and stopped if both high.

    Copyright:

    © All Rights Reserved
    Download as TXT, PDF, TXT or read online from Scribd
    Flag for inappropriate content
    Download as txt, pdf, or txt
    4 views2 pages

    Doiufiegrtg

    Uploaded by

    Jsjs Ne
    The document defines variables for motor pins, PWM pins, and speeds. It sets the pins as outputs in setup. In loop, it reads analog sensors, prints their values, and controls the motors differently depending on the sensor values - forward if both low, left if left low and right high, right if left high and right low, and stopped if both high.

    Copyright:

    © All Rights Reserved
    Download as TXT, PDF, TXT or read online from Scribd
    Flag for inappropriate content
    Download as txt, pdf, or txt
    of 2

    int MotorX1=7;

    int MotorX2=6;
    int MotorY1=9;
    int MotorY2=8;

    int PWMmotor1=5;
    int PWMmotor2=10;

    int velocidad1=120;
    int velocidad2=150;

    void setup()
    {
    Serial.begin(9600);
    pinMode(MotorX1, OUTPUT);
    pinMode(MotorX2, OUTPUT);
    pinMode(MotorY1, OUTPUT);
    pinMode(MotorY2, OUTPUT);
    pinMode(PWMmotor1,OUTPUT);
    pinMode(PWMmotor2,OUTPUT);

    pinMode(A0,INPUT);
    pinMode(A1,INPUT);

    void loop() {

    int sen_Izq=analogRead(A0);
    int sen_Der=analogRead(A1);
    Serial.print("sendor inquierdo= ");
    Serial.println(sen_Izq);
    Serial.print("sendor Derecho= ");
    Serial.println(sen_Der);

    if(sen_Der<36&&sen_Izq<36) // Adelante
    { digitalWrite(MotorX1,HIGH);
    digitalWrite(MotorX2,LOW);
    digitalWrite(MotorY1,HIGH);
    digitalWrite(MotorY2,LOW);
    digitalWrite(PWMmotor1,velocidad1);
    digitalWrite(PWMmotor2,velocidad1);
    }
    else if(sen_Der>36&&sen_Izq<36)// Izquierda
    { digitalWrite(MotorX1,LOW);
    digitalWrite(MotorX2,HIGH);
    digitalWrite(MotorY1,HIGH);
    digitalWrite(MotorY2,LOW);
    digitalWrite(PWMmotor1,velocidad2);
    digitalWrite(PWMmotor2,velocidad2);
    }

    else if(sen_Der<38&&sen_Izq>35)// Derecha


    { digitalWrite(MotorX1,HIGH);
    digitalWrite(MotorX2,LOW);
    digitalWrite(MotorY1,LOW);
    digitalWrite(MotorY2,HIGH);
    digitalWrite(PWMmotor1,velocidad2);
    digitalWrite(PWMmotor2,velocidad2);
    }
    else if(sen_Der>36&&sen_Izq>35)// Parar
    { digitalWrite(MotorX1,LOW);
    digitalWrite(MotorX2,LOW);
    digitalWrite(MotorY1,LOW);
    digitalWrite(MotorY2,LOW);
    delay(1000);

    }
    }

    You might also like