Cinemática de braços robóticos: do PWM à cinemática inversa

A cinemática de braços robóticos é a geometria que conecta duas coisas que um manipulador precisa conciliar: os ângulos das juntas que ele realmente pode comandar e a posição da ferramenta que você quer no mundo. Ir em um sentido — dos ângulos para a posição — é cinemática direta, e é fácil. Ir no sentido inverso — da posição para os ângulos — é cinemática inversa, e é onde ficam os problemas interessantes: duas soluções, limites que não consegue alcançar e poses em que o braço perde brevemente o controle de uma direção.

Esta trilha constrói essa compreensão desde o início. Comece pelo equipamento físico — fazer um servo se mover até um ângulo comandado por meio de um driver PCA9685, com toda a calibração. Depois, aprenda a geometria: como os ângulos de um braço de dois elos posicionam a ferramenta e como inverter esse cálculo para alcançar um alvo. Por fim, explore tudo ao vivo no simulador, arrastando um alvo e vendo o solucionador escolher ângulos de juntas, atingir o limite do espaço de trabalho e sinalizar o ponto inalcançável.

Siga os nós em ordem — cada um libera o próximo depois de concluído, e seu progresso fica salvo neste dispositivo. Quando estiver pronto para construir a versão real, esta trilha desemboca diretamente no projeto de braço robótico de 4 graus de liberdade.

Antes de começar

Você precisa de trigonometria — especificamente sin, cos e atan2 — e de programação suficiente para escrever uma função que retorne dois valores. Experiência com servo ajuda, mas a trilha cobre o básico. Nada aqui exige o braço físico; toda a geometria pode ser aprendida no simulador.

O que você será capaz de fazer

• Calcular onde está a ferramenta de um braço de dois elos a partir dos ângulos das juntas e inverter o cálculo para encontrar os ângulos que alcançam um ponto.
• Escolher conscientemente entre as duas soluções: cotovelo para cima e para baixo, em vez de aceitar qualquer uma que a matemática tenha retornado.
• Prever o limite do espaço de trabalho alcançável e detectar um alvo fora dele antes de o braço tentar se mover.
• Reconhecer uma singularidade quando o braço se aproxima da extensão total, onde uma pequena alteração na posição da ferramenta exige uma mudança enorme no ângulo da junta.
• Medir a folga das suas próprias juntas e dizer quanto do erro da garra vem do mecanismo, não da matemática.

Onde as pessoas costumam travar

Usar atan em vez de atan2. O atan comum não sabe em qual quadrante o alvo está, então o braço alcança corretamente à frente e se espelha para trás. O atan2 recebe as duas componentes separadamente e trata corretamente os quatro quadrantes.

Um erro de domínio em acos. Quando o alvo está mais longe do que os elos alcançam, a lei dos cossenos produz um argumento fora do intervalo de −1 a 1 e acos retorna NaN. Esse NaN segue para o comando do servo como um ângulo inválido. Verifique a alcançabilidade antes da trigonometria, não depois.

Confundir o ângulo da junta com o ângulo do servo. O zero de um servo fica onde o braço foi montado, e ele pode girar no sentido oposto ao da sua matemática. Cada junta precisa de uma calibração de deslocamento e talvez de uma inversão de sinal. Omitir isso produz um braço que se move com suavidade e termina longe do alvo.

Ignorar a gravidade na extensão. A geometria presume que o braço vá para onde é mandado. Um servo de projeto mantendo um elo totalmente estendido está na pior vantagem mecânica, e a posição real cede abaixo da comandada — de forma mais visível no limite do espaço de trabalho.

Ajustar um erro mecânico. Se o braço alcança o mesmo ponto de maneira diferente conforme o lado de aproximação, nenhum ganho corrigirá isso: é folga do conjunto de engrenagens, multiplicada por todo o comprimento do braço. Quatro graus no ombro, acionando um elo de 150 mm, produzem mais de 10 mm na garra.

Atravessar uma singularidade. Perto da extensão total, a solução inversa fica mal condicionada, e um caminho suave da ferramenta se transforma em um movimento brusco das juntas. Mantenha os caminhos dentro de uma margem do limite, sem encostar nele.

O que você precisa

Por que a trilha segue esta ordem

O acionamento dos servos vem antes da geometria, e não é óbvio que deveria. O motivo é a calibração. Depois que você pode comandar uma junta e ver onde ela realmente chega, tem uma forma de testar cada resultado posterior contra a realidade. Se aprender a geometria primeiro, não terá como distinguir um solucionador errado de um braço de servo mal montado — duas falhas muito diferentes que parecem idênticas de longe.

Os tipos de braço vêm em seguida porque explicam o que é um “elo”. Braços cartesianos, SCARA e delta resolvem o mesmo problema com geometrias completamente diferentes, e ver três deles deixa claro que a cinemática diz respeito ao arranjo das juntas, não a um braço específico. Isso também explica por que a IK de um SCARA é quase trivial e a de um delta não é.

A cinemática inversa vem em terceiro, quando ambos os pré-requisitos estão prontos. Ela é o coração da trilha e o único nó em que você vai passar tempo real com matemática.

O simulador vem em quarto porque torna visível o que é invisível. A alcançabilidade, os dois ramos de cotovelo e as singularidades são coisas que você pode provar no papel, mas não compreende de fato até arrastar um alvo até o limite do espaço de trabalho e ver o comportamento do solucionador mudar. Arrastar também é a forma mais rápida de encontrar o formato do espaço de trabalho, que é um anel, não um disco, sempre que os elos têm comprimentos diferentes.

A folga mecânica encerra a trilha de propósito. É o ponto em que deixa de ser possível melhorar a precisão do braço com matemática melhor. Cada nó anterior trata de calcular o ângulo certo; este trata dos milímetros entre o ângulo certo e a posição certa.

Pontos de verificação: como saber que uma etapa foi dominada

Onde esta trilha termina

Esta trilha cobre a solução planar de dois elos resolvida em forma fechada — a geometria por trás do ombro e do cotovelo de quase todo braço de projeto. É o certo para aprender primeiro porque você pode deduzi-la, verificá-la e entender exatamente por que cada falha acontece.

Ela termina antes de vários assuntos que você encontrará a seguir. A cinemática geral de n GDL usa parâmetros de Denavit–Hartenberg e matrizes de transformação homogênea para descrever sistematicamente qualquer cadeia de juntas, em vez de resolver a geometria de cada braço à mão. A IK numérica — iteração baseada no Jacobiano — é usada quando não existe solução em forma fechada, a situação normal depois de quatro ou cinco juntas; ela também degrada de forma controlada perto de singularidades, onde a solução em forma fechada simplesmente falha.

A resolução de redundância é a pergunta sobre o que fazer quando um braço tem mais juntas do que a tarefa restringe e, portanto, infinitas soluções válidas — um problema realmente interessante que esta trilha nunca precisa enfrentar, porque um braço de dois elos tem exatamente duas.

E a dinâmica é toda a outra metade da manipulação: a cinemática não diz nada sobre forças, inércia ou a velocidade com que uma junta pode se mover sem ultrapassagem. Tudo aqui pressupõe que o braço vá para onde é mandado, devagar o bastante para que essa hipótese se mantenha.