Cinemática de brazos robóticos: de PWM a cinemática inversa
Podrá posicionar un brazo servocontrolado en coordenadas cartesianas arbitrarias, dominando cinemática directa, inversa y singularidades antes de fabricar.
La cinemática de brazos robóticos es la geometría que conecta dos cosas que un manipulador tiene que conciliar: los ángulos articulares que realmente puede mandar, y la posición de la herramienta que usted quiere en el mundo. Ir en un sentido —de ángulos a posición— es cinemática directa, y es fácil. Ir en el otro —de posición a ángulos— es cinemática inversa, y es donde viven los problemas interesantes: dos soluciones, bordes que no puede alcanzar, y posturas donde el brazo pierde brevemente el control de una dirección.
Esta ruta construye esa comprensión desde la base. Empieza por el hardware: conseguir que un servo se mueva a un ángulo comandado a través de un driver PCA9685, con calibración y todo. Después aprende la geometría: cómo los ángulos de un brazo de dos eslabones colocan su herramienta, y cómo invertir eso para alcanzar un objetivo. Por último lo explora en vivo en el simulador, arrastrando un objetivo y viendo cómo el solucionador elige ángulos articulares, choca con el borde del espacio de trabajo y marca lo inalcanzable.
Siga los nodos en orden: cada uno desbloquea el siguiente una vez completado, y su progreso se guarda en este dispositivo. Cuando esté listo para construir la cosa real, esta ruta da directamente en el proyecto del brazo robótico de 4 GDL.
Antes de empezar
Necesita trigonometría —en concreto sin, cos y atan2— y programación suficiente para
escribir una función que devuelva dos valores. La experiencia con servos ayuda, pero la ruta la
cubre. Nada de aquí exige el brazo físico; toda la geometría se puede aprender en el simulador.
Lo que podrá hacer
- Calcular dónde está la herramienta de un brazo de dos eslabones a partir de sus ángulos articulares, e invertir eso para encontrar los ángulos que alcanzan un punto dado.
- Elegir deliberadamente entre las dos soluciones —codo arriba y codo abajo— en vez de quedarse con la que la matemática devolvió.
- Predecir el borde del espacio de trabajo alcanzable y detectar un objetivo fuera de él antes de que el brazo intente moverse.
- Reconocer una singularidad a medida que el brazo se acerca a la extensión total, donde un pequeño cambio en la posición de la herramienta exige un cambio enorme en el ángulo articular.
- Medir el juego de sus propias articulaciones, y decir cuánto del error de la pinza es del mecanismo y no de la matemática.
Dónde se atasca la gente
Usar atan en vez de atan2. El atan a secas no puede saber en qué cuadrante está el
objetivo, así que el brazo llega bien por delante y se refleja marcha atrás por detrás. atan2 toma
las dos componentes por separado y acierta en los cuatro cuadrantes.
Un error de dominio en acos. Cuando el objetivo está más lejos de lo que alcanzan los
eslabones, el teorema del coseno produce un argumento fuera de −1 a 1 y acos devuelve NaN. Ese
NaN fluye hasta la orden del servo como un ángulo basura. Compruebe la alcanzabilidad antes de la
trigonometría, no después.
Confundir el ángulo articular con el ángulo del servo. El cero de un servo está donde se montó su horquilla, y puede girar en sentido contrario al de su matemática. Cada articulación necesita un offset de calibración y posiblemente una inversión de signo. Saltarse esto produce un brazo que se mueve con suavidad y aterriza lejos del objetivo.
Ignorar la gravedad en la extensión. La geometría asume que el brazo va donde se le dice. Un servo de hobby sosteniendo un eslabón totalmente extendido está en su peor ventaja mecánica, y la posición real cae por debajo de la comandada, sobre todo en el borde lejano del espacio de trabajo.
Ajustar un error mecánico. Si el brazo alcanza el mismo punto de forma distinta según el lado por el que venga, ninguna ganancia lo arregla: es juego de la caja reductora, multiplicado por toda la longitud del brazo. Cuatro grados en un hombro que mueve un eslabón de 150 mm son más de 10 mm en la pinza.
Atravesar una singularidad. Cerca de la extensión total la solución inversa queda mal condicionada, y una trayectoria suave de la herramienta se convierte en un movimiento articular violento. Mantenga las trayectorias dentro de un margen del borde en vez de pegadas a él.
Qué necesita
| Qué | Por qué lo necesita esta ruta | Notas |
|---|---|---|
sin, cos y atan2 |
Todo el instrumental matemático | Si sabe para qué sirve atan2, ya está listo |
| Una función que devuelva dos valores | La IK devuelve un par de ángulos, y a menudo dos pares | Una tupla, una estructura, un parámetro de salida: lo que sea |
| Un transportador y una regla | Comparar dónde fue el brazo contra dónde se le dijo | La única prueba honesta de una implementación de cinemática |
| Un brazo y un PCA9685 (opcional) | La mitad de hardware | La geometría se puede aprender entera en el simulador |
Por qué la ruta sigue este orden
El manejo de servos va antes que la geometría, y no es obvio que deba ser así. La razón es la calibración. Una vez que puede mandar una articulación y ver dónde aterriza realmente, tiene forma de contrastar cada resultado posterior con la realidad. Si aprende primero la geometría, no tiene manera de distinguir un solucionador erroneo de un servomotor mal montado: dos fallos muy distintos que desde el otro lado de la habitación se ven iguales.
Los tipos de brazo van después porque explican qué es un «eslabón». Los brazos cartesianos, SCARA y delta resuelven el mismo problema con geometrías completamente distintas, y ver tres deja claro que la cinemática trata del disposición de las articulaciones y no de un brazo concreto. También le dice por qué la IK de un SCARA es casi trivial y la de un delta no lo es.
La cinemática inversa va tercera, cuando ya están los dos requisitos. Es el corazón de la ruta, y es el único nodo donde va a pasar tiempo real con matemáticas.
El simulador va cuarto porque hace visible lo invisible. La alcanzabilidad, las dos ramas de codo y las singularidades son cosas que puede demostrar sobre el papel y que no entenderá de verdad hasta que haya arrastrado un objetivo hasta el borde del espacio de trabajo y visto cambiar el comportamiento del solucionador. Arrastrar es también la forma más rápida de hallar la forma de un espacio de trabajo, que es una corona y no un disco siempre que los eslabones sean desiguales.
El backlash cierra la ruta deliberadamente. Es el punto en que deja de poder mejorar la precisión del brazo con mejor matemática. Cada nodo anterior trata de calcular el ángulo correcto; este trata de los milímetros entre el ángulo correcto y la posición correcta.
Puntos de control: cómo saber que una etapa caló
| Etapa | La comprobación | Qué es un aprobado |
|---|---|---|
| Manejo de servos | Mande 0°, 90° y 180° en cada articulación | La horquilla aterriza donde se le mandó, y tiene anotados el offset y el signo de cada articulación |
| Calibración de PWM | Halle los anchos de pulso de los topes reales de cada servo | Sus cuentas mínima y máxima son por servo, no las de la biblioteca por defecto, y nada zumba en los límites |
| Cinemática directa | Fije ángulos conocidos, calcule la posición de la herramienta y midala | Lo calculado y lo medido coinciden dentro de unos pocos milímetros |
| Ida y vuelta | Pase una posición calculada de vuelta por la IK | Los ángulos que salen coinciden con los que entraron |
| Manejo de cuadrantes | Pida objetivos en los cuatro cuadrantes | Los cuatro funcionan: si dos se reflejan, está usando atan |
| Alcanzabilidad | Pida un objetivo muy lejos del alcance del brazo | Obtiene un «inalcanzable» limpio, no un NaN ni un estiramiento |
| Forma del espacio de trabajo | Mapee el borde alcanzable en el simulador | Puede describirlo, y explicar por qué los eslabones desiguales dan una corona con agujero |
| Ramas de codo | Alcance el mismo punto por los dos caminos | Ambos funcionan, eligió uno a propósito, y puede decir por qué |
| Singularidad | Conduzca una trayectoria recta de la herramienta atravesando casi la extensión total | Ha visto el pico de velocidad articular, y ahora planifica un margen |
| Backlash | Acepte el mismo punto desde cada dirección y mida | Tiene un número en milímetros en la pinza, y no es cero |
Dónde termina esta ruta
Esta ruta cubre la solución planar de dos eslabones resuelta en forma cerrada: la geometría que hay detrás del hombro y el codo de casi todos los brazos de hobby. Es lo correcto que aprender primero porque puede derivarlo, comprobarlo, y ver exactamente por qué ocurre cada fallo.
Se queda corta de varias cosas con las que se topará después. La cinemática general de n GDL usa parámetros de Denavit–Hartenberg y matrices de transformación homogénea para describir sistemáticamente cualquier cadena de articulaciones, en vez de resolver a mano la geometría de cada brazo. La IK numérica —iteración basada en el jacobiano— es lo que se usa cuando no existe solución en forma cerrada, que es la situación normal a partir de cuatro o cinco articulaciones; también degrada con elegancia cerca de las singularidades, donde una solución en forma cerrada simplemente se rompe.
La resolución de redundancia es la pregunta de qué hacer cuando un brazo tiene más articulaciones de las que la tarea restringe y por tanto tiene infinitas soluciones válidas: un problema realmente interesante que esta ruta nunca tiene que afrontar, porque un brazo de dos eslabones tiene exactamente dos.
Y la dinámica es toda la otra mitad de la manipulación: la cinemática no dice nada sobre fuerzas, inercia, ni con qué rapidez puede moverse una articulación sin sobrepasar. Todo lo de aquí asume que el brazo va donde se le dice, lo bastante despacio para que el supuesto se cumpla.
Ruta de aprendizaje
La ruta
Sigue los nodos en orden: cada uno desbloquea el siguiente cuando lo completas. Tu progreso se guarda en este dispositivo.
0 / 5 completados
Preguntas comunes
Preguntas frecuentes
¿Cuál es la diferencia entre cinemática directa e inversa?
La cinemática directa responde a: 'dados estos ángulos articulares, ¿dónde se ubica el efector final?'. Es un cálculo trigonométrico directo con solución única y analíticamente simple. La cinemática inversa responde a la pregunta operativa: 'para colocar la pinza en estas coordenadas cartesianas, ¿qué ángulos deben adoptar los motores?'. Presenta mayor complejidad: puede admitir múltiples soluciones válidas (codo arriba / codo abajo), ninguna si el punto queda fuera del alcance físico, o infinitas si el manipulador es cinemáticamente redundante.
¿Por qué el brazo se orienta al lado opuesto ante puntos situados a su espalda?
Casi con seguridad debido al empleo de la función trigonométrica atan en lugar de atan2. La función atan estándar toma el cociente y/n perdiendo el signo individual de las coordenadas, por lo que no distingue el primer cuadrante del tercero ni el segundo del cuarto. Como consecuencia, el brazo resuelve correctamente hacia adelante pero invierte los cuadrantes posteriores. atan2 recibe ambos componentes por separado y discrimina con rigor los cuatro cuadrantes del plano.
¿Qué significan las configuraciones codo arriba y codo abajo?
En un manipulador plano de dos eslabones, prácticamente cualquier coordenada dentro del espacio de trabajo admite dos posturas cinemáticas geométricas válidas: flexionando el codo hacia arriba o hacia abajo. Ambas son matemáticamente equivalentes. La elección depende del entorno: evitar obstáculos, no chocar con la base o prevenir torsión de cableados. Es fundamental mantener coherencia en la rama elegida; alternar arbitrariamente en trayectoria continua provoca giros violentos e imprevistos.
¿Por qué el cálculo cinemático arroja valores NaN (Not a Number)?
Porque el punto solicitado excede la longitud total combinada de los eslabones (o es más cercano que su diferencia), provocando que el argumento del teorema del coseno rebase el intervalo cerrado [-1, 1] admisible por acos(). Ese valor NaN se transmite a las salidas PWM generando movimientos erráticos. Compruebe siempre el alcance radial antes de ejecutar la trigonometría: si la distancia euclidean excede los límites físicos, descarte la consigna con un estado explícito de punto inalcanzable.
¿Qué es una singularidad cinemática en un brazo robótico?
Una configuración geométrica donde el manipulador pierde instantáneamente uno o más grados de libertad en el espacio de la tarea. En un brazo de dos eslabones ocurre en extensión completa o plegado total: con el brazo alineado, es imposible mover la punta radialmente hacia afuera, y un desplazamiento tangencial mínimo exige velocidades angulares infinitas en las articulaciones. Las trayectorias planificadas deben mantener un margen de resguardo respecto a los límites de singularidad.
¿Por qué la pinza real no alcanza exactamente las cotas matemáticas?
Por tres factores acumulativos. Calibración angular: el cero del eje depende de la inserción física del cabezal estriado del servo, requiriendo un offset en software. Deflexión por gravedad: un servo de modelismo con el brazo extendido sufre su mayor par de palanca, cediendo mecánicamente por debajo del ángulo ordenado. Holgura de reductores (backlash): escasos grados de holgura en el hombro se amplifican a más de un centímetro de incertidumbre en el efector final.