Robotarmsimulator voor kinematica en ROS-planning

Bediening

De simulator biedt schuifregelaars voor de gewrichten, een versleepbaar doel voor de grijper, overlays van coördinatenstelsels en regelaars voor de koppellengtes, met de basis gecentreerd zodat het volledige bereik van 360° zichtbaar is. In voorwaartse stand berekent de simulator de pose van de grijper uit de gewrichtshoeken die je instelt. In inverse stand volgt hij een doel dat je versleept — hij berekent live de gewrichtshoeken en meldt onbereikbare of dubbelzinnige doelen in plaats van stilletjes naar een resultaat te springen. Een derde stand, pick-and-place, laat je een grijp- en een afzetpunt positioneren en voert de arm daarna de hele taak uit: hij beweegt naar het object, grijpt het, draagt het en laat het los in de afzetzone — de klassieke taak waarvoor elke echte manipulator is gebouwd.

Theorie

Elk gewricht draagt een transformatie tussen coördinatenstelsels bij. Die transformaties vanaf de basis tot aan de grijper met elkaar vermenigvuldigen levert de voorwaartse kinematische pose op. Inverse kinematica werkt de andere kant op en kan geen oplossing, één oplossing of meerdere oplossingen hebben.

Dicht bij een singulariteit kan een kleine beweging van de grijper een zeer grote gewrichtsbeweging vergen. Een planner moet daarnaast ook limieten voor positie, snelheid, versnelling, koppelmoment en botsing respecteren. Alleen geometrisch bereik maakt een traject nog niet veilig.

Algoritme

1. Definieer koppellengtes, gewrichtsassen, hometransformaties en gewrichtslimieten.
2. Bereken de voorwaartse kinematica voor de huidige gewrichtsstand.
3. Vergelijk de huidige pose van de grijper met het gevraagde doel.
4. Gebruik een analytische of numerieke solver om de posefout binnen de limieten te verkleinen.
5. Verwerp botsende of singuliere kandidaten en kies een continue oplossing.
6. Stuur het pad tijdgestuurd en geef gesynchroniseerde setpoints aan de gewrichtscontrollers.

Broncode

Een vlakke arm met twee koppels heeft een compact voorwaarts model:

from math import cos, sin

def forward_kinematics(theta_1, theta_2, link_1, link_2):
    elbow = (link_1 * cos(theta_1), link_1 * sin(theta_1))
    tool = (
        elbow[0] + link_2 * cos(theta_1 + theta_2),
        elbow[1] + link_2 * sin(theta_1 + theta_2),
    )
    return elbow, tool

Bij fysieke armen moet je elk gepland traject valideren in een begrensde, botsingsbewuste omgeving voordat je de actuatoren van stroom voorziet.

Aannames en hardwareverschillen

De arm is vlak met twee of drie draaibare gewrichten, volledig starre koppels, een onmiddellijke snelheidsrespons en geen zwaartekracht, dynamica of botsing — je kunt van elleboog omhoog naar elleboog omlaag zwaaien zonder limiet op het koppelmoment. Echte servo’s hebben positie- en snelheidslimieten, tandwielspeling, koppelmoment met stroombegrenzing en lastafhankelijke doorbuiging, en een arm met zes assen moet ook oriëntatie, singulariteiten en werken dicht bij de gewrichtslimieten beheersen. In dit lab leer je waarom een doel binnen de annulus twee oplossingen kan hebben en waarom een doel op de rand daarvan singulier is, voordat je de dynamica toevoegt die die poses lastig vasthoudbaar maakt.

Schakelschema

Scheid de stroomvoorziening met hoge stroom voor de actuatoren van de rekenvoorziening, en behoud daarbij de referentie- en veiligheidssignalen die de gekozen hardware vereist.

Begeleide experimenten

Een doel rond slepen is de snelste manier om intuïtie op te bouwen voor dingen die op papier omslachtig te bewijzen zijn en op hardware duur om te ontdekken.

1. Onderzoek de vorm van het werkbereik

Sleep het doel langzaam naar buiten tot de solver onbereikbaar meldt en traceer daarna die grens helemaal rond. Sleep het nu naar binnen, richting de basis.

Bij ongelijke koppellengtes vindt je twee grenzen: een buitenste cirkel op L1 + L2 en een binnenste op |L1 − L2|. Het werkbereik is een annulus, geen schijf, en er zit een gat in het midden dat de arm fysiek niet kan bereiken.

Die laatste rij is een werkelijk nuttige ontwerpfact: gelijke koppellengtes nemen de dode zone volledig weg. Als jouw arm dicht bij zijn eigen basis moet werken, is dat de reden om ze te kiezen.

2. Zie de twee oplossingen samenlopen

Wissel bij een doel vlak bij het midden van het werkbereik tussen de takken elleboog omhoog en elleboog omlaag: twee duidelijk verschillende armposes die hetzelfde punt bereiken.

Sleep dat doel nu naar buiten richting de grens. De twee poses lopen samen en bij volledige strekking worden ze dezelfde pose. Dat is een singulariteit, en het is waar de arm het vermogen verliest, de grijper in één richting te bewegen, wat de gewrichten ook doen.

3. Ervaar wat een singulariteit kost

Sleep het doel langzaam en gestaag langs een rechte lijn die vlak langs de volledige strekking loopt. Kijk naar de gewrichtshoeken in plaats van naar de arm.

De grijper beweegt met constante snelheid; de gewrichten niet. Dicht bij de grens vergt een kleine beweging van de grijper een enorme gewrichtsbeweging, waardoor een vloeiend cartesiaan pad verandert in een geweldige gewrichtsbeweging. Op hardware is dat een servo die tegen zijn limiet slaat.

Houd geplande paden binnen ongeveer 95% van het maximale bereik, en dit probleem verdwijnt.

4. Steek een takgrens over en zie de omslag

Stel de solver zo in dat hij altijd elleboog omhoog kiest en sleep daarna het doel door een gebied waar die tak op een gewrichtslimiet stuit en de solver omschakelt. De arm slaat door in een grote, snelle, volledig ongeplande beweging.

Daarom is de juiste standaard minimale beweging — kies de tak die het dichtst bij de huidige pose ligt — en niet een vaste tak. Een stille takwissel halverwege het pad is op echte hardware verontrustend en kan beschadigend zijn.

Wat je moet zien

Naar de hardware

De geometria gaat exact over. Al het andere niet, en dat verschil is waar een eerste armbouw zijn tijd aan besteedt:

Twee getallen maken het punt. Vier graden speling bij de schouder over een bereik van 190 mm is meer dan 13 mm bij de grijper — groter dan elke fout die de wiskunde introduceert. En een koppellengte die bij 95 mm 10 mm te lang is gemeten, is een systematische fout van 10% die geen enkele afstelling wegneemt.

De praktische gevolgtrekking is dat nauwkeurigheid op hardware voortkomt uit kalibratie en een consistente naderingsrichting, niet uit betere kinematica. Nader een doel altijd van dezelfde kant aan en de speling wordt een reproduceerbare offset die je kunt aftrekken. De volledige solver, met elke foutsituatie afgehandeld, staat in inverse kinematica voor een arm met twee koppels.