Skip to content

Commit

Permalink
preping questão
Browse files Browse the repository at this point in the history
  • Loading branch information
dsoldev committed Oct 2, 2024
1 parent 3bae530 commit 4f368f2
Show file tree
Hide file tree
Showing 4 changed files with 186 additions and 70 deletions.
Loading
Sorry, something went wrong. Reload?
Sorry, we cannot display this file.
Sorry, this file is invalid so it cannot be displayed.
Loading
Sorry, something went wrong. Reload?
Sorry, we cannot display this file.
Sorry, this file is invalid so it cannot be displayed.
119 changes: 49 additions & 70 deletions docs/modulos/07-controle/util/creeper_detector.py
Original file line number Diff line number Diff line change
Expand Up @@ -2,21 +2,25 @@
import cv2
import numpy as np


class CreeperDetector(Aruco3d):
class CreeperDetector(): # Importe a classe Aruco3d
def __init__(self):
Aruco3d.__init__(self)
# Inicialize a classe Aruco3d
self.kernel = np.ones((5,5),np.uint8)

self.filters = {
'blue': {
'lower': np.array([100, 50, 50]),
'upper': np.array([140, 255, 255])
'lower': (0,0,0),
'upper': (255,255,255)
},
'green': {
'lower': np.array([40, 50, 20]),
'upper': np.array([80, 255, 255])
},}
'lower': (0,0,0),
'upper': (255,255,255)
},
'red': {
'lower': (0,0,0),
'upper': (255,255,255)
},
}

def find_creeper(self, bgr: np.ndarray, color: str) -> list:
"""
Expand All @@ -27,23 +31,14 @@ def find_creeper(self, bgr: np.ndarray, color: str) -> list:
color (str): cor do creeper para identificação.
Returns:
list: lista de centros dos creepers detectados e a cor atual. No formato list( [(cx,cy), color], [...]... ).
list: lista de centros dos creepers detectados e a cor atual.
No formato list( [(cx,cy), color], [...]... ).
"""
creepers = []
hsv = cv2.cvtColor(bgr, cv2.COLOR_BGR2HSV)
mask = cv2.inRange(hsv, self.filters[color]['lower'], self.filters[color]['upper'])
mask = cv2.morphologyEx(mask, cv2.MORPH_OPEN, self.kernel)
mask = cv2.morphologyEx(mask, cv2.MORPH_CLOSE, self.kernel)

contours, _ = cv2.findContours(mask, cv2.RETR_EXTERNAL, cv2.CHAIN_APPROX_SIMPLE)
for cnt in contours:
area = cv2.contourArea(cnt)
if area < 1000:
continue
x, y, w, h = cv2.boundingRect(cnt)
cx, cy = x + w//2, y + h//2
creepers.append([(cx, cy), color])

# 1. Converter para hsv e filtrar a partir da chave `color` do dicionário `self.filters`.
# 2. Utilize a função cv2.morphologyEx para aplicar a operação de abertura e fechamento.
# 3. Encontre os contornos e adicione o centro do creeper e o nome da cor na lista `creepers`.

return creepers

def distance(self, x1, x2):
Expand Down Expand Up @@ -71,22 +66,24 @@ def match_aruco(self, bgr, creepers, results):
matched_pairs = []
for creeper in creepers:

# 3. Use a função min para ordenar os resultados por distância com base na função self.distance.
closest = min(results, key=lambda x: self.distance(x['centro'][0], creeper[0][0]))

# 4. Remove da lista `results` o aruco mais próximo do corpo `creeper` para evitar que ele seja combinado novamente.
results = [result for result in results if result['distancia'] != closest['distancia']]

# 5. Adiciona na variável o centro do creeper mais próximo na chave "body_center" do dicionário `closest`.
closest['body_center'] = creeper[0]
# 6. Adiciona a cor do creeper mais próximo na chave "color" do dicionário `closest`.
closest['color'] = creeper[1]
# 1. Use a função min para ordenar os resultados por distância com base na função self.distance.
# Dica: Utilize a função lambda para acessar a chave 'centro' do dicionário `results`.
closest = min(...)

# 2. Remove da lista `results` o aruco mais próximo do corpo `creeper` para evitar que ele seja combinado novamente.
# Dica: Pode ser feito utilizando list comprehension.
results = ...

