Informe Robot Sumo
Informe Robot Sumo
Informe Robot Sumo
FACULTAD DE INGENIERÍA
PROGRAMA INGENIERÍA ELECTRÓNICA, 2011
RESUMEN. El presente documento contiene los parámetros y de gira al exterior para competir con sus pares
características que se utilizaron para implementar el robot extranjeros.
sumo, que es un sistema autónomo con el propósito de
enfrentarse a otro robot sumo en una plataforma circular en
donde se empujan entre si, para sacar al oponente de la En el año 2003 se inició la categoría de 10 kilos (peso
plataforma. del robot) pero a partir de la competencia número 19
(2007-2008) quedará eliminada por escasez de
PALABRAS CLAVES: Sensores Ópticos, Robot Sumo, participantes. Ahora sólo queda la original que
servomotores, Sensores ultrasónicos, control de velocidad de corresponde a los guerreros de 3 kilogramos.
motor, torque.
El escenario de lucha de los robot sumo es similar al
1. INTRODUCCIÓN tradicional, salvo por las dimensiones, los pequeños
androides deben pelear dentro de un círculo de 154
El robot sumo es una máquina diseñada y centímetros de diámetro. La banda blanca, de 5
programada para enfrentarse al oponente por medio centímetros de ancho, que marca el perímetro y otras en
de sensores ultrasónicos o infrarrojos y mantenerse el interior, son para que el tipo autónomo pueda ubicarse
por medio de sus sensores.
dentro de la plataforma mediante sensores
reflectivos. El prototipo fue construido para la
Antes de la gran competencia a nivel nacional, los
participación en el torneo de los robots sumo
aspirantes deben superar las eliminatorias por distrito.
categoría 3kg con el fin de tener experiencia en Los participantes compiten en dos categorías: general y
sistemas autocontrolados que puedan efectuar estudiantes. En la categoría general puede competir
diferentes tareas, en este caso en el de detectar cualquier persona y en cualquier parte del país, sin
objetos y mantenerse dentro de un espacio distinción en cuanto a su lugar de residencia. En cambio,
determinado. los estudiantes deben hacerlo en su circunscripción
(competencia regional) o representando a su escuela
2. MARCO TEORICO (competencia nacional).
1
UNIVERSIDAD DE CUNDINAMARCA
FACULTAD DE INGENIERÍA
PROGRAMA INGENIERÍA ELECTRÓNICA, 2011
3 PARÁMETROS DE CONSTRUCCIÓN
DEL ROBOT
3
UNIVERSIDAD DE CUNDINAMARCA
FACULTAD DE INGENIERÍA
PROGRAMA INGENIERÍA ELECTRÓNICA, 2011
4
UNIVERSIDAD DE CUNDINAMARCA
FACULTAD DE INGENIERÍA
PROGRAMA INGENIERÍA ELECTRÓNICA, 2011
b)
6 FUNCIONAMIENTO ROBOT
#include <16F873A.h>
#fuses HS,NOWDT,NOPROTECT,NOLVP
atrás #use delay(clock=4000000)
#byte puerto_b = 06
#byte puerto_c = 07
#byte puerto_a = 05
void main() {
float n, l;
n=0;
set_tris_a( 0xFF );
set_tris_b( 0xFF );
set_tris_c( 0xF0 );
SETUP_ADC_PORTS(NO_ANALOGS);
inicio:
//while(input(pin_c5)==0)
5
UNIVERSIDAD DE CUNDINAMARCA
FACULTAD DE INGENIERÍA
PROGRAMA INGENIERÍA ELECTRÓNICA, 2011
//{ delay_ms(250);
puerto_c=0;
//} }
if(input(pin_c4)==0)
while(n<5){ {
puerto_c=0; goto adelante;
delay_ms(1000); }
n=n+1; if(input(pin_c7)==0)
} {
setup_ccp1(CCP_PWM); goto atras;
setup_ccp2(CCP_PWM); }
setup_timer_2(T2_DIV_BY_16, 206, 1); adelante:
goto secuencia1; while(puerto_b==15){
set_pwm1_duty(190);
secuencia1: set_pwm2_duty(20);
}
while(puerto_b==15){ }
while(input(pin_c4) != 0 &&input(pin_c7) != 0) if(puerto_b!=15)
{ {
if(puerto_b!=15) goto ubicar;
{ }
goto ubicar;
} atras:
if(input(pin_c4)==0) while(puerto_b==15){
{ set_pwm1_duty(20);
goto adelante; set_pwm2_duty(190);
} }
if(input(pin_c7)==0)
{ if(puerto_b!=15)
goto atras; {
} goto ubicar;
set_pwm1_duty(190); }
set_pwm2_duty(20);
delay_ms(500); secuencia2:
if(puerto_b!=15)
{ while(puerto_b==15){
goto ubicar; while(input(pin_c4) != 0&&input(pin_c7) != 0)
} {
if(input(pin_c4)==0) if(puerto_b!=15)
{ {
goto adelante; goto ubicar;
} }
if(input(pin_c7)==0) if(input(pin_c4)==0)
{ {
goto atras; goto adelante1;
} }
set_pwm1_duty(20); if(input(pin_c7)==0)
set_pwm2_duty(20); {
6
UNIVERSIDAD DE CUNDINAMARCA
FACULTAD DE INGENIERÍA
PROGRAMA INGENIERÍA ELECTRÓNICA, 2011
CRYSTAL
9
10
U1
OSC1/CLKIN RB0/INT
21
22
SW2
SW3
SW4
sensorica.
OSC2/CLKOUT RB1
23
SW-SPST SW5
RB2 SW-SPST
2 24 SW-SPST
RA0/AN0 RB3/PGM
3 25 SW-SPST
RA1/AN1 RB4
4 26
RA2/AN2/VREF-/CVREF RB5
5 27
RA3/AN3/VREF+ RB6/PGC
6 28
7
RA4/T0CKI/C1OUT RB7/PGD R2
RA5/AN4/SS/C2OUT
11
RC0/T1OSO/T1CKI 10k
1 12 R3
MCLR/Vpp/THV RC1/T1OSI/CCP2
13
RC2/CCP1
14
RC3/SCK/SCL 10kR4
15
RC4/SDI/SDA
16 R5
10k
RC5/SDO
17
RC6/TX/CK
18
RC7/RX/DT 10k
D1 D2
PIC16F873A LED-BIBY LED-BIBY
SW1
B
8 REFERENCIAS
SW-SPST
R1
10k
[1] HART. Daniel W. ELECTRONICA DE POTENCIA.
Pearson Educación S.A. Madrid © 2001. Págs.203.
7 CONCLUSIONES Y RESULTADOS
8
UNIVERSIDAD DE CUNDINAMARCA
FACULTAD DE INGENIERÍA
PROGRAMA INGENIERÍA ELECTRÓNICA, 2011
9
ANEX0 1
Technical value servomotor SG 5010