Project

General

Profile

Código e Implementación » History » Version 22

Cesar Jimenez, 12/04/2023 07:19 PM

1 1 Cesar Jimenez
h1. ㅤㅤㅤㅤㅤㅤㅤㅤㅤㅤㅤㅤㅤㅤㅤㅤㅤWikipedia
2 1 Cesar Jimenez
3 1 Cesar Jimenez
4 1 Cesar Jimenez
!logoPRO.png!
5 1 Cesar Jimenez
6 1 Cesar Jimenez
7 1 Cesar Jimenez
----
8 1 Cesar Jimenez
9 1 Cesar Jimenez
+*Grupo A:*+
10 1 Cesar Jimenez
>  Integrantes: Cristian Sánchez, Jean Pier Duran, Sergio Rabanal, Valentina Álvarez, César Jiménez
11 1 Cesar Jimenez
>  Nombre del Producto: Machine EV3 G
12 1 Cesar Jimenez
>  Modulo: Proyecto I
13 1 Cesar Jimenez
>  Docente: Humberto Urrutia
14 1 Cesar Jimenez
>  Fecha de Inicio: 2023-08-14
15 1 Cesar Jimenez
>  Fecha de Termino: 2023-11-30
16 1 Cesar Jimenez
17 1 Cesar Jimenez
----
18 1 Cesar Jimenez
19 1 Cesar Jimenez
*ㅤㅤㅤㅤㅤㅤㅤÍndice:*
20 1 Cesar Jimenez
* [[Introducción]]
21 1 Cesar Jimenez
* [[Descripción y Objetivos]]
22 1 Cesar Jimenez
* [[Organización y Planificación]]
23 1 Cesar Jimenez
* [[Análisis y Diseño]]
24 1 Cesar Jimenez
* [[Código e Implementación]]
25 2 Cesar Jimenez
* [[Bibliografía]]
26 3 Cesar Jimenez
27 18 Cesar Jimenez
h1. ㅤㅤㅤㅤㅤㅤㅤㅤㅤㅤㅤㅤㅤㅤㅤㅤㅤㅤㅤㅤㅤIntefaz Gráfica
28 3 Cesar Jimenez
29 1 Cesar Jimenez
<pre><code class="ruby">
30 15 Cesar Jimenez
31 16 Cesar Jimenez
import tkinter as tk
32 16 Cesar Jimenez
from tkinter import ttk
33 16 Cesar Jimenez
from tkinter import *
34 16 Cesar Jimenez
from tkinter import messagebox
35 20 Cesar Jimenez
from tkinter import PhotoImage
36 1 Cesar Jimenez
import socket
37 20 Cesar Jimenez
conection = False
38 1 Cesar Jimenez
39 20 Cesar Jimenez
def stop(Event):
40 20 Cesar Jimenez
    try:
41 20 Cesar Jimenez
        server.send(bytes([ord(' ')]))
42 20 Cesar Jimenez
    except BrokenPipeError:
43 20 Cesar Jimenez
        messagebox.showwarning("Lo siento","Intentelo Nuevamente")
44 20 Cesar Jimenez
    
45 1 Cesar Jimenez
def Up():
46 20 Cesar Jimenez
    try:
47 20 Cesar Jimenez
        server.send(bytes([ord('w')]))
48 20 Cesar Jimenez
    except BrokenPipeError:
49 20 Cesar Jimenez
        messagebox.showwarning("Lo siento","Intentelo Nuevamente")
50 1 Cesar Jimenez
    
51 1 Cesar Jimenez
def Down():
52 20 Cesar Jimenez
    try:
53 20 Cesar Jimenez
        server.send(bytes([ord('s')]))
54 20 Cesar Jimenez
    except BrokenPipeError:
55 20 Cesar Jimenez
        messagebox.showwarning("Lo siento","Intentelo Nuevamente")
56 1 Cesar Jimenez
    
57 1 Cesar Jimenez
def Left():
58 20 Cesar Jimenez
    try:
59 20 Cesar Jimenez
        server.send(bytes([ord('a')]))
60 20 Cesar Jimenez
    except BrokenPipeError:
61 20 Cesar Jimenez
        messagebox.showwarning("Lo siento","Intentelo Nuevamente")
