Robótica Inteligente

Transcrição

1 Robótica Inteligente Módulos Funcionais de um (hipotético) Robô Móvel Inteligente: Módulos Funcionais relacionados com o Controlo

2 Módulos da Arquitectura de controlo hipotética Objectivos essenciais na Navegação. Funções para responder a: Para onde ir? Por onde ir? Onde estive? Onde estou? Módulos Funcionais relacionados com a Navegação

3 Navegação envolve: Percepção Acção Planeamento Representação Arquitectura de controlo Hardware Eficiência computacional Resolução de Problemas O Planeamento clássico assume: sensores sem erros e robô com capacidade de localização Planeamento de caminhos (Navegação) lida com ruido, incertezas, mapeamento

4 Tipos de algoritmos para planeamento do Movimento: A- Decomposição celular: espaço contínuo dividido em um número finito de células levando a uma pesquisa discreta. B- Esqueletização: calcular um esqueleto unidimensional do espaço (uma linha) C- Navegação baseada em marcos: assume a existência de regiões onde o robô pode ser localizado através de marcos fixos. Fora delas terá apenas uma orientação. D- Algorítmos em-linha : assumem o desconhecimento completo do ambiente

5 A- Decomposição celular: espaço contínuo dividido em um número finito de células levando a uma pesquisa discreta. Memória Espacial: Representação do Mundo para o Robô Processa e representa a informação sensorial Infere informação relevante para a Navegação Funções ligadas à Memória Espacial: atenção ao que procurar raciocinar sobre hipóteses (Pode atravessar esta porta?) planear para encontrar o melhor caminho coligir nova informação

6 Memória Espacial Quantitativa: Espaço em termos de distâncias físicas Perspectiva independente (de cima) Pode gerar memória espacial qualitativa Memória Espacial Qualitativa: Espaço em termos de ligações entre marcas Perspectiva do robô

7 Na determinação de caminhos é importante: decompor o caminho em partes entre pontos intermédios aproximar ao melhor caminho como representar o conhecimento qual o algoritmo Espaço de configuração: permite representar localização e orientação do Robô e dos Objectos assume-se: robô redondo, 2 graus de liberdade, holonómico (pode rodar sobre um eixo) crescimento dos obstáculos de acordo com a largura do robô. Robô transforma-se num ponto sem dimensões

8 Posição final Robô Objectos aumentados sição inicial Robô

9 Robô considerado como um ponto Objectos aumentados

10 Exemplos de representações de Configurações de Espaço A- Decomposição celular: espaço contínuo dividido em um número finito de células levando a uma pesquisa discreta. 1- Dividir o espaço livre E em regiões simples (ex: rectangulares) contíguas; 2- Determinar que células são adjacentes a outras e construir um grafo de adjacências; Os vértices do grafo são as células; arcos juntam nós correspondentes a células contíguas; 3- Pesquisar um caminho entre os nós (células) início e objectivo; 4- da sequência de células encontrada para o caminho, compute trajectos dentro de cada célula de um ponto na fronteira com a célula anterior até à fronteira com a próxima célula;

11 A- Decomposição celular: espaço contínuo dividido em um número finito de células levando a uma pesquisa discreta. 1- Dividir o espaço livre E em regiões simples (ex: rectangulares) contíguas;

12 Células simples (rectangulares) Ligar as fronteiras de cada célula por um segmento de recta A Decomposição celular não é exacta. Podem ligar-se os centroides de cada célula O algoritmo pode ir variando a largura das células de forma adaptativa Algoritmo seguro mas não completo (pode não encontrar a solução) Admitindo as células sempre livres o algoritmo é completo (propõe sempre uma solução) Mas não é seguro ( a solução pode não ser viável).

13 Numa decomposição celular exacta, as células tem fronteiras que são os próprios Obstáculos. As células tem fronteiras curvas (células cilindricas) nos topos mas deve manter-se recta nos lados. A largura dos cilindros não é fixa. Encontram-se pontos críticos para ajudar a decomposição. Pontos críticos são aqueles cuja fronteira (do obstáculo) é vertical Fazendo varrer uma linha vertical pelo espaço, pontos críticos são aqueles onde essa linha se parte ou onde dois segmentos dela, antes partidos, se juntam de novo

