Dominando Ângulos de Euler para Controle Preciso de Robôs de 6 Eixos
Como a orientação no espaço é representada com ângulos de Euler?
Se você utiliza um braço robótico de seis eixos, como o Meca500 da Mecademic usado neste tutorial como exemplo, provavelmente está interessado em posicionar sua ferramenta (end-effector) em várias orientações. Em outras palavras, você precisa ser capaz de programar seu robô para mover seu end-effector tanto para uma posição desejada QUANTO para uma orientação desejada (ou seja, para um pose desejado). Claro, você pode sempre movimentar manualmente o end-effector do robô ou guiá-lo manualmente até aproximadamente o pose desejado, mas esse chamado método de programação online é tedioso e muito impreciso. É muito mais eficiente calcular e definir seu pose desejado offline. Além disso, para definir o referencial da ferramenta associado ao seu end-effector (como na imagem mostrada aqui), você precisaria calcular o pose desse referencial da ferramenta em relação ao referencial da flange.
No espaço 3D, você precisa de um mínimo de seis parâmetros para definir um pose. Por exemplo, a posição do end-effector do robô, ou mais precisamente do TCP (tool center point), é tipicamente definida como as coordenadas x, y e z da origem do referencial da ferramenta em relação ao referencial mundial. Mas como você então define a orientação no espaço?
A representação da orientação no espaço é uma questão complexa. O teorema da rotação de Euler afirma que, no espaço (3D), qualquer deslocamento de um corpo rígido de forma que um ponto no corpo permaneça fixo é equivalente a uma única rotação em torno de um eixo que passa pelo ponto fixo. Consequentemente, tal rotação pode ser descrita por três parâmetros independentes: dois para descrever o eixo e um para o ângulo de rotação. A orientação no espaço, no entanto, pode ser representada de várias outras maneiras, cada uma com suas próprias vantagens e desvantagens. Algumas dessas representações usam mais do que o mínimo necessário de três parâmetros.
A forma mais comum de transformar coordenadas de posição de um referencial cartesiano (3D), F, para outro, F’, é a matriz de rotação. Esta matriz 3×3 pode, portanto, ser usada para representar a orientação do referencial F’ em relação ao referencial F. No entanto, esta representação, embora frequentemente necessária como veremos mais adiante, não é uma maneira compacta e intuitiva de definir orientação.
Outra forma muito mais compacta de definir orientação é o quaternion. Esta forma de representação consiste em um vetor normalizado de quatro escalares. O quaternion é geralmente usado em controladores de robôs, pois não é apenas mais compacto que a matriz de rotação, mas também menos suscetível a erros de aproximação. Além disso, durante uma interpolação entre duas orientações diferentes, os elementos do quaternion mudam continuamente, evitando as descontinuidades inerentes a parameterizações tridimensionais como ângulos de Euler. No entanto, o quaternion é raramente usado como meio de comunicação entre um usuário e o controlador do robô porque é contra-intuitivo.
Definição detalhada de ângulos de Euler
De longe, a maneira mais comum de comunicar uma orientação no espaço a um usuário, ou permitir que um usuário defina uma orientação, em um software CAD ou em um controlador de robô, é o uso de ângulos de Euler. Como o termo ângulos de Euler é frequentemente mal utilizado, preparamos este tutorial interativo.
Ângulos de Euler são um conjunto (ou melhor, uma sequência) de três ângulos, que podem ser denotados, por exemplo, por α, β e γ. (Muitas vezes, ângulos de Euler são denotados por roll, pitch e yaw.) Ângulos de Euler são definidos da seguinte forma: Considere dois referenciais cartesianos destro 3D, dos quais um será arbitrariamente chamado de referencial fixo e o outro será referido como referencial móvel. Os dois referenciais coincidem inicialmente. Para definir a orientação de um terceiro referencial (todos os três referenciais compartilham a mesma origem), o referencial móvel é levado, na ordem mostrada abaixo, a coincidir com o terceiro referencial rotacionando o referencial móvel
- em torno do eixo x, y ou z do referencial fixo ou do x’, y’ ou z’ do referencial móvel, por α graus,
- em seguida, em torno do eixo x, y ou z do referencial fixo ou do x’, y’ ou z’ do referencial móvel, por β graus,
- e finalmente em torno do eixo x, y ou z do referencial fixo ou do x’, y’ ou z’ do referencial móvel, por γ graus.
A ordem em que as três rotações são realizadas é importante. Assim, temos um total de 216 (63) sequências possíveis: x→y→z, y→y→z, z→y→z, x’→y→z, y’→y→z, z’→y→z, e assim por diante. No entanto, uma sequência de três rotações em que duas rotações consecutivas são em torno do mesmo eixo (ex.: y→y→z) não pode descrever uma orientação geral. Além disso, antes da primeira rotação, x coincide com x‘, y coincide com y‘ e z coincide com z‘. Consequentemente, de todas essas 216 combinações, existem apenas doze sequências ordenadas únicas e significativas de rotações, ou doze convenções de ângulos de Euler: XYX, XYZ, XZX, XZY, YXY, YXZ, YZX, YZY, ZXY, ZXZ, ZYX, ZYZ.
Dito isso, cada uma das doze combinações é equivalente a outras três sequências. Em outras palavras, cada convenção de ângulos de Euler pode ser descrita de quatro maneiras diferentes. Por exemplo, a convenção ZYX é equivalente às sequências z→y→x, x‘→y‘→z‘, y→z‘→x e y→x→z‘. Felizmente, ninguém descreve ângulos de Euler com sequências em que algumas rotações são em torno dos eixos do referencial móvel e outras em torno dos eixos do referencial fixo (ex.: sequências como y→z‘→x e y→x→z‘).
Assim, embora existam doze convenções diferentes de ângulos de Euler, cada uma é tipicamente descrita de duas maneiras diferentes: seja como uma sequência de rotações em torno dos eixos do referencial fixo, seja como uma sequência de rotações em torno dos eixos do referencial móvel. Portanto, pode ser conveniente falar em convenções fixas e móveis, embora sejam equivalentes. Por exemplo, a convenção de ângulos de Euler XYZ fixa é descrita pela sequência x→y→z, enquanto a convenção de ângulos de Euler ZYX móvel é descrita pela sequência z’→y’→x’, mas ambas são equivalentes, como veremos mais adiante.
Na robótica, FANUC e KUKA usam a convenção de ângulos de Euler XYZ fixa, enquanto a ABB usa a convenção de ângulos de Euler ZYX móvel. Além disso, Kawasaki, Omron Adept Technologies e Stäubli usam a convenção de ângulos de Euler ZYZ móvel. Finalmente, os ângulos de Euler usados no CATIA e SolidWorks são descritos pela convenção de ângulos de Euler ZYZ móvel.
Na Mecademic, usamos a convenção de ângulos de Euler XYZ móvel e, portanto, descrevemos ângulos de Euler como a sequência x‘→y‘→z‘. Por que ser diferente? A razão é que costumávamos oferecer uma garra mecânica para manipulação de peças axisimétricas (veja vídeo), que era acionada pelo motor da junta 6. Um robô de seis eixos equipado com tal garra pode controlar apenas dois graus de liberdade rotacionais, ou mais especificamente a direção do eixo da junta 6, ou seja, a direção do eixo de simetria da peça. Na convenção de ângulos de Euler escolhida, os ângulos α e β definem esta direção, enquanto o ângulo γ é ignorado porque corresponde a uma rotação parasita que é incontrolável.
Nosso applet abaixo ajudará você a entender ângulos de Euler. Você pode selecionar uma das doze convenções possíveis de ângulos de Euler clicando nas caixas x, y e z da primeira, segunda e terceira rotação. (A sequência padrão de ângulos de Euler é a usada pela Mecademic.) Para alternar entre rotações em torno dos eixos dos referenciais fixo ou móvel, você precisa dar um duplo clique em qualquer uma dessas nove caixas. Os eixos do referencial fixo são desenhados em cinza, enquanto os eixos do referencial móvel são em preto. Os eixos x e x‘ são desenhados em vermelho, y e y‘ em verde, e z e z‘ em azul. Deslizando ao longo de qualquer uma das três setas horizontais azuis com o mouse, você altera o ângulo de Euler correspondente. Alternativamente, você pode definir diretamente o valor do ângulo de Euler (em graus) na caixa de texto correspondente abaixo da seta. Finalmente, você pode arrastar o mouse sobre o referencial para alterar o ponto de vista.
| α : | β : | γ : |
| R = Rx(0°) Ry(0°) Rz(0°) = |
|
Calculando ângulos de Euler via matrizes de rotação
Com o applet acima, você verá a orientação do referencial móvel em relação ao referencial fixo, para um dado conjunto de ângulos de Euler, no subgráfico à direita. Infelizmente, porém, na prática, a situação costuma ser a oposta. Você frequentemente tem dois referenciais e deseja encontrar os ângulos de Euler que descrevem a orientação de um referencial em relação ao outro.
Para orientações em que pelo menos dois eixos são paralelos, você poderia tentar adivinhar os ângulos de Euler por tentativa e erro. Por exemplo, olhe novamente a imagem no início deste tutorial e tente encontrar os ângulos de Euler usados pela Mecademic que definem a orientação do referencial da ferramenta associado à garra, em relação ao referencial da flange. A resposta é α = −90°, β = 0°, γ = −90°. Não é tão fácil de obter, não é? Para ser mais eficiente, portanto, você deve aprender sobre matrizes de rotação afinal.
Como já mencionamos, qualquer orientação no espaço pode ser representada com uma matriz de rotação 3×3. Por exemplo, uma rotação de α em torno do eixo x, uma rotação de β em torno do eixo y e uma rotação de γ em torno do eixo z, correspondem respectivamente às seguintes três matrizes de rotação básicas:
| Rx(α) = |
|
| Ry(β) = |
|
| Rz(γ) = |
|
Referimo-nos às matrizes acima como matrizes de rotação básicas. Para obter o produto de matrizes de rotação básicas que corresponde a uma sequência de rotações, comece escrevendo a matriz de rotação básica correspondente à primeira rotação. Por exemplo, se a primeira rotação for em torno do eixo x (ou x‘), então escreva Rx(ψ), onde ψ é o ângulo de rotação. Para cada rotação subsequente, pós-multiplique (multiplique à direita) o resultado atual pela próxima matriz de rotação, se a rotação for em torno de um eixo do referencial móvel, ou pré-multiplique (multiplique à esquerda) o resultado atual pela próxima matriz de rotação, se a rotação for em torno de um eixo do referencial fixo. Use nosso applet para ver o produto resultante de matrizes de rotação básicas. Por exemplo, a sequência de rotação x‘→y‘→z‘ corresponde ao produto R = Rx(α)Ry(β)Rz(γ). Assim, a matriz de rotação que corresponde aos ângulos de Euler usados pela Mecademic é:
| R(α, β, γ) = |
|
Portanto, para uma dada orientação, você precisará fazer duas coisas: Primeiro, encontrar a matriz de rotação que corresponde à sua orientação. Segundo, extrair os ângulos de Euler usando algumas equações simples. Vamos primeiro mostrar duas maneiras de encontrar sua matriz de rotação.
Considere o exemplo mostrado na figura abaixo, onde precisamos encontrar a matriz de rotação que representa a orientação do referencial F’ em relação ao referencial F. (Lembre-se de que sempre representamos o eixo x em vermelho, o eixo y em verde e o eixo z em azul.)
Aqui, é fácil ver que se alinharmos um terceiro referencial com F, que atuará como referencial móvel, então rotacionarmos este referencial em torno de seu eixo z‘ a θ graus, e depois rotacioná-lo em torno de seu eixo y‘ a φ graus, obteremos a orientação de F. Assim, a matriz de rotação que procuramos é:
| Rdesejado = Rz(θ)Ry(φ) = |
|
Alternativamente, podemos obter a matriz de rotação acima diretamente. Suas primeira, segunda e terceira colunas representam as coordenadas dos vetores unitários ao longo dos eixos x, y e z, respectivamente, do referencial F’, em relação ao referencial F.
Agora que você tem a matriz de rotação que representa sua orientação desejada, basta resolver o sistema de nove equações trigonométricas escalares Rdesejado = R(α, β, γ), para α, β e γ. Felizmente, este problema tem uma solução genérica e simplesmente lhe daremos as equações a usar.
Seja a orientação desejada de um referencial F’ em relação a um referencial F representada pela seguinte matriz de rotação:
| Rdesejado = |
|
Os ângulos de Euler (em graus), de acordo com a convenção XYZ móvel usada pela Mecademic, são então obtidos de acordo com os seguintes dois casos:
Caso 1: r1,3 ≠ ±1 (ou seja, o eixo z’ do referencial F’ não é paralelo ao eixo x do referencial F).
β = asin(r1,3), γ = atan2(−r1,2, r1,1), α = atan2(−r2,3, r3,3).
Caso 2: r1,3 = ±1 (ou seja, o eixo z’ do referencial F’ é paralelo ao eixo x do referencial F).
β = r1,390°, γ = atan2(r2,1, r2,2), α = 0.
No Caso 1 geral, na verdade temos dois conjuntos de soluções onde todos os ângulos estão no intervalo semi-aberto (−180°, 180°]. No entanto, é inútil calcular ambos os conjuntos de soluções, então apenas o primeiro é apresentado, no qual −90° < β < 90°. Observe também que usamos a função atan2(y, x) em nossa solução. Cuidado: em algumas linguagens de programação, em algumas calculadoras científicas e na maioria dos softwares de planilha, os argumentos desta função são invertidos.
Finalmente, note que o Caso 2 corresponde a uma chamada singularidade de representação. Esta singularidade está presente em qualquer representação de três parâmetros de orientação no espaço 3D (não apenas na escolha de ângulos de Euler da Mecademic). É semelhante ao problema de representar pontos em uma esfera por apenas dois parâmetros. Por exemplo, a longitude não é definida na Terra nos Polos Sul e Norte. Em outras palavras, esta singularidade não tem nada a ver com as singularidades de mecanismos (ex.: o chamado gimbal lock), que correspondem a problemas físicos reais (ex.: a perda de um grau de liberdade).
Exercício
Considere a seguinte situação real que ocorreu conosco. Queríamos acoplar uma válvula dispensadora FISNAR ao end-effector do nosso braço robótico Meca500. Naturalmente, o engenheiro que projetou e usinou o adaptador não se importava com ângulos de Euler e estava apenas preocupado com usinabilidade e alcance. Em seu projeto, havia essencialmente duas rotações de 45°. Primeiro, ele usou dois furos roscados diametralmente opostos na flange do robô para fixar o adaptador, o que causou a primeira rotação de 45°. Em segundo lugar, o ângulo entre o plano de interface da flange e o eixo do dispensador era de 45°.
A figura acima mostra a instalação real (esquerda) e o referencial da ferramenta (direita) que precisava ser definido. Observe que ao usar ferramentas axisimétricas, é prática comum alinhar o eixo z da ferramenta com o eixo da ferramenta. Isso é particularmente útil com a convenção de ângulos de Euler XYZ móvel, pois a rotação redundante em torno da ferramenta axisimétrica corresponde ao terceiro ângulo de Euler, γ. Assim, os dois primeiros ângulos de Euler definem o eixo da ferramenta, enquanto o terceiro pode ser usado para escolher a configuração ótima do robô (ou seja, longe de singularidades).
Voltando ao nosso exemplo, mostraremos agora que é impossível chegar aos ângulos de Euler de acordo com a convenção XYZ móvel por tentativa e erro. De fato, para esta escolha de referencial da ferramenta, podemos representar a orientação final como uma sequência das seguintes duas rotações: R = Rz(45°)Ry(45°). A partir daí, podemos extrair os ângulos de Euler de acordo com a convenção XYZ móvel usando as equações descritas anteriormente e obter: α = −35.264°, β = 30.000°, γ = 54.735°. Você está convencido agora de que precisa dominar ângulos de Euler para situações como esta?
Singularidades de representação e erros de orientação
No caso da convenção de ângulos de Euler XYZ móvel, se o eixo z’ do referencial F’ for paralelo ao eixo x do referencial F, existem infinitos pares de α e γ que definirão a mesma orientação. Obviamente, você só precisa de um para definir sua orientação desejada, então definimos arbitrariamente α como igual a zero. Mais especificamente, se β = 90°, então qualquer combinação de α e γ, tal que α + γ = φ, onde φ é qualquer valor, corresponderá à mesma orientação e será emitida pelo controlador da Mecademic como {0,90°,φ}. Da mesma forma, se β = −90°, então qualquer combinação de α e γ, tal que α − γ = φ, onde φ é qualquer valor, corresponderá à mesma orientação e será emitida pelo controlador da Mecademic como {0,−90°,−φ}. Note, no entanto, que se você tentar representar a orientação de um referencial F’ em relação a um referencial F e o eixo z’ do referencial F’ estiver quase paralelo ao eixo x do referencial F (ou seja, β está muito próximo de ±90°), os ângulos de Euler serão muito sensíveis a erros numéricos. Em tal caso, você deve inserir o máximo de dígitos após o ponto decimal possível ao definir a orientação usando ângulos de Euler.
Considere a seguinte situação que causou preocupação a vários usuários do nosso Meca500. Você define a orientação do referencial da ferramenta em relação ao referencial mundial como {0°, 90°, 0°}, que é uma singularidade de representação. Então você mantém esta orientação e move o end-effector no espaço para várias posições. Em algumas posições, devido a ruído numérico, o controlador não detecta a condição r1,3 = ±1 (Caso 2, como mencionado acima) e calcula os ângulos de Euler como se a orientação não correspondesse a uma singularidade de representação. Assim, o controlador retorna algo como {41.345°, 90.001°, −41.345°}, que parece totalmente errado e muito distante de {0°, 90°, 0°}. Bem, não é.
Diferente de erros de posição, que são medidos como √(Δx2 + Δy2 + Δz2), erros de orientação não estão diretamente relacionados com variações nos ângulos de Euler, especialmente perto de singularidades de representação. Para entender melhor esta chamada natureza não euclidiana dos ângulos de Euler, considere as coordenadas esféricas usadas para representar uma localização na Terra. No Polo Norte, a latitude é 90° (Norte), mas qual é a longitude? A longitude não é definida no Polo Norte, ou pode ser qualquer valor. Agora imagine que nos movemos apenas 1 mm para longe do Polo Norte na direção de Greenwich. Neste caso, a latitude será 89.99999999°, mas a longitude agora terá o valor de 0°. Imagine mais uma vez que você retorna ao Polo Norte e se move 1 mm na direção de Tóquio. A nova longitude será aproximadamente 140°. Entre suas duas localizações, o erro em longitude é 140°! No entanto, o erro angular real será aproximadamente 0.00000002°.
A situação descrita acima é semelhante em todas as outras convenções de ângulos de Euler. Dependendo da convenção de ângulos de Euler, a singularidade de representação correspondente ocorre quando um eixo específico do referencial F’ é paralelo a outro eixo específico do referencial F. Em tal singularidade de representação, a primeira e a terceira rotações tornam-se dependentes.
Em conclusão, a menos que você domine ângulos de Euler (ou use software avançado de programação offline), e mais especificamente a convenção usada para programar seu robô, você dificilmente conseguirá programar algo além de operações simples de pick and place. Como a robótica não é simples, fazemos o nosso melhor para ajudá-lo a entender o básico.
Sistema de controle de automação
- Sepro Expande Linha de Robôs de Seis Eixos com Novos Modelos Compactos para Moldagem por Injeção
- NPE 2018: Robôs Mais Rápidos, Inteligentes e Colaborativos
- Robô Empunhando Pincel da Star Automation Brilha na NPE2018
- Maximizando Eficiência: Célula de Injeção Multi-Robô Produz Copo Shaker Completo em Um Ciclo
- igus Inc. Revela Robô de Montagem de Baixo Custo e Alta Velocidade com Precisão de ±0,5 mm
- Schunk Expande Montagem de Garras Robóticas nos EUA em Morrisville, NC, Impulsionando Produção Local e Personalização
- Automatizando Moldagem por Injeção: Insights de Especialistas e Tendências Emergentes
- Wittmann Battenfeld Lança Linha de Robôs WX153 para Automação de Injeção de Alta Força
- Universal Robots Nomeia Kim Povlsen Presidente para Fortalecer Liderança Dinamarquesa em Robótica
- GP4: Robô Compacto de 6 Eixos da Yaskawa para Automação Ultra-Rápida e Precisa