62 1 Cesar Jimenez
def Right():
63 20 Cesar Jimenez
    try:
64 20 Cesar Jimenez
        server.send(bytes([ord('d')]))
65 20 Cesar Jimenez
    except BrokenPipeError:
66 20 Cesar Jimenez
        messagebox.showwarning("Lo siento","Intentelo Nuevamente")
67 16 Cesar Jimenez
68 20 Cesar Jimenez
def Disconnect():
69 20 Cesar Jimenez
    if conection:
70 20 Cesar Jimenez
        server.send(bytes([ord('z')]))
71 20 Cesar Jimenez
        ventana.destroy()
72 20 Cesar Jimenez
    else:
73 20 Cesar Jimenez
        ventana.destroy()
74 1 Cesar Jimenez
    
75 20 Cesar Jimenez
def Power(Pow):
76 20 Cesar Jimenez
    if (Pow == 45):
77 20 Cesar Jimenez
        server.send(bytes([ord('1')]))
78 20 Cesar Jimenez
    elif (Pow == 60):
79 20 Cesar Jimenez
        server.send(bytes([ord('2')]))
80 20 Cesar Jimenez
    elif (Pow == 90):
81 20 Cesar Jimenez
        server.send(bytes([ord('2')]))
82 20 Cesar Jimenez
    else:
83 20 Cesar Jimenez
        server.send(bytes([ord('3')]))
84 20 Cesar Jimenez
    
85 21 Cesar Jimenez
def Validar():
86 21 Cesar Jimenez
    pts = 0
87 21 Cesar Jimenez
    numero = True
88 21 Cesar Jimenez
    for k in ip.get():
89 21 Cesar Jimenez
        if (k == '.'):
90 21 Cesar Jimenez
            pts += 1
91 21 Cesar Jimenez
        elif (k.isdigit()):
92 21 Cesar Jimenez
            continue
93 21 Cesar Jimenez
        else:
94 21 Cesar Jimenez
            numero = False
95 21 Cesar Jimenez
    if (pts == 3 and numero):
96 21 Cesar Jimenez
        conectar()
97 21 Cesar Jimenez
    else:
98 21 Cesar Jimenez
        messagebox.showwarning("Error","Ingrese una dirección valida")
99 21 Cesar Jimenez
    ip.set("")
100 21 Cesar Jimenez
101 1 Cesar Jimenez
def conectar():
102 1 Cesar Jimenez
    puerto = 4999
103 21 Cesar Jimenez
    direccion = ip.get()
104 1 Cesar Jimenez
    try: 
105 16 Cesar Jimenez
        server.connect((direccion,puerto))
106 1 Cesar Jimenez
        messagebox.showinfo("Conectado","Se ha establecido la conexion exitosamente")
107 20 Cesar Jimenez
        conection = True
108 20 Cesar Jimenez
    except BrokenPipeError:
109 1 Cesar Jimenez
        messagebox.showwarning("Desconectado","Ingrese la dirección correcta")
110 1 Cesar Jimenez
        conection = False
111 21 Cesar Jimenez
    ip.set("")
