Código realizado por: A.M.C 19 , J.C.B 4 y D.V.G 24

-
Código normal: 

/***   Included libraries  ***/


/***   Global variables and function definition  ***/
const int EN_A_5 = 5;
const int IN_1_11 = 11;
const int IN_2_10 = 10;
const int EN_B_6 = 6;
const int IN_3_12 = 12;
const int IN_4_13 = 13;
const int infrarrojo_izquierdo = 2;
const int infrarrojo_derecho = 3;

float Velocidad = 150;
float izquierda = 0;
float derecha = 0;
void se_ha_salido() {
    digitalWrite(IN_1_11, LOW);
    digitalWrite(IN_2_10, HIGH);
    digitalWrite(IN_3_12, LOW);
    digitalWrite(IN_4_13, HIGH);
    analogWrite(5, Velocidad);
    analogWrite(6, Velocidad);
}
analogWrite(6, Velocidad);
void Derecha() {
    digitalWrite(IN_1_11, LOW);
    digitalWrite(IN_2_10, HIGH);
    digitalWrite(IN_3_12, LOW);
    digitalWrite(IN_4_13, HIGH);
    analogWrite(5, Velocidad);
}
void Apagado() {
    digitalWrite(IN_1_11, LOW);
    digitalWrite(IN_2_10, LOW);
    digitalWrite(IN_3_12, LOW);
    digitalWrite(IN_4_13, LOW);
    digitalWrite(EN_A_5, LOW);
    digitalWrite(EN_B_6, LOW);
}
void avanzar() {
    digitalWrite(IN_1_11, LOW);
    digitalWrite(IN_2_10, HIGH);
    digitalWrite(IN_3_12, HIGH);
    digitalWrite(IN_4_13, LOW);
    analogWrite(5, Velocidad);
    analogWrite(6, Velocidad);
}
void Izquierda() {
    digitalWrite(IN_1_11, HIGH);
    digitalWrite(IN_2_10, LOW);
    digitalWrite(IN_3_12, HIGH);
    digitalWrite(IN_4_13, LOW);
    analogWrite(5, Velocidad);
    analogWrite(6, Velocidad);
}



/***   Setup  ***/
void setup() {
    pinMode(EN_A_5, OUTPUT);
    pinMode(IN_1_11, OUTPUT);
    pinMode(IN_2_10, OUTPUT);
    pinMode(EN_B_6, OUTPUT);
    pinMode(IN_3_12, OUTPUT);
    pinMode(IN_4_13, OUTPUT);
    pinMode(infrarrojo_izquierdo, INPUT);
    pinMode(infrarrojo_derecho, INPUT);

}


/***   Loop  ***/
void loop() {
    izquierda = digitalRead(infrarrojo_izquierdo);
    derecha = digitalRead(infrarrojo_derecho);
    if (((izquierda == 0) && (derecha == 0))) {
        Apagado();
    } else if (((izquierda == 1) && (derecha == 0))) {
        Derecha();
    } else if (((izquierda == 0) && (derecha == 1))) {
        Izquierda();
    } else if (((izquierda == 1) && (derecha == 1))) {
        avanzar();
    }
}








Código de 90 grados:


/***   Included libraries  ***/


/***   Global variables and function definition  ***/
const int EN_A_5 = 5;
const int IN_1_11 = 11;
const int IN_2_10 = 10;
const int EN_B_6 = 6;
const int IN_3_12 = 12;
const int IN_4_13 = 13;
const int infrarrojo_izquierdo = 2;
const int infrarrojo_derecho = 3;

