INTEGRANTES:
VARGAS RODRIGUEZ JAVIER JESUS
VAZQUEZ CANTO ANDRES OMAR
FLORES LOPEZ DONOVAN ANTONIO
GONZALEZ TORRES DANIEL
CODIGO:
#include <Arduino.h> //Permite utilizar los comandos de Arduino
#include "Base_Robot.h"
void Base_Robot::Inicializar_Robot()
{
Motor_1.Inicializar_Motor();
Motor_2.Inicializar_Motor();
}
void Base_Robot::Atras(int Velocidad_1,int Velocidad_2)
{
Motor_1.Atras(Velocidad_1);
Motor_2.Atras(Velocidad_2);
}
void Base_Robot::Adelante(int Velocidad_1,int Velocidad_2)
{
Motor_1.Adelante(Velocidad_1);
Motor_2.Adelante(Velocidad_2);
}
void Base_Robot::Derecha(int Velocidad_1,int Velocidad_2)
{
Motor_1.Adelante(Velocidad_1);
Motor_2.Atras(Velocidad_2);
}
void Base_Robot::Izquierda(int Velocidad_1,int Velocidad_2)
{
Motor_1.Atras(Velocidad_1);
Motor_2.Adelante(Velocidad_2);
}
void Base_Robot::Stop()
{
Motor_1.Stop();
Motor_2.Stop();
}
CODIGO:
#include <Arduino.h> //Permite utilizar los comandos de Arduino
#include "Motor_DC.h"
void Motor_DC::Inicializar_Motor()
{
pinMode(A, OUTPUT);
pinMode(B, OUTPUT);
pinMode(Pwm, OUTPUT);
}
void Motor_DC::Atras(int Velocidad)
{
analogWrite(Pwm,Velocidad );
digitalWrite(A, HIGH);
digitalWrite(B, LOW);
}
void Motor_DC::Adelante(int Velocidad)
{
analogWrite(Pwm,Velocidad );
digitalWrite(A, LOW);
digitalWrite(B, HIGH);
}
void Motor_DC::Stop()
{
analogWrite(0, Pwm);
digitalWrite(A, LOW);
digitalWrite(B, LOW);
}
No hay comentarios:
Publicar un comentario