112 1 Cesar Jimenez
113 20 Cesar Jimenez
# Ventana principal
114 1 Cesar Jimenez
ventana = tk.Tk()
115 20 Cesar Jimenez
ventana.geometry("750x500") 
116 1 Cesar Jimenez
ventana.title("Machine EV3")
117 20 Cesar Jimenez
ventana.configure(bg="light sea green")  
118 1 Cesar Jimenez
ventana.resizable(0,0)
119 1 Cesar Jimenez
120 21 Cesar Jimenez
ip = StringVar()
121 21 Cesar Jimenez
122 20 Cesar Jimenez
# Ingresar Imagenes
123 20 Cesar Jimenez
up = PhotoImage(file="up.png")
124 20 Cesar Jimenez
down = PhotoImage(file="down.png")
125 20 Cesar Jimenez
left = PhotoImage(file="left.png")
126 20 Cesar Jimenez
right = PhotoImage(file="right.png")
127 20 Cesar Jimenez
cross = PhotoImage(file="cross.png")
128 20 Cesar Jimenez
129 20 Cesar Jimenez
# Dimensiones de las Imagenes
130 1 Cesar Jimenez
up = up.subsample(6, 6)
131 20 Cesar Jimenez
down = down.subsample(6, 6)
132 20 Cesar Jimenez
left = left.subsample(6, 6)
133 20 Cesar Jimenez
right = right.subsample(6, 6)
134 20 Cesar Jimenez
cross = cross.subsample(6, 6)
135 20 Cesar Jimenez
136 20 Cesar Jimenez
# Iniciar Servidor
137 1 Cesar Jimenez
server = socket.socket()
138 1 Cesar Jimenez
139 1 Cesar Jimenez
# Boton Arriba
140 21 Cesar Jimenez
boton_arriba = Button(None, repeatdelay=20,repeatinterval=20,text="UP", command=Up, background="cadetblue2", image=up)
141 21 Cesar Jimenez
boton_arriba.place(x=150, y=105)
142 1 Cesar Jimenez
143 1 Cesar Jimenez
# Boton Derecha
144 21 Cesar Jimenez
boton_derech = Button(None, repeatdelay=20,repeatinterval=20 ,text="RIGHT", command=Right, background="cadetblue2", image=right)
145 21 Cesar Jimenez
boton_derech.place(x=260, y=215)
146 20 Cesar Jimenez
147 1 Cesar Jimenez
# Boton Izquierda
148 21 Cesar Jimenez
boton_izq = Button(None, repeatdelay=20,repeatinterval=20, text="LEFT", command=Left, background="cadetblue2", image=left)
149 21 Cesar Jimenez
boton_izq.place(x=40, y=215)
150 1 Cesar Jimenez
151 20 Cesar Jimenez
# Boton Abajo
152 21 Cesar Jimenez
boton_abajo = Button(None, repeatdelay=20, repeatinterval=20,text="DOWN", command=Down, background="cadetblue2", image=down)
153 21 Cesar Jimenez
boton_abajo.place(x=150, y=325)
154 20 Cesar Jimenez
155 1 Cesar Jimenez
# Boton Disparar
156 1 Cesar Jimenez
boton_disparar = Button(text="SHOT", command=lambda:[Power(50)], background="cadetblue2", image=cross)
157 21 Cesar Jimenez
boton_disparar.place(x=515, y=270)
158 1 Cesar Jimenez
159 1 Cesar Jimenez
# Boton Power de 30°
160 1 Cesar Jimenez
boton_p30 = Button(text="Angle 45%", command=lambda:[Power(45)], background="cadetblue2",fg = "DodgerBlue4")
161 21 Cesar Jimenez
boton_p30.config(width=7, height=4)
162 21 Cesar Jimenez
boton_p30.place(x=410, y=220)
163 1 Cesar Jimenez
164 1 Cesar Jimenez
# Boton Power de 60°
165 1 Cesar Jimenez
boton_p60 = Button(text="Angle 60%", command=lambda:[Power(60)], background="cadetblue2",fg = "DodgerBlue4")
166 21 Cesar Jimenez
boton_p60.config(width=7, height=4)
167 21 Cesar Jimenez
boton_p60.place(x=520, y=160)
168 20 Cesar Jimenez
169 20 Cesar Jimenez
# Boton potenca de 90°
170 20 Cesar Jimenez
boton_p100 = Button(text="Angle 90%", command=lambda:[Power(90)], background="cadetblue2",fg = "DodgerBlue4")
171 21 Cesar Jimenez
boton_p100.config(width=7, height=4)
172 21 Cesar Jimenez
boton_p100.place(x=630, y=220)
173 20 Cesar Jimenez
174 1 Cesar Jimenez
# Desconectar Brick
175 20 Cesar Jimenez
boton_exit = Button(text="Disconnect",command = Disconnect,background="cadetblue2",fg = "DodgerBlue4")
176 20 Cesar Jimenez
boton_exit.config(width=9, height=1)
177 21 Cesar Jimenez
boton_exit.place(x=620, y=20)
178 1 Cesar Jimenez
179 21 Cesar Jimenez
#Ingreso ip
180 21 Cesar Jimenez
entrada_IP = Entry(ventana,textvariable = ip, width = 18)
181 21 Cesar Jimenez
entrada_IP.focus_set()
182 21 Cesar Jimenez
entrada_IP.place(x = 320, y=25)
183 21 Cesar Jimenez
184 21 Cesar Jimenez
# Conexión
185 21 Cesar Jimenez
boton_conectar = Button(text="Conect",background="cadetblue2",fg = "DodgerBlue4",command = Validar)
186 21 Cesar Jimenez
boton_conectar.config(width=9, height=1)
187 21 Cesar Jimenez
boton_conectar.place(x=490, y=20)
188 21 Cesar Jimenez
189 20 Cesar Jimenez
# Detener Motores
190 20 Cesar Jimenez
boton_arriba.bind('<ButtonRelease-1>',stop)
191 20 Cesar Jimenez
boton_abajo.bind('<ButtonRelease-1>',stop)
192 20 Cesar Jimenez
boton_izq.bind('<ButtonRelease-1>',stop)
193 20 Cesar Jimenez
boton_derech.bind('<ButtonRelease-1>',stop)
194 20 Cesar Jimenez
195 17 Cesar Jimenez
ventana.mainloop()
196 21 Cesar Jimenez
197 17 Cesar Jimenez
198 17 Cesar Jimenez
</code></pre>
199 17 Cesar Jimenez
200 17 Cesar Jimenez
201 17 Cesar Jimenez
h1. Servidor
202 17 Cesar Jimenez
203 17 Cesar Jimenez
<pre><code class="ruby">
204 17 Cesar Jimenez
205 17 Cesar Jimenez
import socket
206 17 Cesar Jimenez
from Funciones import *
207 20 Cesar Jimenez
208 17 Cesar Jimenez
# Crear un socket del servreceptor
209 20 Cesar Jimenez
server = socket.socket()
210 17 Cesar Jimenez
211 20 Cesar Jimenez
# Vincular el socket a una dirección IP y un puerto
212 20 Cesar Jimenez
server.bind(('',4999))
213 17 Cesar Jimenez
print("CONECTADO")
214 17 Cesar Jimenez
215 20 Cesar Jimenez
# Poner el socket en modo de escucha
216 17 Cesar Jimenez
server.listen(5)  # Permite hasta 5 conexiones pendientes
217 17 Cesar Jimenez
print("Esperando conexiones entrantes...")
218 17 Cesar Jimenez
219 20 Cesar Jimenez
# Aceptar una conexión entrante
220 20 Cesar Jimenez
socket_client, address_client = server.accept()
221 17 Cesar Jimenez
print("Conexion entrante desde 192.168.47.147")
222 19 Cesar Jimenez
223 20 Cesar Jimenez
while True:
224 20 Cesar Jimenez
    recept = socket_client.recv(1).recept.decode("utf-8")