float Velocidad = 95;
float izquierda = 0;
float derecha = 0;
void se_ha_salido() {
    digitalWrite(IN_1_11, LOW);
    digitalWrite(IN_2_10, HIGH);
    digitalWrite(IN_3_12, LOW);
    digitalWrite(IN_4_13, HIGH);
    analogWrite(5, Velocidad);
    analogWrite(6, Velocidad);
}
analogWrite(6, Velocidad);
void Derecha() {
    digitalWrite(IN_1_11, LOW);
    digitalWrite(IN_2_10, HIGH);
    digitalWrite(IN_3_12, LOW);
    digitalWrite(IN_4_13, HIGH);
    analogWrite(5, Velocidad);
}
void Apagado() {
    digitalWrite(IN_1_11, LOW);
    digitalWrite(IN_2_10, LOW);
    digitalWrite(IN_3_12, LOW);
    digitalWrite(IN_4_13, LOW);
    digitalWrite(EN_A_5, LOW);
    digitalWrite(EN_B_6, LOW);
}
void avanzar() {
    digitalWrite(IN_1_11, LOW);
    digitalWrite(IN_2_10, HIGH);
    digitalWrite(IN_3_12, HIGH);
    digitalWrite(IN_4_13, LOW);
    analogWrite(5, Velocidad);
    analogWrite(6, Velocidad);
}
void Izquierda() {
    digitalWrite(IN_1_11, HIGH);
    digitalWrite(IN_2_10, LOW);
    digitalWrite(IN_3_12, HIGH);
    digitalWrite(IN_4_13, LOW);
    analogWrite(5, Velocidad);
    analogWrite(6, Velocidad);
}



/***   Setup  ***/
void setup() {
    pinMode(EN_A_5, OUTPUT);
    pinMode(IN_1_11, OUTPUT);
    pinMode(IN_2_10, OUTPUT);
    pinMode(EN_B_6, OUTPUT);
    pinMode(IN_3_12, OUTPUT);
    pinMode(IN_4_13, OUTPUT);
    pinMode(infrarrojo_izquierdo, INPUT);
    pinMode(infrarrojo_derecho, INPUT);

}


/***   Loop  ***/
void loop() {
    izquierda = digitalRead(infrarrojo_izquierdo);
    derecha = digitalRead(infrarrojo_derecho);
    if (((izquierda == 0) && (derecha == 0))) {
        Apagado();
    } else if (((izquierda == 1) && (derecha == 0))) {
        Derecha();
    } else if (((izquierda == 0) && (derecha == 1))) {
        Izquierda();
    } else if (((izquierda == 1) && (derecha == 1))) {
        avanzar();
    }
}










Código buscar la linea:




/***   Included libraries  ***/


/***   Global variables and function definition  ***/
const int EN_A_5 = 5;
const int IN_1_11 = 11;
const int IN_2_10 = 10;
const int EN_B_6 = 6;
const int IN_3_12 = 12;
const int IN_4_13 = 13;
const int infrarrojo_izquierdo = 2;
const int infrarrojo_derecho = 3;

float Velocidad = 95;
float izquierda = 0;
float derecha = 0;
void se_ha_salido() {
    digitalWrite(IN_1_11, LOW);
    digitalWrite(IN_2_10, HIGH);
    digitalWrite(IN_3_12, LOW);
    digitalWrite(IN_4_13, HIGH);
    analogWrite(5, Velocidad);
    analogWrite(6, Velocidad);
}
analogWrite(6, Velocidad);
void Derecha() {
    digitalWrite(IN_1_11, LOW);
    digitalWrite(IN_2_10, HIGH);
    digitalWrite(IN_3_12, LOW);
    digitalWrite(IN_4_13, HIGH);
    analogWrite(5, Velocidad);
}
void Apagado() {
    digitalWrite(IN_1_11, LOW);
    digitalWrite(IN_2_10, LOW);
    digitalWrite(IN_3_12, LOW);
    digitalWrite(IN_4_13, LOW);
    digitalWrite(EN_A_5, LOW);
    digitalWrite(EN_B_6, LOW);
}
void avanzar() {
    digitalWrite(IN_1_11, LOW);
    digitalWrite(IN_2_10, HIGH);
    digitalWrite(IN_3_12, HIGH);
    digitalWrite(IN_4_13, LOW);
    analogWrite(5, Velocidad);
    analogWrite(6, Velocidad);
}
void Izquierda() {
    digitalWrite(IN_1_11, HIGH);
    digitalWrite(IN_2_10, LOW);
    digitalWrite(IN_3_12, HIGH);
    digitalWrite(IN_4_13, LOW);
    analogWrite(5, Velocidad);
    analogWrite(6, Velocidad);
}