14 Decomposição cilindrica do espaço. Existem aqui 9 cilindros:

15 O Algorítmo A* é um bom candidato para calcular o melhor caminho em um espaç de representação conhecida. Pode gerar-se também o Plano global e depois tentar ultrapassar localmente Obstáculos imprevistos. São algoritmos Completos mas gerando passos sub-óptimos Pode-se também replanear o Plano global sempre que, durante a execução nova Informação aparece que contradiz a anterior. Estes algoritmos de replaneamento podem ser custosos em tempo. A representação do espaço com quadtrees pode dar mais alguma eficiência pois representa melhor o espaço livre e os obstáculos.

16 Algoritmo D* Seja um Robô com sensores e com um Mapa que pode ser incompleto ou impreciso O Algorítmo D* (Dynamic A*) também faz pesquisa em grafo mas admite constan replaneamento à medida que nova informação vai chegando ao Robô. Os nodos do grafo são estados (localizações do Robô) ligados por arcos etiquetad com custos. Custos podem ser distâncias, tempo, riscos, gastos de energia... Tais custos podem ser reavaliados à medida que o robô vai progredindo no espaço O algoritmo pode ser usado com grafos de visibilidade ou representação por grelh D* produz caminhos óptimos em ambientes dinâmicos. Incorpora conhecimento do ambiente em tempo-real. Replaneia quando algo inesperado é detectado

17 Algoritmo D* Cada estado (nó) X, excepto G, tem um apontador para um estado seguinte Y, b(x)=y D* usa estes apontadores para representar o caminho para o Objectivo G. Os arcos tem um custo c(x,y) (que pode estar indefinido). Existindo c(x,y) ou c(y,x) dois nós X e Y são considerados vizinhos. Como no A*, o D* mantém uma LISTA ABERTA (LA) de nós que vão ser analisado e que serve para propagar os custos. Os nós tem uma etiqueta t(x) t(x)=novo se X nunca pertenceu à Lista Aberta t(x)= Aberto se X pertence à Lista Aberta t(x)= Fechado se X já não pertence à Lista Aberta Para cada nó X, D* mantém uma estimativa do custo de X até G h(g,x).

18 Algoritmo D* Para cada nó X na Lista Aberta a função Chave k(g,x) guarda o mínimo dos custo estimados de X a G desde o inícial h(g,x) até ao presente. Os nós são classificados como: AUMENTADOS se k(g,x) < h(g,x) ou BAIXADOS se k(g,x) = h(g,x) D* usa os nós AUMENTADOS da Lista Aberta para propagar os aumentos no cust e os BAIXADOS para propagar as reduções de custo do caminho. Sempre que um Nó é retirado da Lista Aberta ele é expandido e os custos são propagados para os seus vizinhos os quais são colocados na Lista Aberta. Estados (nós) com etiqueta ABERTO, na Lista Aberta estão ordenados de acordo com os valores da função chave.

19 Algoritmo D* Todos os passos com custo inferior ou igual a min(k(x)) são óptimos Kold = Kmin antes da mais recente extracção de um nó da LA D* guarda sequências {G,Xi} de nós correspondentes a passos monótonos (i de 1 a N): Se nós FECHADOS (t( Xi)=FECHADO) Então h(g,xi) < h(g,xi+1) Se nós ABERTOS (t(xi)=aberto) Então k(g,xi) < h(g,xi+1)

20 Algoritmo D* Simplificando f(x) =f(g,x) e {X} ={G,X} Algoritmo D* é basicamente constitudo por 2 funções: Processar_Estado: Computa o passo óptimo para o objectivo Modificar_Custos: altera os custos dos arcos e dá entrada aos nós afectados na Lista Aberta Inicialmente: todos os nós são etiquetados como NOVO, h(g)=0 G vai para a Lista Aberta A função Processar_Estado é chamada recursivamente até o nó X estar fora da Lista Aberta, i.e. t(x)=fechado ou retorna -1 (sequência X computada ou não existe)

