Escolar Documentos
Profissional Documentos
Cultura Documentos
FACULTAD DE INGENIERA
PROGRAMA INGENIERA ELECTRNICA, 2011
1. INTRODUCCIN
El robot sumo es una mquina diseada y
programada para enfrentarse al oponente por medio
de sensores ultrasnicos o infrarrojos y mantenerse
dentro de la plataforma mediante sensores
reflectivos. El prototipo fue construido para la
participacin en el torneo de los robots sumo
categora 3kg con el fin de tener experiencia en
sistemas autocontrolados que puedan efectuar
diferentes tareas, en este caso en el de detectar
objetos y mantenerse dentro de un espacio
determinado.
2. MARCO TEORICO
2.2 ANTECEDENTES
Desde 1989 y en forma anual, se inici y se desarroll
en Japn una competencia nacional de robot sumo
organizada por Fuji Soft. Lo curioso de este caso es que
los armatostes metlicos deban emular a los
tradicionales luchadores de sumo. En dos categoras,
radio controlados y autnomos, los gladiadores de metal
echaban chispas sobre la arena en su esfuerzo por
tumbar a su rival. Es la competencia ms importante del
mundo en donde participan ms de 3.000 robots de todo
Japn. Adems, a partir de 1998, los robots sumo salen
UNIVERSIDAD DE CUNDINAMARCA
FACULTAD DE INGENIERA
PROGRAMA INGENIERA ELECTRNICA, 2011
Instrumentacin del robot y adecuacin
de los mismos
2.1 MODULO ULTRASONICO SRF05
UNIVERSIDAD DE CUNDINAMARCA
FACULTAD DE INGENIERA
PROGRAMA INGENIERA ELECTRNICA, 2011
Resistencias implementadas:
RD= 2 K
RT=100
2.4
SERVOMOTOR
Engranaje a eliminar
PARMETROS
DEL ROBOT
DE
CONSTRUCCIN
3
UNIVERSIDAD DE CUNDINAMARCA
FACULTAD DE INGENIERA
PROGRAMA INGENIERA ELECTRNICA, 2011
MATERIALES
para
la
Lminas de acrilico.
6 Ruedas de goma.
Lminas de aluminio para el cuerpo del
robot.
Laminas de baquela para la fabricacin de
circuitos impresos.
Microcontrolador PIC 16F873A para el
circuito de control.
Regulador de voltaje LM7805
Regulador de voltaje LM7806
Sensor ultrasnico SRF05.
4 Sensor ptico CNY70.
Interruptor tipo contactos para el
encendido del robot.
2 resistencias de 220 ohmios.
1 resistencia de 15k
Potencimetro de 1k.
Resistencia de 100 ohmios.
6 diodos LED para la visualizacin de los
estados del microcontrolador.
LM358 configurado como comparador y
acondicionador de seal para los sensores
reflectivos..
6 servomotores como actuadores para el
movimiento de las ruedas del prototipo.
Cristal de Cuarzo de 4 MHz para realizar
la oscilacin del microcontrolador.
Diodos rectificadores.
Potencimetros 10 Kilo-ohmios para el
ajuste de sensibilidad de los sensores
reflectivos.
Cable para protoboard.
COMPETENCIA
DESCRIPCIN DE LA CATEGORA
UNIVERSIDAD DE CUNDINAMARCA
FACULTAD DE INGENIERA
PROGRAMA INGENIERA ELECTRNICA, 2011
y no podrn tener cualquier arma nociva de ataque
para otros robots.
6
b)
FUNCIONAMIENTO ROBOT
Lgica de programacin
El principio de programacin se basa en buscar
algn obstculo mediante una programacin de
giros del robot y detectar el objeto mediante los
sensores ultrasnicos y dar marcha hasta detectar el
lmite de la pista (lnea blanca); posteriormente
vuelve a buscar.
Para ello se hizo uso de PICC compiler para
elaborar el programa del PIC:
atr
#include <16F873A.h>
#fuses HS,NOWDT,NOPROTECT,NOLVP
#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 INGENIERA
PROGRAMA INGENIERA ELECTRNICA, 2011
//{
puerto_c=0;
//}
while(n<5){
puerto_c=0;
delay_ms(1000);
n=n+1;
}
setup_ccp1(CCP_PWM);
setup_ccp2(CCP_PWM);
setup_timer_2(T2_DIV_BY_16, 206, 1);
goto secuencia1;
secuencia1:
while(puerto_b==15){
while(input(pin_c4) != 0 &&input(pin_c7) != 0)
{
if(puerto_b!=15)
{
goto ubicar;
}
if(input(pin_c4)==0)
{
goto adelante;
}
if(input(pin_c7)==0)
{
goto atras;
}
set_pwm1_duty(190);
set_pwm2_duty(20);
delay_ms(500);
if(puerto_b!=15)
{
goto ubicar;
}
if(input(pin_c4)==0)
{
goto adelante;
}
if(input(pin_c7)==0)
{
goto atras;
}
set_pwm1_duty(20);
set_pwm2_duty(20);
delay_ms(250);
}
if(input(pin_c4)==0)
{
goto adelante;
}
if(input(pin_c7)==0)
{
goto atras;
}
adelante:
while(puerto_b==15){
set_pwm1_duty(190);
set_pwm2_duty(20);
}
}
if(puerto_b!=15)
{
goto ubicar;
}
atras:
while(puerto_b==15){
set_pwm1_duty(20);
set_pwm2_duty(190);
}
if(puerto_b!=15)
{
goto ubicar;
}
secuencia2:
while(puerto_b==15){
while(input(pin_c4) != 0&&input(pin_c7) != 0)
{
if(puerto_b!=15)
{
goto ubicar;
}
if(input(pin_c4)==0)
{
goto adelante1;
}
if(input(pin_c7)==0)
{
6
UNIVERSIDAD DE CUNDINAMARCA
FACULTAD DE INGENIERA
PROGRAMA INGENIERA ELECTRNICA, 2011
goto atras1;
}
set_pwm1_duty(190);
set_pwm2_duty(20);
delay_ms(500);
if(puerto_b!=15)
{
goto ubicar;
}
if(input(pin_c4)==0)
{
goto adelante1;
}
if(input(pin_c7)==0)
{
goto atras1;
}
set_pwm1_duty(190);
set_pwm2_duty(190);
delay_ms(250);
}
if(input(pin_c4)==0)
{
goto adelante1;
}
if(input(pin_c7)==0)
{
goto atras1;
}
adelante1:
while(puerto_b==15){
set_pwm1_duty(190);
set_pwm2_duty(20);
}
}
if(puerto_b!=15)
{
goto ubicar;
}
atras1:
while(puerto_b==15){
set_pwm1_duty(20);
set_pwm2_duty(190);
}
if(puerto_b!=15)
{
goto ubicar;
}
ubicar:
while(puerto_b!=15){
if(puerto_b==14)
{
set_pwm1_duty(20);
set_pwm2_duty(190);
delay_ms(500);
set_pwm1_duty(20);
set_pwm2_duty(20);
delay_ms(250);
l=0;
}
if(puerto_b==13)
{
set_pwm1_duty(190);
set_pwm2_duty(190);
l=1;
}
if(puerto_b==12)
{
set_pwm1_duty(190);
set_pwm2_duty(190);
l=1;
}
if(puerto_b==6)
{
set_pwm1_duty(20);
set_pwm2_duty(20);
l=0;
}
if(puerto_b==11)
{
set_pwm1_duty(190);
set_pwm2_duty(20);
l=0;}
if(puerto_b==4)
{
set_pwm1_duty(190);
set_pwm2_duty(20);
delay_ms(500);
l=0;}
if(puerto_b==7)
{
set_pwm1_duty(20);
7
UNIVERSIDAD DE CUNDINAMARCA
FACULTAD DE INGENIERA
PROGRAMA INGENIERA ELECTRNICA, 2011
set_pwm2_duty(20);
l=0;
}
}
if(l==0){
goto secuencia1;
}
if(l==1){
goto secuencia2;
}
C1
1n
R7
C2
1n
X1
10k
SW2
U1
CRYSTAL
9
10
2
3
4
5
6
7
1
OSC1/CLKIN
OSC2/CLKOUT
RB0/INT
RB1
RB2
RB3/PGM
RB4
RB5
RB6/PGC
RB7/PGD
RA0/AN0
RA1/AN1
RA2/AN2/VREF-/CVREF
RA3/AN3/VREF+
RA4/T0CKI/C1OUT
RA5/AN4/SS/C2OUT
RC0/T1OSO/T1CKI
MCLR/Vpp/THV
RC1/T1OSI/CCP2
RC2/CCP1
RC3/SCK/SCL
RC4/SDI/SDA
RC5/SDO
RC6/TX/CK
RC7/RX/DT
21
22
23
24
25
26
27
28
SW3
SW-SPST
SW4
SW-SPST
SW5
SW-SPST
SW-SPST
R2
11
12
13
14
15
16
17
18
10k
R3
10kR4
R5
10k
PIC16F873A
D1
D2
LED-BIBY
LED-BIBY
10k
SW1
REFERENCIAS
SW-SPST
R1
10k
CONCLUSIONES Y RESULTADOS
UNIVERSIDAD DE CUNDINAMARCA
FACULTAD DE INGENIERA
PROGRAMA INGENIERA ELECTRNICA, 2011
ANEX0 1
Technical value servomotor SG 5010