225 20 Cesar Jimenez
    if (recept == 'w'): # arriba
226 20 Cesar Jimenez
        Mov_Up()
227 20 Cesar Jimenez
    if (recept == 's'): # abajo
228 20 Cesar Jimenez
        Mov_Down()
229 20 Cesar Jimenez
    if (recept == 'a'): # izquierda
230 20 Cesar Jimenez
        Mov_Left()
231 20 Cesar Jimenez
    if (recept == 'd'): # derecha
232 20 Cesar Jimenez
        Mov_Right()
233 20 Cesar Jimenez
    if (Id.isdigit()): # disparo por angulo 
234 20 Cesar Jimenez
        if (recept == '1'):
235 20 Cesar Jimenez
            Angle45()
236 20 Cesar Jimenez
        elif (recept == '2'):
237 20 Cesar Jimenez
            Angle60()
238 20 Cesar Jimenez
        elif (recept == '3'):
239 20 Cesar Jimenez
            Angle90()   
240 20 Cesar Jimenez
    if (recept == 'z'): # Cierre Ventana
241 20 Cesar Jimenez
        break
242 20 Cesar Jimenez
    if (recept == ' '): # Detener Movimiento
243 17 Cesar Jimenez
        Stop_Motor()
244 17 Cesar Jimenez
245 17 Cesar Jimenez
</code></pre>
246 17 Cesar Jimenez
247 17 Cesar Jimenez
h1. Funciones Principales del Robot
248 17 Cesar Jimenez
249 17 Cesar Jimenez
<pre><code class="ruby">
250 17 Cesar Jimenez
251 20 Cesar Jimenez
from ev3dev.ev3 import Sound
252 17 Cesar Jimenez
from ev3dev2.motor import LargeMotor,OUTPUT_A, OUTPUT_B, OUTPUT_C, OUTPUT_D, MoveTank
253 20 Cesar Jimenez
from time import sleep
254 17 Cesar Jimenez
import time
255 17 Cesar Jimenez
256 20 Cesar Jimenez
#Agregar Funciones del ROBOT
257 20 Cesar Jimenez
rueda_left = LargeMotor(OUTPUT_C)
258 20 Cesar Jimenez
rueda_right = LargeMotor(OUTPUT_B)
259 17 Cesar Jimenez
motor_A = LargeMotor(OUTPUT_A)
260 17 Cesar Jimenez
261 20 Cesar Jimenez
def Mov_Right():
262 17 Cesar Jimenez
    motor_A.run_forever(speed_sp=80)