# 3. Adiciona na variável o centro do creeper mais próximo na chave "body_center" do dicionário `closest`.
closest['body_center'] = ...
# 4. Adiciona a cor do creeper mais próximo na chave "color" do dicionário `closest`.
closest['color'] = ...

# 7. Desenha uma linha entre o centro do creeper e o centro do marcador Aruco.
cv2.line(bgr, tuple(closest['centro']), tuple(closest['body_center']), (0, 0, 255), 2)
# 5. Desenha uma linha entre o centro do creeper e o centro do marcador Aruco.
cv2.line()

# 8. Adiciona o par combinado na lista `matched_pairs`.
matched_pairs.append(closest)
# 6. Adiciona o par combinado na lista `matched_pairs`.
matched_pairs...

if len(results) == 0:
break
Expand All @@ -106,54 +103,36 @@ def run(self, bgr):
dict_keys(['id', 'rvec', 'tvec', 'distancia', 'corners', 'centro', 'body_center', 'color'])
"""
# 1. Chame a função self.detect_aruco e armazene os resultados em uma variável.
_, results = self.detectaAruco(bgr)

_, results = ...

# 2. Chame a função self.find_creeper para encontrar os creepers na imagem de cada cor.
creepers = []
creepers += self.find_creeper(bgr, "green")
creepers += self.find_creeper(bgr, "blue")
creepers += ...
creepers += ...
creepers += ...

if len(creepers) == 0 or len(results) == 0:
if len(creepers) == 0 or len(results) == 0: # Verifica se não há creepers ou arucos na imagem.
return bgr, []

# 2. Desenvolva a função `match_aruco` para combinar os marcadores Aruco com os corpos dos creepers.
bgr, matched_pairs = self.match_aruco(bgr, creepers, results)
# 3. Desenvolva a função `match_aruco` para combinar os marcadores Aruco com os corpos dos creepers.
bgr, matched_pairs = ...

# 4. Desenha os marcadores Aruco na imagem utilizando a função `drawAruco`.
for result in matched_pairs:
bgr = self.drawAruco(bgr, result)
bgr = ...

return bgr, matched_pairs


def rodar_webcam():
Arucos = DistanceEstimator()
# cap = cv2.VideoCapture(0) # webcam
cap = cv2.VideoCapture('img/aruco.mp4') # Confira se o video esta na pasta img

while True:
ret, bgr = cap.read()
bgr, ranked_arucos = Arucos.run(bgr)

# 10. Imprime a distância e o id do creeper mais próximo da camera.

cv2.imshow("Imagem", bgr)
if cv2.waitKey(1) & 0xFF == ord('q'):
break

def rodar_frame():
Arucos = DistanceEstimator()
def main():
Arucos = CreeperDetector()

# bgr = cv2.imread("img/aruco.jpg")
bgr = cv2.imread("docs/modulos/06-visao-p3/atividades/img/aruco.jpg")
bgr = cv2.imread("img/aruco.jpg")
# bgr = cv2.imread("img/aruco2.jpg")

bgr, ranked_arucos = Arucos.run(bgr)
cv2.imshow("Imagem", bgr)
cv2.waitKey(0)

def main():
# Selecione se deseja rodar seu codigo com uma imagem ou um video:
# rodar_webcam()
rodar_frame()


if __name__ == "__main__":
main()
137 changes: 137 additions & 0 deletions docs/modulos/07-controle/util/creeper_detector_gab.py
Original file line number Diff line number Diff line change
@@ -0,0 +1,137 @@
from robcomp_util.module_aruco import Aruco3d
import cv2
import numpy as np

class CreeperDetector(Aruco3d):
def __init__(self):
Aruco3d.__init__(self)
self.kernel = np.ones((5,5),np.uint8)

self.filters = {
'blue': {
'lower': np.array([100, 50, 50]),
'upper': np.array([140, 255, 255])
},
'green': {
'lower': np.array([40, 50, 20]),
'upper': np.array([80, 255, 255])
},}

def find_creeper(self, bgr: np.ndarray, color: str) -> list:
"""
Encontra o creeper na imagem com base na cor fornecida.
Args:
bgr (numpy.array): imagem no espaço de cor BGR.
color (str): cor do creeper para identificação.
Returns:
list: lista de centros dos creepers detectados e a cor atual. No formato list( [(cx,cy), color], [...]... ).
"""
creepers = []
hsv = cv2.cvtColor(bgr, cv2.COLOR_BGR2HSV)
mask = cv2.inRange(hsv, self.filters[color]['lower'], self.filters[color]['upper'])
mask = cv2.morphologyEx(mask, cv2.MORPH_OPEN, self.kernel)
mask = cv2.morphologyEx(mask, cv2.MORPH_CLOSE, self.kernel)

contours, _ = cv2.findContours(mask, cv2.RETR_EXTERNAL, cv2.CHAIN_APPROX_SIMPLE)
for cnt in contours:
area = cv2.contourArea(cnt)
if area < 1000:
continue
x, y, w, h = cv2.boundingRect(cnt)
cx, cy = x + w//2, y + h//2
creepers.append([(cx, cy), color])

return creepers

def distance(self, x1, x2):
"""
Calcula a distância horizontal entre duas coordenadas.
"""
distance = abs(x1 - x2)
return distance

def match_aruco(self, bgr, creepers, results):
"""
Combina os marcadores Aruco com os creepers mais próximos.
Args:
bgr (numpy.array): imagem no espaço de cor BGR.
creepers (list): lista de centros dos creepers detectados através da função `find_creeper`.
results (list(dicts)): resultados da detecção Aruco.
dict_keys(['id', 'rvec', 'tvec', 'distancia', 'corners', 'centro'])
Returns:
bgr (numpy.array): imagem com linhas desenhadas e pares combinados.
matched_pairs (dict): detecções Aruco combinadas com o centro do "corpo" do creeper mais próximo, na chave "body_center".
e a cor do creeper na chave "color". Remova creepers sem correspondência.
"""
matched_pairs = []
for creeper in creepers:

# 3. Use a função min para ordenar os resultados por distância com base na função self.distance.
closest = min(results, key=lambda x: self.distance(x['centro'][0], creeper[0][0]))

# 4. Remove da lista `results` o aruco mais próximo do corpo `creeper` para evitar que ele seja combinado novamente.
results = [result for result in results if result['distancia'] != closest['distancia']]

# 5. Adiciona na variável o centro do creeper mais próximo na chave "body_center" do dicionário `closest`.
closest['body_center'] = creeper[0]
# 6. Adiciona a cor do creeper mais próximo na chave "color" do dicionário `closest`.
closest['color'] = creeper[1]

# 7. Desenha uma linha entre o centro do creeper e o centro do marcador Aruco.
cv2.line(bgr, tuple(closest['centro']), tuple(closest['body_center']), (0, 0, 255), 2)

# 8. Adiciona o par combinado na lista `matched_pairs`.
matched_pairs.append(closest)

if len(results) == 0:
break

return bgr, matched_pairs

def run(self, bgr):
"""
Executa a detecção de Aruco e correspondência com creepers.
Args:
bgr (numpy.array): imagem no espaço de cor BGR.
Returns:
bgr (numpy.array): imagem no espaço de cor BGR com linhas desenhadas entre Arucos e creepers.
ranked_arucos (list(dicts)): imagem processada e Arucos classificados por distância.
dict_keys(['id', 'rvec', 'tvec', 'distancia', 'corners', 'centro', 'body_center', 'color'])
"""
# 1. Chame a função self.detect_aruco e armazene os resultados em uma variável.
_, results = self.detectaAruco(bgr)

creepers = []
creepers += self.find_creeper(bgr, "green")
creepers += self.find_creeper(bgr, "blue")

if len(creepers) == 0 or len(results) == 0:
return bgr, []

# 2. Desenvolva a função `match_aruco` para combinar os marcadores Aruco com os corpos dos creepers.
bgr, matched_pairs = self.match_aruco(bgr, creepers, results)

for result in matched_pairs:
bgr = self.drawAruco(bgr, result)

return bgr, matched_pairs

def main():
Arucos = CreeperDetector()

bgr = cv2.imread("img/aruco.jpg")
# bgr = cv2.imread("img/aruco2.jpg")

bgr, ranked_arucos = Arucos.run(bgr)
cv2.imshow("Imagem", bgr)
cv2.waitKey(0)


if __name__ == "__main__":
main()

0 comments on commit 4f368f2

Please sign in to comment.