Académique Documents
Professionnel Documents
Culture Documents
FACULTAD DE INGENIERÍA
PROGRAMA INGENIERÍA ELECTRÓNICA, 2011
RESUMEN. El presente documento contiene los parámetros y Japón. Además, a partir de 1998, los robots sumo salen
características que se utilizaron para implementar el robot de gira al exterior para competir con sus pares
sumo, que es un sistema autónomo con el propósito de extranjeros.
enfrentarse a otro robot sumo en una plataforma circular en
donde se empujan entre si, para sacar al oponente de la
plataforma. En el año 2003 se inició la categoría de 10 kilos (peso
del robot) pero a partir de la competencia número 19
PALABRAS CLAVES: Sensores Ópticos, Robot Sumo, (2007-2008) quedará eliminada por escasez de
servomotores, Sensores ultrasónicos, control de velocidad de participantes. Ahora sólo queda la original que
motor, torque. corresponde a los guerreros de 3 kilogramos.
2
UNIVERSIDAD DE CUNDINAMARCA
FACULTAD DE INGENIERÍA
PROGRAMA INGENIERÍA ELECTRÓNICA, 2011
Figura 5. a) Conexión para detectar línea negra Engranaje a eliminar muesca para cortar
b) Conexión para detectar línea blanca
Figura 5. Estructura interna servomotor
Resistencias implementadas:
Giro del servomotor
RD= 2 K Ω
RT=100 Ω
El servomotor SG 5010 consta de 3 pines para su
funcionamiento y cada uno esta determinado por
2.4 SERVOMOTOR
un color especifico:
Este actuador es un motor DC cuya función es
1. Cable rojo: VCC 5V
convertir la energía eléctrica en energía mecánica
2. Cable café: ground
para el accionamiento de un mecanismo
3. Cable naranja: señal de control
incorporado en el sistema. Su característica
primordial es el desempeño en la velocidad a
El pin mas importante es el de señal de control ya
través de engranajes, mecanismos circulares y
que es el que habilita el sentido de giro del motor a
dentados por medio de un potenciómetro, lo cual
través de un ciclo útil (PWM) y una frecuencia
en contraposición aumenta el torque del motor para
determinada.
mover objetos de determinado peso.
Este dispositivo muestra una forma muy particular
Frecuencia de operación: 300 Hz
en su manipulación; en el caso de nosotros se
Sentido de giro izquierdo: ciclo útil<10 %
utilizo el servomotor SG 5010. Ver anexo 1
3
UNIVERSIDAD DE CUNDINAMARCA
FACULTAD DE INGENIERÍA
PROGRAMA INGENIERÍA ELECTRÓNICA, 2011
6 FUNCIONAMIENTO ROBOT
#include <16F873A.h>
#fuses HS,NOWDT,NOPROTECT,NOLVP
#use delay(clock=4000000)
#byte puerto_b = 06
#byte puerto_c = 07
#byte puerto_a = 05
while(n<5){ }
puerto_c=0; if(input(pin_c4)==0)
delay_ms(1000); {
n=n+1; goto adelante;
} }
setup_ccp1(CCP_PWM); if(input(pin_c7)==0)
setup_ccp2(CCP_PWM); {
setup_timer_2(T2_DIV_BY_16, 206, 1); goto atras;
goto secuencia1; }
adelante:
secuencia1: while(puerto_b==15){
set_pwm1_duty(190);
while(puerto_b==15){ set_pwm2_duty(20);
while(input(pin_c4) != 0 &&input(pin_c7) != 0) }
{ }
if(puerto_b!=15) if(puerto_b!=15)
{ {
goto ubicar; goto ubicar;
} }
if(input(pin_c4)==0)
{ atras:
goto adelante; while(puerto_b==15){
} set_pwm1_duty(20);
if(input(pin_c7)==0) set_pwm2_duty(190);
{ }
goto atras;
} if(puerto_b!=15)
set_pwm1_duty(190); {
set_pwm2_duty(20); goto ubicar;
delay_ms(500); }
if(puerto_b!=15)
{ secuencia2:
goto ubicar;
} while(puerto_b==15){
if(input(pin_c4)==0) while(input(pin_c4) != 0&&input(pin_c7) != 0)
{ {
goto adelante; if(puerto_b!=15)
} {
if(input(pin_c7)==0) goto ubicar;
{ }
6
UNIVERSIDAD DE CUNDINAMARCA
FACULTAD DE INGENIERÍA
PROGRAMA INGENIERÍA ELECTRÓNICA, 2011
if(input(pin_c4)==0) atras1:
{ while(puerto_b==15){
goto adelante1; set_pwm1_duty(20);
} set_pwm2_duty(190);
if(input(pin_c7)==0) }
{
goto atras1; if(puerto_b!=15)
} {
set_pwm1_duty(190); goto ubicar;
set_pwm2_duty(20); }
delay_ms(500);
if(puerto_b!=15)
{ ubicar:
goto ubicar; while(puerto_b!=15){
} if(puerto_b==14)
if(input(pin_c4)==0) {
{ set_pwm1_duty(20);
goto adelante1; set_pwm2_duty(190);
} delay_ms(500);
if(input(pin_c7)==0) set_pwm1_duty(20);
{ set_pwm2_duty(20);
goto atras1; delay_ms(250);
} l=0;
set_pwm1_duty(190); }
set_pwm2_duty(190); if(puerto_b==13)
delay_ms(250); {
set_pwm1_duty(190);
} set_pwm2_duty(190);
if(input(pin_c4)==0) l=1;
{ }
goto adelante1; if(puerto_b==12)
} {
if(input(pin_c7)==0) set_pwm1_duty(190);
{ set_pwm2_duty(190);
goto atras1; l=1;
} }
adelante1: if(puerto_b==6)
while(puerto_b==15){ {
set_pwm1_duty(190); set_pwm1_duty(20);
set_pwm2_duty(20); set_pwm2_duty(20);
} l=0;
} }
if(puerto_b!=15) if(puerto_b==11)
{ {
goto ubicar; set_pwm1_duty(190);
} set_pwm2_duty(20);
7
UNIVERSIDAD DE CUNDINAMARCA
FACULTAD DE INGENIERÍA
PROGRAMA INGENIERÍA ELECTRÓNICA, 2011
X1
C2
1n
R7
10k
desempeño en la competencia, hay que identificar
CRYSTAL
9
10
U1
OSC1/CLKIN RB0/INT
21
22
SW2
SW3
SW4
que variables pueden afectar al robot desde la
OSC2/CLKOUT RB1 SW-SPST SW5
sensorica.
23 SW-SPST
RB2
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 R2
RA4/T0CKI/C1OUT RB7/PGD
7
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
RC5/SDO 10k
17
RC6/TX/CK
18
RC7/RX/DT 10k
D1 D2
PIC16F873A LED-BIBY LED-BIBY
SW1
R1
SW-SPST
8 REFERENCIAS
10k
9
UNIVERSIDAD DE CUNDINAMARCA
FACULTAD DE INGENIERÍA
PROGRAMA INGENIERÍA ELECTRÓNICA, 2011
ANEX0 1
Technical value servomotor SG 5010
10