Innehållsförteckning:
2025 Författare: John Day | [email protected]. Senast ändrad: 2025-01-13 06:58
Använda LEGO NXT för att bygga en Delta Robot.
Kombinerad skanning och teckning.
Steg 1: Kinemtisk analys
Vänligen öppna PDF -filen för att se detaljer.
Referens: https://www.google.com.tw/url? Sa = t & rct = j & q = & esrc = s …
Steg 2: Mekanism
LEGO NXT *1LEGO Motor *3LEGO Ljussensor *1LEGO minstorms *1 låda Vit tavla *1 (Eftersom vit bräda har mindre friktion.) Vit brädmarkör *1Hylla *1Bälte *n (Fixat hyllan och roboten tillsammans.)
Om du har mer växel kan du använda dem för att bygga en växellåda. Det är bättre för motorn att ha ett stort reduktionsförhållande.
Ändra armlängden för att möta ditt behov.
Det är bättre att använda bolluttaget vid korsningen. Jag har den inte, så jag byter den till 2 varvskarvar.
Steg 3: MATLAB -simulering
Använda MATLAB för att simulera åtgärden.
Beräkna robotens bana innan du använder roboten. Det kan undvika felaktig användning, till exempel att överskrida arbetsytan.
Steg 4: LabVIEW -kod - Main
- Klicka på "Initiera" -botten. Den kan låta roboten alltid starta från samma ställe. Ge tre motorer krafter som gör att de går till toppen av hyllan. Beräkna skillnaden mellan tidigare och nuvarande värde på motorgraden. Om skillnaden är 0, initialiseringen är klar.
-
Klicka på "Scan" -botten. Ge NXT en L (cm)*L (cm) -matris som har d -kolumner och d -rader. Låt ljussensorn skanna från vänster till höger och uppifrån och ner. Om värdena som ljussensorn bestämt är svart (på bilden är det <45, men det kommer att vara annorlunda.), det kommer att vara åtkomst till arrayen som X0, Y0, Z0. Och det kommer att avsluta skanningsprocessen.
- Byt ljussensor till vit tavla.
- Klicka på "Draw" -botten. Ritningen kommer att börja på den plats som steg 2 kommer åt (X0, Y0, Z0). Matlab -skriptet är en bana som du infogar.
Steg 5: LabVIEW -kod - Delta Inverse
Det är den inversa kinematiska beräkningen.
Ingångar är banans punkter koordinat x, y och z.
Utgångar är vinkeln och effekten för tre motorer, och "slingorna" visar slingornas nummer.
Steg 6: LabVIEW -kod - 3 motorsynk
Använda PID -kontroll.
Ingång 3 motorns port, effekt, vinkel.
Om skillnaden i motorns vinkelavläsning från NXT och vinkeln som Delta Inverse gav är mindre än 5 grader, slutar motorn att rotera.
Om tre motorer stoppas är processen klar.