Pose-Parameterized Motion Planning and CBF-QP Self-Collision Filtering for a Long-Reach Drilling Boom

Resumo Técnico: Planejamento de Movimento Parametrizado por Pose e Filtragem de Autocolisão via CBF-QP para um Braço de Perfuração de Longo Alcance

Definição do Problema
Braços de perfuração de longo alcance, como o Sandvik SB60 usado em construção subterrânea e mineração, enfrentam desafios significativos na transição entre poses de perfuração sucessivas sem autocolisão. Embora as máquinas modernas possuam redundância cinemática, a geometria acoplada das hastes longas e das carcaças do braço cria um problema de controle complexo onde trajetórias diretas frequentemente levam à interferência com o transportador ou outros segmentos do braço. Os fluxos de trabalho de produção atuais dependem fortemente da supervisão do operador para monitorar a proximidade e intervir quando colisões são iminentes. Essa dependência limita a autonomia, aumenta os tempos de ciclo e expõe os operadores a riscos em ambientes confinados. Os métodos de automação existentes carecem, frequentemente, de um framework unificado que integre o planejamento parametrizado por pose com uma filtragem de segurança rigorosa e em tempo real, capaz de lidar com as restrições geométricas específicas e limites de junta de manipuladores hidráulicos pesados.

Metodologia
O estudo propõe um framework de execução de malha fechada que integra um planejador geométrico offline com um filtro de segurança baseado em Programação Quadrática de Função de Barreira de Controle (CBF-QP), especificamente adaptado para o manipulador SB60.

1. Geração de Movimento Parametrizada por Pose:

   • O sistema aceita uma sequência de poses de perfuração de 6-DOF. Dentro de cada tarefa, um conjunto de parâmetros fixos gera pontos de passagem (waypoints), desvios e referências temporais sem a necessidade de novo ajuste específico para o alvo.
   • Geração de Referência: Uma lei de tempo polinomial de sétima ordem (séptica) é utilizada para suavizar as transições entre os waypoints. O planejador emprega uma estratégia de elevação $z$ adaptativa e uma cadeia de quatro waypoints (início, escape, ponto médio, objetivo) para garantir alturas de trânsito seguras.
   • Planejador de Desvio Geométrico: Um planejador offline monitora candidatos a trajetórias usando um modelo reduzido composto por 23 distâncias selecionadas entre segmentos de haste e regiões do corpo. Se um segmento corre o risco de violar os limiares de segurança, o planejador gera waypoints de desvio candidatos baseados em gradientes de clareza. Caso os candidatos falhem, um caminho de contingência determinístico com waypoints de trânsito elevados é inserido.

2. Filtro de Segurança CBF-QP de Estado Medido:

   • Modelagem de Colisão: O manipulador é modelado utilizando uma aproximação de nove primitivas de cápsula de corpo inteiro.
   • Restrições Online: O filtro de tempo de execução impõe 14 distâncias de pares de cápsulas configuradas (selecionadas das 9 primitivas) como restrições de desigualdade dentro de um QP. Uma margem de segurança ($d_{safe} = 0,22$ m) é subtraída da distância medida para definir a função de barreira.
   • Formulação do QP: O controlador minimiza uma função de custo composta por erro de rastreamento de 6-DOF, regularização de velocidade, suavização e viés de postura, sujeito a limites de velocidade/aceleração de junta e às desigualdades da CBF. Variáveis de folga (slack variables) são incluídas para penalizar violações de barreira explicitamente, em vez de permitir falhas silenciosas.
   • Escalonamento de Juntas: O método lida com restrições dependentes da tarefa. Na Tarefa 1, juntas específicas (rolamento de avanço e inclinação de bolting) são fixadas a referências programadas pelo procedimento, deixando seis graus de liberdade para otimização. Na Tarefa 2, apenas a inclinação de bolting é fixada, permitindo que o QP regule a orientação completa de 6-DOF usando sete velocidades livres.

3. Driver de Modo de Tour (Tour-Mode Driver):

   • O sistema encadeia múltiplas poses de perfuração em uma sequência autônoma contínua. Ele propaga o estado de junta final de um salto para o início do próximo, inserindo uma pausa de 3 segundos em cada alvo para permitir o assentamento da planta, garantindo um fluxo contínuo de comando de junta sem retornar a uma pose de casa entre os alvos.

Principais Contribuições
O artigo identifica quatro contribuições primárias:

