Bom, finalmente terminei a detecção de objetos no mapa, ainda precisa de muito polimento, ma está bem rápido,
ainda penso que o angulo deve ser maior, porém quero fazer outras coisas, então por enquanto é o suficiente.
Vou começar trabalhar na AI agora.