21 Algoritmo D* O robô segue os apontadores até: chegar ao Objectivo G ou encontrar erro no custo do Arco (obstáculo não previsto). A função Modifica_Custo é então chamada para: alterar o custo e colocar os nós (estados) afectados na Lista Aberta. Sendo Y o nó onde seja encontrado um erro na função de custo: Chamando Processa_Estado até: Kmin >= h(y) as modificações no custo são propagadas ao estado Y tal que: h(y)=o(y) (mínimo Custo). Construiu-se assim a nova sequencia {Y} e o Robô continua a dirigir-se para o Objectivo

22 Algoritmo D* Função: PROCESSA-ESTADO () L1 X =MIN STATE( ) {retorna nó da LA com menor K} L2 if X NULL then return -1 {NO-VAL} L3 kold =GET -KMIN () ; DELETE (X ) {retorna Kmin da LA ou -1 se vazia} {apaga X da LA e faz t(x)=closed} L4 if kold < h (X ) then L5 for each neighbor Y of X: L6 if t(y)=/= NEW and h(y) =< Kold and h(x)>h(y)+c(y,x) then L7 b(x)=y; h(x)=h(y)+c(y,x) L8 if Kold = h(x) then L9 for each neighbor Y of X: L10 if t(y)=new or L11 ( b(y)=x and h(y)=/= h(x)+c(x,y) ) or L12 ( b(y) =/=X and h(y) > h(x)+c(x,y) ) then L13 b(y) = X; I NSERT(Y, h(x)+c(x,y) ) {Y passa a apontar para X}

23 Algoritmo D* L14 else L15 for each Y neighbor of X : {Propagar mudanças de Custos para E NEW e descendentes imediatos tal como para E BAIXADOS} L16 if t(y)=new or L17 (b(y)=x and h(y)=/=h(x)+c(x,y)) then L18 b(y) =X ; INSERT(Y,h(X) + c(x,y) ); {Insert(X,hnew) Calcula k(x)=hnew se t(x)=new, k(x)=min(h(x), hnew) se t(x)=open e k(x)=min(h(x),hnew) se t(x)=closed. Ainda faz h(x)=hnew e t(x)=open recolocando X na posição correcta da LA ordenada pelos k} L19 else {t(y)=/=new estados não descendentes imediatos} L20 if b(y)=/=x and h(y)>h(x)+c(x,y) and t(x)=closed then L21 INSERT(X, h(x)) {na LA para posterior expansão} L22 else { passo de X pode ser reduzido por um vizinho, este vai para LA} L23 if b(y)=/=x and h(x) > h(y) + c(y,x) and L24 t(y)=closed and h(y) > Kold then L25 INSERT(Y, h(y)) L26 return GET-KMIN {retorna Kmin da LA ou -1 se vazia}

24 Algoritmo D* Na Função Modifica_Custos a função do custo do arco é alterada com o novo valor. Como alteração do custo de Y altera também o custo do caminho de X, X vai para a LA. Quando X é expandido com Processa_Estado, calcula um novo h(y)=h(x)+c(x,y) e coloca Y na LA. Expansões dos nós subsequentes propagam o custo para os descendentes de Y Função: MODIFICA_CUSTOS (X, Y, cval) L1 c ( X,Y ) = cval L2 if t(x)= CLOSED then INSERT (X, h(x)) L3 return GET-KMIN( )

25 Algoritmo D* O papel dos estados: AUMENTADOS (k(x)<h(x) ) ou BAIXADOS (k(x) = h(x) ) é essencial no algoritmo. Estados AUMENTADOS propagam aumentos de custos e BAIXADOS propagam redução de custos. Quando o custo de um arco é aumentado, o estado vizinho afectado vai para a LA e o custo propagado via estados AUMENTADOS em todas as sequencias de estados contendo o arco. Quando os estados AUMENTADOS ficam em contacto com Nós vizinhos de custo inferior, estes estados BAIXADOS vão para a LA e fazem diminuir os custos dos estados anteriormente aumentados. Se o custo de atravessar um arco decresce, a redução é propagada via nós BAIXADOS através das sequências contendo o arco e dos estados vizinhos que podem ser decrementados.