1. Camada de Movimento Específica para o SB60: Um gerador parametrizado por pose que combina elevação adaptativa, encadeamento de waypoints, desvios geométricos e escalonamento de tempo de sétima ordem, reutilizável em todos os alvos de uma tarefa sem novo ajuste.
2. Implementação de CBF-QP de Estado Medido: Um solver de QP de nível de velocidade para o SB60 que impõe 14 restrições de pares de cápsulas derivadas de um modelo de nove primitivas. Isso é distinto do modelo de 23 distâncias do planejador offline, sendo o modelo online o que define o conjunto de segurança real.
3. Ablação de Componentes: Uma análise interna caracterizando a interação entre o planejador offline e o filtro CBF-QP de tempo de execução, isolando seus respectivos papéis na conformação de trajetória versus a aplicação de restrições.
4. Validação Baseada em Modelo: Um estudo abrangente de software-in-the-loop utilizando um modelo Simscape Multibody desenvolvido pelo fabricante, avaliando duas tarefas distintas: um tour de cinco alvos com orientação restrita e um tour de três alvos de 6-DOF total.

Resultos
O framework foi avaliado em um ambiente de simulação de alta fidelidade (Simscape Multibody) com um período de controle de 5 ms.

• Tarefa 1 (Tour de Cinco Alvos com Orientação Restrita):

  • Ao longo de 299.757 amostras de controle (aprox. 1500 segundos), o método completo alcançou zero falhas de IK (cinemática inversa).
  • O sistema gerou 13 waypoints de desvio para navegar em riscos de autocolisão.
  • Precisão de Rastreamento: Erro médio de posição final do salto foi de 4,42 mm; erro de posição RMS foi de 34,08 mm.
  • Segurança: Nenhuma margem de CBF amostrada caiu abaixo dos limiares reportados de -1 mm ou -5 mm. A margem mínima amostrada foi de -2,033 $\mu$m (efetivamente zero dentro da tolerância numérica).
  • Ablação: Remover o CBF-QP de tempo de execução resultou em uma margem mínima de -332,08 mm (colisão). Remover o planejador mantendo o CBF-QP aumentou o erro de posição RMS de 34,08 mm para 39,12 mm, demonstrando o papel do planejador em reduzir a exposição à região de ativação.

• Tarefa 2 (Tour de Três Alvos de 6-DOF Total):

  • Esta tarefa variou todos os seis componentes da pose (posição e orientação).
  • O planejador não detectou segmentos de risco; portanto, nenhum waypoint de desvio foi inserido.
  • Ao longo de 73.731 amostras (aprox. 369 segundos), o sistema alcançou 100% de taxa de passagem de pose simultânea com zero falhas de solver.
  • Precisão de Rastreamento: Erro de posição RMS foi de 1,005 mm; erro de orientação RMS foi de 0,0464°.
  • Segurança: A clareza mínima amostrada foi de 0,251658 m, mantendo uma margem de 31,658 mm acima do limiar de segurança durante todo o trajeto.

Significância e Alegações
O artigo posiciona este trabalho como uma integração de engenharia de componentes estabelecidos (planejamento parametrizado por pose, modelos de colisão de cápsula e filtragem CBF-QP) adaptados especificamente para o ambiente de braço de perfuração hidráulico pesado.

• Distinção de Trabalhos Anteriores: Diferente de métodos anteriores de perfuração baseados em RRT ou Campos de Potencial Artificial (APF) sem camadas de restrição em tempo de execução, esta abordagem mantém uma camada de CBF de execução. Por outro lado, ao contrário do trabalho de CBF para manipuladores gerais, ela se adapta à geometria específica, limites de junta e interface de pose de perfuração encadeada do SB60.
• Alegações Modestas sobre Segurança: Os autores afirmam explicitamente que o resultado de invariância progressiva no tempo contínuo é condicional. Ele depende de suposições como o fato de o QP produzir uma velocidade localmente Lipschitz e a ausência de dinâmicas não modeladas. O estudo não alega uma garantia de segurança incondicional de dados amostrados ou de máquina física. Os resultados são apresentados como "evidência de clareza modelada empírica" baseada no modelo específico de 14 pares de cápsulas e na taxa de amostragem de 5 ms.
• Escopo: Os achados são validados dentro do modelo de cápsula configurado e dos conjuntos de poses específicos utilizados. O artigo observa que o modelo de planejamento de 23 distâncias e o modelo CBF de 14 pares são distintos; satisfazer um não garante a satisfação do outro, e o planejador não define o conjunto seguro online.

O estudo conclui que o framework proposto fornece evidências de viabilidade específicas para aplicações de sequências de perfuração autônomas no SB60, equilibrando com sucesso a geração de trajetória com a prevenção de autocolisão em tempo real em um ambiente simulado. O trabalho futuro é identificado como a avaliação do sistema em hardware físico com controladores de produção.