Decisao desvio » Histórico » Revisão 9
Revisão 8 (Ebert Melo, 24/08/2021 13:37 h) → Revisão 9/11 (Ebert Melo, 27/08/2021 19:08 h)
h1. Decisao desvio É apenas uma função criada para fins de teste e retorna sempre 1 (Girar para a esquerda). Porém, encontra-se implementada no arquivo turn.py com o nome rotate(). O objetivo da função rotate() é retornar o lado que o robô deve girar para desviar do obstáculo: 1 para a esquerda, 2 para a direita e 0 para continuar andando. Para isso, calcula-se as distâncias do objeto até as bordas e os ângulos de inclinação das retas, e então analisa-se 3 situações: se alguma das distâncias for maior que uma distância mínima d_min para ultrapassá-lo, se uma das retas tiver ângulo agudo maior do que o da outra acrescido de 10º, e se alguma das distâncias for maior que a outra. Primeiramente, a função obtém a imagem tirada pela câmera, por meio da biblioteca picamera, e a salva no path '/home/pi/image.jpg'. Depois, duas funções são chamadas: xy() e edge(). A primeira utiliza a imagem salva para detectar o obstáculo e retornar as coordenadas (x,y) do centro do objeto. Já a segunda, utiliza a imagem para detectar as bordas laterais mais internas à pista e retornar seus coeficientes de reta em forma de lista (1º termo é o coef. angular e o 2º, coef. linear), junto de um valor j, sendo j = 1 para linha central (as duas bordas foram detectadas), central, j = 2 para apenas a borda da direita, j = 3 para apenas a borda da esquerda e j = 0 para nenhuma borda detectada. Se o retorno da função xy() for (0,0), então o robô não detectou obstáculo e retorna 0 (Andar). Caso contrário, analisa-se o valor de j: para j = 1, faz-se a análise das duas bordas, enquanto que para j=2 ou j=3, faz a análise de uma só borda. Antes de prosseguir, é preciso saber que as coordenadas cartesianas utilizadas são diferentes das usuais: o eixo y é invertido de forma que o ponto (0,0) está no canto superior esquerdo da imagem. Então, é feita uma mudança de eixos (x', y') = (y, x) em ambas as retas, de modo que trocar os eixos é equivalente a girar o gráfico 90º à esquerda, transformando-o nos eixos cartesianos usuais. !mudança_de_eixos.png! Em seguida, é calculado x_linha_left e x_linha_right colocando o valor de x' como y do centro nas equações das retas depois de convertidas nos eixos x' e y'. |x - x_linha_left| = d_left e |x - x_linha_right| = d_right , serão as distâncias das bordas laterais até o centro do obstáculo. !d_left-d_right.png! Também é calculado os ângulos agudos de inclinação das retas (ang_left e ang_right) usando a função math.atan() !ang_left-ang_right.png! Depois, os casos são separados para cada valor de j. * j = 1 (duas bordas detectadas): 1: ** Um dos ângulos é maior que o outro acrescido de 10º: *** A distância da reta até o objeto é maior que d_min: retorna tal lado. *** Caso contrário: O outro lado é escolhido ** Os ângulos não são discrepantes um do outro: *** Ambos os lados são maiores que d_min: retorna o lado de maior distância até o objeto *** Apenas um dos lados é maior que d_min: retorna o lado em que a distância é maior que d_min *** Caso contrário: retorna o lado de maior distância até o objeto * j = 2 ou j = 3 (apenas uma borda foi detectada): 3: ** A distância calculada para o lado é maior que d_min: retorna tal lado. ** Caso contrário: retorna o outro lado. *j = 0 (nenhuma borda detectada): **Não há nada escrito para este caso. Seria bom implementar algo para evitar bugs.