-
Notifications
You must be signed in to change notification settings - Fork 0
Expand file tree
/
Copy pathmain.py
More file actions
executable file
·44 lines (34 loc) · 1.46 KB
/
Copy pathmain.py
File metadata and controls
executable file
·44 lines (34 loc) · 1.46 KB
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
import cv2 as cv
from matplotlib import pyplot as plt
import time
from time import sleep
import math
from vision import Avision
from procesamiento import Aprocesamiento #Clase de vision
from mapeo import Amapeo, AStarPlanner #Import class from a_star
from robot import Arobot #Clase de robot
class Amain:
def __init__(self):
self.event = 0 #1 Penalty kick / 2 Obstacle run
self.scaled = 1
self.width_field = 350//self.scaled #90 width x
self.height_field = 180//self.scaled #45 height y
self.grid_size = 5.0
def set_event(self, number_event):
self.event = number_event
def get_event(self):
return self.event
def main(self):
print(__file__ + " start!!")
#Inicializar Clases
obj_vision = Avision()
obj_robot = Arobot() #Inicializar variables en Adarwinop de a_robot.py #print(Adarwinop_obj.angle_robot_camera)
obj_mapeo = Amapeo(self.width_field, self.height_field, self.scaled, self.grid_size) #Inicializar variables en A_field de a_star.py
obj_procesamiento = Aprocesamiento(obj_mapeo, obj_robot, obj_vision) #Inicializar variables en A_vision -> clase Acamera
#obj_mapeo.Aplot_obstacle(40, 60, 25) #Objeto identificado, ejemplo
#obj_mapeo.Aplot_obstacle(100, 80, 50) #Objeto identificado, ejemplo
obj_procesamiento.main()
if __name__ == '__main__':
obj_main = Amain()
#Inicio de programa
obj_main.main()