Förstå hur man härleder den Jacobian matrisen är avgörande för att kontrollera en 6-graders frihet (6-DOF) robotmanipulator. Jacobian relaterar gemensamma hastigheter till sluteffekthastigheter, vilket möjliggör exakt rörelse och kraftkontroll.
Kinematisk modell av manipulatorn
Det första steget innebär att man etablerar robotens kinematiska modell. Detta använder vanligtvis Denavit-Hartenberg (D-H) parametrar för att definiera koordinatramarna för varje led. Dessa parametrar inkluderar länklängder, vridningar, kompensationer och gemensamma vinklar.
Med hjälp av D-H-parametrarna kan du härleda transformationsmatriserna från en led till nästa. Multiplicera dessa matriser ger den övergripande omvandlingen från basen till sluteffekten.
Beräkning av Jacobian
Den Jacobian matrisen består av två delar: den linjära hastigheten Jacobian och den vinkelhastighet Jacobian. För varje led, avgöra om det är revoluta eller prismatisk, eftersom detta påverkar beräkningen.
För revoluta leder är den linjära hastighetskomponenten korsprodukten av den gemensamma axeln och vektorn från leden till sluteffekten. Den vinkelhastighetskomponenten är helt enkelt den gemensamma axelvektorn. För prismatiska leder är den linjära komponenten den gemensamma axelvektorn och den vinkelkomponenten är noll.
Bygga Jacobian Matrix
Montera den Jacobian matrisen genom att stapla linjära hastighet vektorer och vinkelhastighet vektorer för varje led. Den resulterande 6x6 matrisen relaterar gemensamma hastigheter till slut-effector hastigheter.
Se till att Jacobian utvärderas i de nuvarande gemensamma vinklarna för att exakt återspegla robotens konfiguration.
- Definiera robotens D-H-parametrar.
- Beräkna transformationsmatriser.
- Bestäm gemensamma axlar och positionsvektorer.
- Beräkning av varje kolumn av Jacobian.
- Montera hela Jacobian matrisen.