26 Algoritmo D* Função MOVE_ROBOT(S,G) L1 for each state X in the Graph {Nós colocados na LA e h(g)=0;g na LA} L2 t(x)=new L3 INSERT(G,O) L4 val=0 L5 while t(s)=/=closed and val=/=no_val {computar o caminho inicial ou não existe caminho} L6 val=process_state( ) L7 if t(s)=new then return NO_PATH {nenhum arco para o G} L8 R=S {segue os apontadores até G ou descobre discrepância, L10 L11} L9 while R=/=G L10 for each (X,Y) such that s(x,y)=/=c(x,y) {c(x,y) custo anterior} L11 val=modify_cost(x,y,s(x,y) ) {s medido por sensor} L12 while LESS(val,COST(R) ) and val=/=no_val {até val>=h(r)} L13 val=process_state( ) L14 R=b(R) L15 return GOAL_REACHED {G atingido ou NO_PATH}

27 Algoritmo D* Existe uma melhoria ao algoritmo D* : Algoritmo D* Focalizado. Referências para estes algoritmos com exemplos de aplicação: Optimal and Efficient Path Planning for Partially-Known Environments Anthony Stentz The Robotics Institute; Carnegie Mellon University; Pittsburgh The D* Algorithm for Real-Time Planning of Optimal Traverses Anthony Stenz CMU-RI-TR The Robotics Institute; Carnegie Mellon University; Pittsburgh

28 B-Esqueletização: Em vez de decompôr em células esqueletiza o espaço numa linha que será o possível trajecto nesse espaço. A descrição do espaço livre é minimalista. - Se S é um esqueleto do espaço livre E, então S deve ser uma única linha em cada região conectada de E - para cada ponto p de E deve ser fácil computar um caminho para o esqueleto Exemplos de Métodos de esqueletização no espaço 2D: B.1 Grafo de Visibilidade B.2 Diagramas de Voronoi (B.3 Roteiros)

29 Esqueletização: B.1 Grafo de Visibilidade Para uma configuração poligonal do espaço, o Grafo de Visibilidade consiste rcos ligando todos os pares de vértices que se podem ver um ao outro. xiste portanto um segmento de recta entre eles que não intersecta qualquer stáculo.

30 Esqueletização: B.2 Diagramas de Voronoi ra cada ponto do espaço livre calcula-se a distância para o obstáculo mais próximo ssa distância é vista como uma função altitude que tem o valor zero nto dos obstáculos (zero também nas margens). terreno passa a ter a sua curva de nível mais elevada (a única desenhada) ssando pelos pontos equidistantes dos obstáculos. algoritmo é completo: Havendo um passo em E implica a existência do diagrama Voronoi. No entanto esse trajecto não é, normalmente, o passo mais curto.

31 Esqueletização: B.2 Diagramas de Voronoi

32 Navegação baseada em Marcos: Navegação do Robô Aqui a navegação depende das percepções recebidas através de ensores. Ambiente contém marcos modelados como pontos com um campo de influência rcular. entro de cada campo de influência o robô pode conhecer a sua exacta posição. odem sêr código de barras lidos pelo robô). robô pode estimar distancia e ângulo para o marco. mbora os marcos no espaço sejam conhecidos em tempo de planeamento, a posição robô só é conhecida em tempo de execução.

33 Navegação baseada em Marcos: Navegação do Robô O planeamento do trajecto é feito em encadeamento inverso a partir do objectivo Faz-se a retro-projecção do campo de influência do objectivo em relação ao mando de velocidade V. Isto quer dizer que se o robô inicia o seu deslocamento em qualquer nto do cone de retro-projecção e aplica o comando de velocidade V1 ele atinge o Objectivo. e esse cone intersecta o campo de influência de outro marco, uma vez nesse campo o bô pode navegar para a sua intersecção com o cone. claro que deve pesquisar várias possibilidades para comandos Velocidade CVi tais que os con retro-projecção intersectem outros os outros campos de influência circulares.

34 Navegação baseada em Marcos: tro-projecção do objectivo com respeito a Vi CV1 CV2 operação