Académique Documents
Professionnel Documents
Culture Documents
Universidad de pamplona
Ingeniería mecatrónica
Pamplona 2018
Introducción
Los robots minisumo son un tipo de robot autómata el cual simula una batalla de sumo, para
esto utiliza sensores para la detección de robot adversario. Para este tipo de robot hay gran
variedad de sensores los cuales tienen algunas características específicas de cada uno de ellos.
En esta ocasión se hizo una comparación entre el sensor ultrasónico y el Sharp estas pruebas
se desarrollaron con diferentes superficies y con diferentes ángulos. Para ver su eficiencia
para ser usados en un robot minisumo.
Voltaje de alimentación: 5v
Corriente: 33mA
Rango de medición: 10cm a 80cm
Pines de conexión: 3
Distancia = (4800)/(lectura-20);
Programación
La programación fue desarrollada en Arduino para los parámetros de distancia se utilizaron
las formulas ya presentadas en los parámetros de cada sensor.
La distancia para el ultrasónico se tiene en cuenta el tiempo en que se demora en ir y volver
la señal, multiplicado por la velocidad del sonido en cm.
La distancia en el Sharp se tiene en cuenta el valor analógico que este entrega y los otros
parámetros son dados por el fabricante (teniendo en cuenta que el valor obtenido debe estar
entre 80 a 500) que equivalen a (391mv a 2.44v) que son los rangos en que varía la salida del
sensor en voltios.
#define Pecho 6
#define Ptrig 7
#define sharp A0
float lectura;
int cm;
long duracion, distancia;
void setup() {
Serial.begin(9600);
pinMode(Pecho,INPUT);
pinMode(Ptrig,OUTPUT);
}
void loop() {
digitalWrite(Ptrig,LOW);
delayMicroseconds(2);
digitalWrite(Ptrig,HIGH);
delayMicroseconds(10);
digitalWrite(Ptrig,LOW);
duracion = pulseIn(Pecho,HIGH);
distancia=(duracion/2)/29;
lectura = analogRead(sharp);
if(lectura>=80 && lectura<=500)
{
cm=(4800)/(lectura-20);
}
if(distancia >=500 || distancia <=0)
{
if(cm >=80 || cm <=0)
{
Serial.println("----");
}
}if(cm >=80 || cm <=0)
{
if(distancia >=500 || distancia <=0)
{
Serial.println("----");
}
}
else
{
Serial.print(distancia);
Serial.print("cm");
Serial.print(cm);
Serial.println("cm");
}
delay(250);
}
Tabla de resultados
Esta tabla fue realizada por los datos obtenidos por el monitor serie las distancia real de los
objetos que se censaron fue de ±30 cm y a un ángulo de 90° y de ±60°