Forstå hvordan man utleder den jakobittiske matrisen er avgjørende for å kontrollere et 6-graders fridom (6-DOF) robotmanipulator. Jacobian relaterer felles fartøy til slutteffekt-verft, noe som muliggjør nøyaktig bevegelse og kraftkontroll.

Kinematic Modell av manipulatoren

Det første trinnet innebærer å etablere den kinematiske modellen til roboten. Dette vanligvis bruker Denavit-Hartenberg (D-H) parametre for å definere koordinatrammene for hvert ledd. Disse parametrene inkluderer linklengder, vrider, offset og leddvinkler.

Ved å bruke D-H-parametrene kan du hente transformasjonsmatrisene fra ett ledd til det neste. Multiplisere disse matrisene gir den generelle transformasjonen fra basen til slutteffekten.

Beregner Jacobian

Den jakobitiske matrise består av to deler: den lineære hastighet Jacobian og den vinkelformede hastighet Jacobian. For hver ledd, bestemme om det er revolut eller prismatisk, da dette påvirker beregningen.

For revolute ledd er den lineære hastighetskomponenten tverrproduktet til leddeaksen og vektoren fra leddet til endeeffektoren. Den vinkelrette hastighetskomponenten er rett og slett den leddaksevektor. For prismatiske ledd er den lineære komponenten jointaksenvektoren, og den vinkelformede komponenten er null.

Bygger den jakobiske matrisen

Samle den jakobittiske matrise ved å stable de lineære hastighetsvektorene og vinkelhastighetsvektorene for hver ledd. Den resulterende 6x6 matrise vedrører leddveier til endeeffektor-velociteter.

Sørg for at Jacobian evalueres i de aktuelle leddvinkler for nøyaktig å reflektere robotens konfigurasjon.

  • Definere robotens D-H-parametre.
  • Beregn transformasjonsmatriser.
  • Fastsett felles akser og posisjonsvektorer.
  • Beregn hver kolonne av Jacobian.
  • Samle den fulle Jacobian matrisen.