/***   Setup  ***/
void setup() {
    pinMode(EN_A_5, OUTPUT);
    pinMode(IN_1_11, OUTPUT);
    pinMode(IN_2_10, OUTPUT);
    pinMode(EN_B_6, OUTPUT);
    pinMode(IN_3_12, OUTPUT);
    pinMode(IN_4_13, OUTPUT);
    pinMode(infrarrojo_izquierdo, INPUT);
    pinMode(infrarrojo_derecho, INPUT);

}


/***   Loop  ***/
void loop() {
    izquierda = digitalRead(infrarrojo_izquierdo);
    derecha = digitalRead(infrarrojo_derecho);
    if (((izquierda == 0) && (derecha == 0))) {
        se_ha_salido();
    } else if (((izquierda == 1) && (derecha == 0))) {
        Derecha();
    } else if (((izquierda == 0) && (derecha == 1))) {
        Izquierda();
    } else if (((izquierda == 1) && (derecha == 1))) {
        avanzar();
    }
}








































































Comentarios











Publicar un comentario



















Entradas populares de este blog









Robot Da Vinci 






-














Imagen







 Robot Da Vinci   El robot Da Vinci es a dia de hoy es el mejor robot de cirujia que existe.     El sitema quirurjico Da Vinci  un equipo de cirugía robótica desarrollado por la empresa norteamericana Intuitive Surgical,  está controlado por un cirujano que opera desde una consola y se diseñó para facilitar la cirugía compleja      El  robot quirúrgico Da Vinci se compone de una consola ergonómica desde la que el cirujano opera sentado . Al lado del paciente se sitúa la torre de visión (formada por controladores, vídeo, audio y proceso de imagen) y el carro quirúrgico que incorpora tres o cuatro brazos robóticos.   Los robots da Vinci operan en centros hospitalarios públicos y privados de todo el mundo, con un estimado de 300.000 cirugías realizadas en 2013.     Espero que te haya gustado y que hayas aprendido un poco mas.    MK.    








Leer más














-














Imagen







                             SENSOR DE LUZ 1.0    Este es el primer circuito que hemos hecho intentando que el ldr funcione, lo que intentamos es que cuando es de día se apague o haya la mínima luz y cuando sea de noche que la bombilla se encienda al máximo            COMPONENTES:   Pila 9V   Interruptor   LDR(que es una resistencia que varia con la luz) Una bombilla                








Leer más














-















 Practica 3. 01           Te adjunto una lista de sensores que pueden ser  utilizados por robots.      Sensores de luz LDR: Un LDR es una resistencia que varia en función de la luz que le llega a mayor luz, menor resistencia y viceversa            Sensores de presión y fuerza: Convierten el valor de una presion en una señal normalizada.       -Sensores de contacto:Mide la posición de un objeto mediante un contacto directo con este.  Se utiliza por ejemplo para detectar cuando un robot alcanza una superficie.  -Microinterruptores:Se utilizan para tareas de regulacion o precision.   Sensores de sonido:Son sensores destinados a detectar la intensidad de un sonido. -Microfonos:Es un sensor que puede recibir sonidos desde el interior o desde el exterior del robot.  -Rangers ultrasonicos:lanza un tren de pulsos ultrasonicos y espera el rebote,segun el tiempo esperado se conoce la distancia entre el emisor y el objeto en el que se produjo el rebote-   Sensor de medidor de distancia:Son sensor








Leer más