263 17 Cesar Jimenez
264 20 Cesar Jimenez
def Mov_Left():
265 17 Cesar Jimenez
    motor_A.run_forever(speed_sp=-80)
266 17 Cesar Jimenez
267 20 Cesar Jimenez
def Mov_Down():
268 20 Cesar Jimenez
    rueda_left.run_forever(speed_sp=500)
269 17 Cesar Jimenez
    rueda_right.run_forever(speed_sp=500)
270 1 Cesar Jimenez
271 20 Cesar Jimenez
def Mov_Up():
272 20 Cesar Jimenez
    rueda_left.run_forever(speed_sp=-500)
273 1 Cesar Jimenez
    rueda_right.run_forever(speed_sp=-500)
274 20 Cesar Jimenez
275 20 Cesar Jimenez
def Stop_Motor():
276 20 Cesar Jimenez
    rueda_left.stop()
277 20 Cesar Jimenez
    rueda_right.stop()
278 1 Cesar Jimenez
    motor_A.stop()
279 20 Cesar Jimenez
280 20 Cesar Jimenez
def Angle45():
281 20 Cesar Jimenez
    motor_D = LargeMotor(OUTPUT_D)
282 20 Cesar Jimenez
    motor_D.on_for_degrees(speed=10, degrees = 45)
283 20 Cesar Jimenez
    motor_D.on_for_degrees(speed=100, degrees = -105)
284 20 Cesar Jimenez
    motor_D.on_for_degrees(speed=10, degrees = 60)
285 1 Cesar Jimenez
    motor_D.off()
286 20 Cesar Jimenez
287 20 Cesar Jimenez
def Angle60():
288 20 Cesar Jimenez
    motor_D = LargeMotor(OUTPUT_D)
289 20 Cesar Jimenez
    motor_D.on_for_degrees(speed=10, degrees = 60)
290 20 Cesar Jimenez
    motor_D.on_for_degrees(speed=100, degrees = -120)
291 20 Cesar Jimenez
    motor_D.on_for_degrees(speed=10, degrees = 60)
292 20 Cesar Jimenez
    motor_D.off()
293 20 Cesar Jimenez
294 20 Cesar Jimenez
def Angle90():
295 20 Cesar Jimenez
    motor_D = LargeMotor(OUTPUT_D)
296 20 Cesar Jimenez
    motor_D.on_for_degrees(speed=10, degrees = 90)
297 20 Cesar Jimenez
    motor_D.on_for_degrees(speed=100, degrees = -150)
298 20 Cesar Jimenez
    motor_D.on_for_degrees(speed=10, degrees = 60)
299 20 Cesar Jimenez
    motor_D.off()
300 1 Cesar Jimenez
301 1 Cesar Jimenez
def Sonido():
302 1 Cesar Jimenez
    sound = Sound()
303 1 Cesar Jimenez
    sound.beep()
304 1 Cesar Jimenez
    sound.speak("Vini o' rey do futebol")
305 1 Cesar Jimenez
306 1 Cesar Jimenez
</code></pre>