Guida al montaggio di Mobile ALOHA
Manipolazione mobile bimanuale con 4 bracci robotici su una base su ruote per la teleoperazione
Licenza
MIT
Guida al montaggio
1. Cosa pubblica la fonte originale
Leggi prima questo. Il tutorial di Stanford è l'unico documento di montaggio per Mobile ALOHA. È composto da una distinta base, un modello del telaio in Fusion360 e una breve guida all'hardware. Non è una costruzione completa passo per passo, e costruisce una macchina diversa dalla versione AgileX Cobot Magic.
1.1 Quale build copre questa guida
Questa guida segue il tutorial di Stanford: due bracci ViperX 300, due bracci WidowX 250, un AGV Tracer e un portatile Lambda Labs Tensorbook.
- Il progetto originale pubblica un unico documento di assemblaggio, il Mobile ALOHA Hardware Assembly Tutorial. Contiene una distinta base, un elenco di sei pezzi stampati in 3D per l'odometria delle ruote e una guida hardware in cinque parti: montare gli end effector ALOHA, costruire il telaio del robot, montare i robot e le telecamere, collegamenti dei cavi e odometria delle ruote.
- Il telaio è pubblicato solo come modello Fusion360. Il tutorial non fornisce passaggi scritti per il telaio e non dice come il telaio finito si fissa alla base Tracer. Questa guida quindi elenca i pezzi del telaio e rimanda al modello. Non inventa i passaggi mancanti.
- Il tutorial affida due compiti ad altri documenti: la Part 1 del tutorial ALOHA originale (end effector e alimentazione dei bracci) e il README del repository mobile-aloha (software). Entrambi sono usati qui sotto.
- Il software è stato testato su Ubuntu 18.04 o 20.04 con ROS 1 noetic. Il README indica ROS 2 e Ubuntu 22.04 o successive come in fase di test, non come funzionanti.
- AgileX vende una versione chiamata Cobot Magic. Il post di AgileX dell'8 marzo 2024 elenca una base Tracer, tre telecamere di profondità Orbbec Dabai, quattro bracci leggeri a 6 gradi di libertà descritti come personalizzati da AgileX, un hub USB a 7 porte, una ciabatta a 4 prese, una power station portatile da 1000W e, come opzione, un Jetson Orin Nano Developer Kit (8G) o un PC industriale APQ-X7010. Anche i modelli di simulazione di AgileX mostrano un Tracer 2 con telecamere Dabai e bracci PiPER. Nessuna delle due fonti fornisce passaggi di assemblaggio, quindi questa guida non descrive quella versione. Se hai acquistato Cobot Magic, usa la documentazione di AgileX per i suoi bracci, le telecamere e il computer.
- Il totale del tutorial è $31,757.86 per l'elenco dei pezzi di Stanford.
1.2 Regole che valgono sempre
USB diretto per i quattro robot, niente hub né prolunghe, e non lasciare mai che un robot alimentato perda coppia senza essere sostenuto.
- Collega i quattro robot al computer direttamente via USB. Non usare prolunghe né hub USB per i robot.
- Le telecamere possono passare da un hub USB, con un massimo di 2 telecamere per hub per una latenza ragionevole.
- Il robot crolla se la coppia dei suoi motori è disattivata, perché nei giunti non ci sono freni che si inseriscono automaticamente.
- Dynamixel Wizard non conosce la cinematica del robot, quindi fai attenzione alle collisioni quando invii comandi da lì.
- Prima di eseguire i comandi di teleoperazione, porta tutti e 4 i robot nelle loro posizioni di riposo e apri la pinza del robot master.
2. End effector e telecamere del polso
Il tutorial di Mobile ALOHA dice di seguire la Part 1 del tutorial ALOHA originale per gli end effector dei robot leader e follower, e di installare le telecamere del polso su entrambi i robot follower. Il repository contiene anche un progetto di pinza rivisto con un proprio documento di montaggio, trattato nella sezione successiva.
2.1 Monta le impugnature sui due bracci WidowX e rimuovi la pinza originale
Su ogni braccio WidowX, il più piccolo, vanno due metà dell'impugnatura con quattro dadi M2.5 e bulloni M2.5 x 10, poi si toglie la pinza originale.
- Pezzi necessari: handle_lower, handle_upper e 4 dadi M2.5 con bulloni M2.5 x 10.
- Monta le impugnature sui due robot WidowX (i bracci più piccoli).
- Suggerimento: allarga il foro con un trapano così che il bullone passi facilmente. Due viti montate in diagonale potrebbero bastare; quattro sono più sicure.
- Togli la pinza originale con le chiavi a brugola. Conserva tutte le viti e le rondelle originali e ricorda da dove proviene ciascuna, perché in seguito si usano allo stesso modo.
2.2 Monta e installa l'unità di backdriving
Lever1, lever2, due slider, due rotor e quattro rotor arm formano l'unità che si monta sul motore del polso di ogni WidowX.
- Pezzi necessari: lever1, lever2, 2 cursori, 2 rotori, 4 rotor_arm. Attrezzi: chiavi a brugola.
- Prima di iniziare, verifica che entrambi i cursori scorrano facilmente lungo la guida della pinza appena smontata. In caso contrario, limali con una lima per metalli.
- A seconda della stampante, potrebbe essere necessario arrotondare o allargare i fori perché i pezzi si muovano liberamente.
- Per l'anello per il dito in velcro, prendi una fascetta, tagliala a una lunghezza adatta e incollala alla leva con la colla a caldo.
- Collegati al robot con Dynamixel Wizard (vedi i passaggi del README nella sezione software). Seleziona il 9° motore, attiva la coppia e imposta Position a 180 trascinando la linea rossa.
- L'albero motore deve mostrare i fori esattamente come nella fotografia del tutorial. Monta l'unità di azionamento inverso usando i fori sinistro e destro.
2.3 Monta la guida della pinza e prova l'unità di backdriving
Una vite M3 x 30 con dadi tiene ciascuna estremità della vecchia guida della pinza, e l'unità si prova con la coppia del motore disattivata.
- Pezzi necessari: viti e dadi M3 x 30. Attrezzi: chiavi a brugola.
- Su ciascun lato: metti un dado sulla vite M3 x 30 come rondella, fai passare la vite nel foro e avvita un altro dado per fissarla.
- Avvita un altro dado seguito dal dado a T recuperato smontando il robot. La vite deve essere a filo con il dado a T. Ripeti sull'altro lato.
- Infila la guida della pinza, in questo ordine: dado a T, cursore, cursore, dado a T. Serra il dado per fissare la guida a entrambe le estremità.
- Prova: disattiva la coppia del motore in Dynamixel Wizard. Dovresti riuscire a muovere facilmente a mano il motore della pinza.
2.4 Monta le dita della pinza stampate in 3D
Finger1 e finger2 sostituiscono le dita originali usando le due viti lunghe fornite con il robot.
- Pezzi necessari: finger1, finger2. Attrezzi: chiavi a brugola; si consiglia un trapano con inserti esagonali.
- Prima del montaggio, verifica che il cursore scorra liberamente lungo la guida della pinza. Se il cursore fornito con il robot è troppo stretto, lima i suoi fori.
- Monta la pinza personalizzata come la pinza originale, con le due viti lunghe fornite con il robot. È normale che avvitarle sia piuttosto duro.
- Fai attenzione all'orientamento: il lato dritto di ogni dito deve essere rivolto verso l'alto.
2.5 Applica il nastro antiscivolo alle dita
Il nastro antiscivolo sulle punte e sui bordi delle dita permette alla pinza di afferrare oggetti sottili e scivolosi.
- Taglia prima un pezzo da 1 cm di nastro antiscivolo e applicalo sulla punta della pinza. L'estremità del nastro deve trovarsi sulla punta del triangolo.
- Poi applica un pezzo lungo (circa 10 cm). Avvolgi prima il lato dritto, poi l'altro lato, e taglia l'eccesso. Assicurati che aderisca bene.
- Ripeti per l'altra pinza. Avvolgi sempre prima il lato dritto.
- Facoltativo, per oggetti tondi come le maniglie: per ogni dito taglia pezzi da 5 cm, 3,5 cm e 2 cm e applicali in quest'ordine. Non lasciare giunzioni né sovrapposizioni tra i pezzi da 3,5 cm e 2 cm. Secondo il tutorial, così il braccio riesce a sollevare un trapano di dimensioni normali.
2.6 Monta le telecamere del polso su entrambi i robot follower
Una webcam Logitech senza supporto scorre in ogni cam_mount, tenuta da una vite M3 x 4, e il supporto si fissa al robot con quattro viti M2.5 x 8.
- Pezzi necessari: cam_mount, webcam Logitech, viti M2.5 x 8, viti M3 x 4. Attrezzi: chiavi a brugola.
- Togli prima il supporto della webcam. Questo riduce anche di molto il peso della webcam.
- La telecamera dovrebbe poi scorrere facilmente nel cam_mount. Una vite M3 x 4 aggiuntiva la tiene in posizione.
- Monta il cam_mount sul robot con 4 viti M2.5 x 8.
- Il tutorial Mobile ALOHA prevede telecamere da polso su entrambi i robot follower.
3. Pinze rivedute (progetto alternativo)
La cartella hardware del repository contiene un progetto di pinza successivo con un proprio documento di montaggio, scritto da Thinh Nguyen (versione 1.0, 28 luglio 2023). Usa carrelli su guida, cuscinetti e acrilico tagliato al laser ed è più impegnativo delle dita stampate descritte sopra. Il tutorial di Mobile ALOHA non lo menziona. Scegli un solo progetto per ogni braccio, non entrambi. Le immagini dei passaggi sono nel PDF.
3.1 Pinza WidowX rivista
Una pinza a guida con portadito in velcro e impugnatura, costruita con parti dai file STEP, una piastra posteriore in acrilico da 3 mm e carrelli per guide McMaster.
- Pezzi e minuteria sono elencati nella sezione 2.0 del PDF (per esempio 4 distanziali in ottone M2, 6 cuscinetti radiali a sfere 3 mm x 6 mm x 2,5 mm e una guida da 120 mm con carrello). Leggi quell'elenco prima di ordinare.
- Inserisci i 4 distanziali in ottone M2 nel supporto delle guide del ponte.
- Dopo aver tagliato al laser la piastra posteriore in acrilico da 3 mm, svasa i fori come mostrato nell'immagine.
- Monta i 3 cuscinetti sul braccio del rotore (2 sul lato destro e 1 sul lato sinistro).
- Usa un maschio per filettare M3 i fori centrali, per una profondità di circa 5 mm.
- Unisci il rotore e il braccio del rotore con una vite a testa svasata M3 x 10 mm e un dado autobloccante.
- Fissa le guide con i carrelli al ponte e bloccale con viti a testa svasata M2 x 16 mm a entrambe le estremità. Usa viti a testa svasata M2 x 10 mm e dadi per i fori centrali.
- Fissa l'adattatore del dito ai carrelli usando le 8 viti a testa bombata (6 mm) fornite con le guide, con rondelle piane a diametro esterno ridotto.
- Usa viti a testa svasata M3 x 20 mm per fissare il collegamento del rotore all'adattatore del dito.
- Fissa la piastra posteriore al ponte con viti M2 x 10 mm, con i fori svasati rivolti in avanti. Verifica che il centro dei fori grandi sia allineato con il centro delle due guide.
- Fissa il portadito con il velcro.
- Apri e chiudi l'adattatore del dito per verificare che il rotore giri correttamente (la chiusura è in senso orario, l'apertura in senso antiorario).
- Inserisci il rotore spessorato nel motore.
- Usa una vite M2 x 6 mm e una rondella per fissare il rotore alla squadretta del motore. Usa viti a testa svasata M2.5 x 16 per fissare la pinza al motore, con l'orientamento corretto per la tua configurazione.
- Monta l'impugnatura sul motore e fissala con viti M2.5 x 8 mm su entrambi i lati.
- Apri e chiudi il portadito per verificare che il movimento sia fluido. L'assemblaggio della pinza è così completo.
3.2 Pinza ViperX rivista
Lo stesso progetto a guida con un dito a linguetta in tessuto e una guida da 150 mm.
- Pezzi e minuteria sono elencati nella sezione 2.0 del PDF (per esempio 4 distanziali in ottone M2, 6 cuscinetti radiali a sfere 3 mm x 6 mm x 2,5 mm e una guida da 150 mm con carrello). Leggi quell'elenco prima di ordinare.
- Inserisci i 4 distanziali in ottone M2 nel supporto delle guide del ponte.
- Dopo aver tagliato al laser la piastra posteriore in acrilico da 3 mm, svasa i fori come mostrato nell'immagine.
- Monta i 3 cuscinetti sul braccio del rotore (2 sul lato sinistro e 1 sul lato destro).
- Usa un maschio per filettare M3 i fori centrali, per una profondità di circa 5 mm.
- Unisci il rotore e il braccio del rotore con una vite a testa svasata M3 x 10 mm e un dado autobloccante.
- Fissa le guide con i carrelli al ponte e bloccale con viti a testa svasata M2 x 16 mm a entrambe le estremità. Usa viti a testa svasata M2 x 10 mm e dadi per i fori centrali.
- Fissa l'adattatore del dito ai carrelli usando le 8 viti a testa bombata (6 mm) fornite con le guide, con rondelle piane a diametro esterno ridotto.
- Usa viti a testa svasata M3 x 20 mm per fissare il collegamento del rotore all'adattatore del dito.
- Fissa la piastra posteriore al ponte con viti M2 x 10 mm, con i fori svasati rivolti in avanti. Verifica che il centro dei fori grandi sia allineato con il centro delle due guide.
- Apri e chiudi l'adattatore del dito per verificare che il rotore giri correttamente (la chiusura è in senso orario, l'apertura in senso antiorario).
- Fissa la linguetta in tessuto al dito.
- Inserisci in posizione l'adattatore tra le dita e fissalo con viti M2 x 20 mm.
- Inserisci il rotore spessorato nel motore.
- Usa una vite M2 x 6 mm e una rondella per fissare il rotore alla squadretta del motore. Usa viti a testa svasata M2.5 x 16 per fissare la pinza al motore, con l'orientamento corretto per la tua configurazione.
- Apri e chiudi il dito per verificare che il movimento sia fluido. L'assemblaggio della pinza è così completo.
4. Telaio, bracci e telecamera anteriore
La fonte originale fornisce il telaio come modello Fusion360 e un elenco delle parti, con passaggi scritti solo per il montaggio dei robot e della telecamera anteriore.
4.1 Raccogli le parti del telaio
Il telaio è in profilato di alluminio 4040 con connettori, più viti M6 e dadi a T usati solo per i robot.
- Profilato 4040: 800 mm x 8, 500 mm x 6, 400 mm x 2, 300 mm x 7.
- Connettori: connettori a L 4040 x 28, connettori a T 4040 x 4, connettore angolare a 45 gradi 4040 x 1, e squadrette angolari 4040 e dadi scorrevoli per cava a T.
- Tappi 4040 e, per il montaggio dei robot: viti M6 da 20 mm e dadi a T M6 per 4040.
- La colonna delle quantità del tutorial indica il numero di confezioni da acquistare e il testo del link indica i pezzi per confezione (per esempio 4 confezioni da 2 per le barre da 800 mm). Confronta le dimensioni delle confezioni con il numero di pezzi indicato sopra prima di ordinare.
4.2 Costruisci il telaio dal modello Fusion360
L'unica istruzione del tutorial per il telaio è seguirne il modello CAD.
- Segui i file CAD indicati nel tutorial. Seleziona Model Browser per vedere l'elenco dei componenti e fai clic su un componente per evidenziarlo. L'etichetta 4040-50 indica una trave da 50 cm.
- Il resto del telaio usa viti M8. Il montaggio del robot usa invece M6 (passaggio successivo).
- Secondo il tutorial, il progetto del telaio del robot è disponibile anche presso Vention (credito: Robert Shuttleworth).
- Il tutorial non dice come il telaio si fissa alla base Tracer.
4.3 Monta i bracci leader e follower
Entrambi i tipi di braccio si imbullonano al telaio con viti M6 da 20 mm e dadi a T M6 per 4040, sei viti per il braccio leader e due per il braccio follower.
- A differenza del resto del telaio, che ha viti M8, il robot va montato con M6 (vedi M6 20mm e dadi a T M6 per 4040 nella distinta base).
- Braccio leader (sinistro): fissa il robot al telaio con 6 viti M6. Il lato anteriore della piastra di base del robot deve essere allineato con i profilati.
- Braccio follower (sinistro): il robot si fissa al telaio con 2 viti M6.
- Nel tutorial ALOHA originale i bracci WidowX più piccoli sono i leader (master) e i bracci ViperX più grandi sono i follower (puppet).
4.4 Monta la telecamera frontale
La webcam frontale è fissata con nastro a una trave e la sua angolazione è bloccata con colla a caldo.
- Per montare la telecamera anteriore, fissa con nastro adesivo la base della webcam Logitech sopra la trave, poi usa la colla a caldo per bloccare l'angolazione della telecamera.
- Il tutorial mostra la trave da usare ed esempi di inquadrature (anteriore, sinistra, destra) solo in fotografie.
4.5 Facoltativo: compensazione della gravità per i bracci leader
Elastici attorno a viti M2.5 x 20 mm alla spalla e al gomito, e un elastico al polso.
- La compensazione della gravità dell'ALOHA originale è troppo ingombrante per l'uso mobile, quindi il tutorial propone una riprogettazione (in parte ispirata a GELLO).
- Giunto della spalla: usa 4 viti M2.5 da 20 mm e avvolgile con elastici. Procedi allo stesso modo per il giunto del gomito.
- Aggiungi un elastico al giunto del polso per riportarlo nella posizione di riposo. Secondo il tutorial, questo è importante per evitare che il giunto si ribalti di 180 gradi.
- Nota dal tutorial: con il tempo le viti potrebbero piegarsi a causa delle sollecitazioni.
5. Cablaggio di alimentazione e USB
La fonte originale descrive la disposizione di alimentazione e USB in brevi paragrafi e fotografie. Non indica tensione né polarità per il cablaggio con capicorda a forcella; per questo usa il manuale dell'alimentatore stesso.
5.1 Alimentazione
Un pacco batteria sulle travi inferiori alimenta un alimentatore DC per tutti e quattro i bracci e l'alimentatore del portatile.
- Appoggia il pacco batteria sopra le travi inferiori.
- Per alimentare i bracci ALOHA, segui il tutorial ALOHA originale, poi collega l'alimentatore direttamente al pacco batteria.
- Il tutorial ALOHA originale avverte che l'alimentatore fornito con il ViperX può essere instabile e usa un unico alimentatore separato che alimenta tutti e 4 i robot insieme, con 4 cavi verso i robot. L'estremità femmina di ogni cavo viene tagliata e sostituita con capicorda a forcella, come descritto nelle istruzioni dell'alimentatore.
- Collega anche l'alimentatore del portatile direttamente al pacco batteria.
- La distinta base di Mobile ALOHA elenca un alimentatore DC da 600W, 5 cavi DC da 12V e capicorda a forcella.
5.2 Collegamenti USB
La base Tracer si collega tramite il convertitore fornito in dotazione, e tutto il resto passa da due hub o da porte dirette.
- Per collegare la base Tracer al portatile, usa il convertitore USB-CAN bus fornito con la base.
- Il tutorial usa due hub USB. Hub 1: i cavi USB dei bracci robotici, 1 USB per la base Tracer e 1 telecamera anteriore. Hub 2: le 2 telecamere da polso. I due hub si collegano al portatile sul lato sinistro e su quello destro.
- Il cavo da Micro-B a USB-A fornito con il WidowX o il ViperX può essere troppo corto. Il tutorial ALOHA originale usa invece un cavo da 10 ft e avverte che il cavo originale più una prolunga USB non funziona.
- Il README dice di non usare prolunghe né hub USB per i quattro robot, e il tutorial ALOHA originale dice lo stesso. Questo contraddice l'hub 1 descritto sopra: segui il README e collega i quattro robot direttamente al portatile, facendo passare dagli hub solo le telecamere (massimo 2 per hub) e il convertitore del Tracer.
- Il tutorial ALOHA originale indica che il computer deve avere almeno 6 porte USB: 4 per i robot e 2 per le telecamere.
- A questo punto, secondo il tutorial, dovresti poter teleoperare entrambi i bracci una volta configurato il software.
6. Odometria delle ruote
Le letture delle ruote del Tracer stesso non si possono usare per la registrazione, perché le sue ruote sono mantenute in coppia ogni volta che è alimentato. Stanford aggiunge un'unità di odometria separata su ciascun lato della base. Il tutorial fornisce l'elenco delle parti e il cablaggio, ma il montaggio delle unità sulla base è mostrato solo in fotografie, e il suo ultimo passaggio fa riferimento a una configurazione dei motori nel README del repository che il README non contiene.
6.1 Stampa le sei parti dell'odometria
Due ruote, due supporti e due alloggiamenti si stampano dai file collegati nel tutorial.
- Stampa 6 pezzi in totale: Wheel (2), Mount (2), Housing (2). I file sono collegati dal tutorial come file STL, STEP e Fusion360.
- L'odometria delle ruote serve a registrare la velocità della base durante la raccolta dati in teleoperazione. Le ruote del Tracer vengono messe automaticamente in coppia quando è alimentato, quindi la base viene spenta e per i dati si usa questa unità.
6.2 Prepara i due motori DYNAMIXEL XL430-W250-T
Si rimuove l'ingranaggio accanto all'albero motore, così il motore gira liberamente e funziona solo da encoder.
- I Dynamixel servono solo a leggere la velocità della base, come un encoder. L'attrito degli ingranaggi potrebbe far slittare la ruota sul pavimento, quindi l'albero viene scollegato dal motore DC interno.
- Togli la squadretta seguendo la guida DYNAMIXEL X-Series Horn Disassembly, oppure con la forza.
- Apri la scatola del Dynamixel seguendo il video DYNAMIXEL Gear Replacement (AX-Series) fino a 0:41. Il motore usato nel video è diverso dall'XL430 ma ha una struttura simile.
- Togli l'ingranaggio più vicino all'albero del motore, poi rimonta tutto.
6.3 Monta un'unità su ogni lato della base
Ogni lato ha un XL430-W250-T, una ruota, un supporto e un alloggiamento, con nastro antiscivolo sulla ruota e un peso sopra.
- Monta l'unità su entrambi i lati della base. Per ogni lato servono 1 DYNAMIXEL XL430-W250-T, 1 ruota, 1 supporto e 1 alloggiamento.
- Per ridurre lo slittamento tra le ruote e il pavimento, avvolgi le ruote con nastro antiscivolo e aggiungi peso sopra l'alloggiamento.
- Il tutorial non fornisce istruzioni scritte per fissare il supporto al Tracer. Usa le sue fotografie.
6.4 Collega i motori dell'odometria al portatile
Entrambi i motori vanno a un U2D2 Power Hub Board Set, poi a un U2D2, poi direttamente al portatile via USB.
- Collega entrambi i motori all'U2D2 Power Hub Board Set con il cavo fornito con il motore e i cavetti jumper.
- Collega l'U2D2 Power Hub Board Set all'U2D2.
- Collega l'U2D2 al portatile direttamente via USB.
- Aggiungi un altro cavo DC da 12V all'alimentatore da 12V e collegalo all'U2D2 Power Hub Board Set.
- L'ultimo passaggio del tutorial dice di configurare entrambi i motori seguendo il tutorial nel repository Mobile ALOHA. Il README, nella versione consultata, non ha una sezione al riguardo.
7. Software e primi controlli
Tutto questo proviene dal README del repository. Le configurazioni provate sono Ubuntu 18.04 o 20.04 con ROS 1 noetic.
7.1 Installa ROS e il repository
Il software interbotix di Trossen crea il workspace in cui si clona il repository.
- Installa ROS e il software interbotix seguendo la documentazione interbotix_xsarms di Trossen Robotics. Questo crea la directory ~/interbotix_ws, che contiene src.
- Clona il repository mobile-aloha dentro ~/interbotix_ws/src.
- Esegui: source /opt/ros/noetic/setup.sh && source ~/interbotix_ws/devel/setup.sh
- Esegui: sudo apt-get install ros-noetic-usb-cam && sudo apt-get install ros-noetic-cv-bridge
- Esegui catkin_make dentro ~/interbotix_ws e assicurati che la compilazione vada a buon fine.
- Vai a ~/interbotix_ws/src/interbotix_ros_toolboxes/interbotix_xs_toolbox/interbotix_xs_modules/src/interbotix_xs_modules/arm.py e trova la funzione publish_positions. Cambia self.T_sb = mr.FKinSpace(self.robot_des.M, self.robot_des.Slist, self.joint_commands) in self.T_sb = None. Così il codice smette di calcolare la cinematica diretta a ogni passo, cosa che rallenta la teleoperazione.
7.2 Individua i quattro robot e assegna a ciascuno un nome di porta fisso
Dynamixel Wizard conferma ogni robot, poi le regole udev associano ciascuno a un nome fisso.
- Collega i 4 robot al computer via USB e accendili. Non usare prolunghe né hub USB.
- Installa Dynamixel Wizard. Aprilo, entra nelle opzioni e seleziona: Protocol 2.0, All ports, 1000000 bps, intervallo ID 0-10. Ripeti questa impostazione ogni volta prima di eseguire la scansione.
- Premi Scan. Dovrebbero comparire 4 dispositivi, ciascuno con 9 motori.
- La porta a cui si associa ogni robot può cambiare nel tempo (per esempio ttyUSB0 può diventare ttyUSB5), quindi associa ciascuno a un collegamento simbolico fisso: ttyDXL_master_right, ttyDXL_puppet_right, ttyDXL_master_left, ttyDXL_puppet_left. Master è il robot che l'operatore tiene in mano; puppet è il robot che esegue il compito.
- Per ogni robot: trova la sua porta attuale, per esempio ttyUSB0. Esegui: udevadm info --name=/dev/ttyUSB0 --attribute-walk | grep serial. Usa il primo numero di serie che compare (ha un aspetto simile a FT6S4DSP).
- Esegui: sudo vim /etc/udev/rules.d/99-fixed-interbotix-udev.rules e aggiungi questa riga, con il tuo numero di serie e il nome del collegamento simbolico per quel robot: SUBSYSTEM=="tty", ATTRS{serial}=="<serial number here>", ENV{ID_MM_DEVICE_IGNORE}="1", ATTR{device/latency_timer}="1", SYMLINK+="ttyDXL_master_right"
- Ripeti per gli altri 3 robot, poi esegui: sudo udevadm control --reload && sudo udevadm trigger
- Se ha funzionato, in /dev compaiono le voci ttyDXL*.
7.3 Limita la corrente del motore della pinza sui bracci puppet
Un limite di corrente di 300 sul motore del polso del puppet evita gli errori di sovraccarico.
- In Dynamixel Wizard, seleziona il motore del polso di un braccio puppet. Si chiama [ID:009] XM430-W350.
- Suggerimento: il LED sulla base del robot lampeggia quando comunica con Dynamixel Wizard, e così mostra quale robot è selezionato.
- Trova 38 Current Limit, inserisci 300, poi premi save in basso.
- Ripeti per entrambi i robot puppet. Questo limita la corrente massima nei motori delle pinze ed evita errori di sovraccarico.
7.4 Assegna nomi fissi alle tre telecamere
Ogni telecamera riceve un symlink udev, così mantiene lo stesso nome.
- Puoi usare un hub USB per le telecamere, ma con un massimo di 2 telecamere per hub per una latenza ragionevole.
- Per impostazione predefinita le telecamere si associano a /dev/video0, /dev/video1 e così via. I collegamenti simbolici richiesti sono CAM_RIGHT_WRIST, CAM_LEFT_WRIST e CAM_HIGH.
- Per CAM_RIGHT_WRIST, se si trova su /dev/video0, esegui: udevadm info --name=/dev/video0 --attribute-walk | grep serial. Usa il primo numero di serie che compare (ha un aspetto simile a 0E1A2B2F).
- Esegui: sudo vim /etc/udev/rules.d/99-fixed-interbotix-udev.rules e aggiungi: SUBSYSTEM=="video4linux", ATTRS{serial}=="<serial number here>", ATTR{index}=="0", ATTRS{idProduct}=="085c", ATTR{device/latency_timer}="1", SYMLINK+="CAM_RIGHT_WRIST"
- Ripeti per CAM_LEFT_WRIST e CAM_HIGH, poi esegui: sudo udevadm control --reload && sudo udevadm trigger
- Se ha funzionato, in /dev compaiono CAM_RIGHT_WRIST, CAM_LEFT_WRIST e CAM_HIGH.
7.5 Configura la base Tracer per il computer
La base si collega con il suo cavo CAN-USB di serie e si attiva come can0.
- Collega la base al computer con il cavo CANBUS-USB in dotazione e accendila.
- Installa l'SDK di AgileX: pip3 install pyagxrobots
- Abilita il modulo del kernel gs_usb: sudo modprobe gs_usb
- Attiva il dispositivo CAN: sudo ip link set can0 up type can bitrate 500000
- Se non ci sono stati errori, il dispositivo can compare con: ifconfig -a
- Installa can-utils per testare l'hardware: sudo apt install can-utils
- Ricevi i dati da can0 con: candump can0
7.6 Avvia i robot e le telecamere
Un unico file di launch avvia i 4 robot e le 3 telecamere.
- Apri un nuovo terminale. Se conda compare per impostazione predefinita, esegui: conda deactivate
- Esegui: source /opt/ros/noetic/setup.sh && source ~/interbotix_ws/devel/setup.sh
- Esegui: roslaunch aloha 4arms_teleop.launch
- Se non compaiono messaggi di errore, il computer è collegato a tutte e 3 le telecamere, a tutti e 4 i bracci robotici e alla base del robot.
- Risoluzione dei problemi: assicurati che Dynamixel Wizard sia disconnesso e che nessuna app stia usando un flusso della webcam. Entrambe le cose impediscono a ROS di collegarsi a questi dispositivi.
7.7 Installa l'ambiente Python
Un ambiente conda chiamato aloha con Python 3.8.10.
- Esegui: conda create -n aloha python=3.8.10
- Esegui: conda activate aloha
- Poi installa ciascuno di questi con pip install: torchvision, torch, pyquaternion, pyyaml, rospkg, pexpect, mujoco, dm_control, opencv-python, matplotlib, einops, packaging, h5py, tqdm, wandb.
- Il repository mobile-aloha non ha un requirements.txt né un catkin_ws; il workspace è ~/interbotix_ws.
7.8 Prova la teleoperazione
Ogni mano ha il proprio terminale e la teleoperazione inizia quando la pinza del leader viene chiusa.
- Prima di eseguire questi comandi, porta tutti e 4 i robot nelle loro posizioni di riposo e apri la pinza del robot master. Tutti i robot si solleveranno a un'altezza comoda per la teleoperazione.
- Terminale ROS: conda deactivate, poi source /opt/ros/noetic/setup.sh && source ~/interbotix_ws/devel/setup.sh, poi roslaunch aloha 4arms_teleop.launch
- Terminale della mano destra: conda activate aloha, poi cd ~/interbotix_ws/src/aloha/aloha_scripts, poi python3 one_side_teleop.py right
- Terminale della mano sinistra: lo stesso, con python3 one_side_teleop.py left
- La teleoperazione inizia quando si chiude la pinza del lato master.
7.9 Registra, visualizza e riproduci un episodio
record_episodes.py richiede un nome di task presente in constants.py e salva nella cartella di quel task.
- In un nuovo terminale esegui: conda activate aloha, poi cd ~/interbotix_ws/src/aloha/aloha_scripts
- Registra un episodio con: python3 record_episodes.py --task_name aloha_mobile_dummy --episode_idx 0
- In questa versione lo script richiede --task_name e accetta un --episode_idx facoltativo. Legge la cartella di salvataggio, la durata dell'episodio e le telecamere dalla voce corrispondente in constants.py. aloha_mobile_dummy è una di queste voci e salva in ~/data/aloha_mobile_dummy. L'esempio del README, che usa --dataset_dir, non corrisponde allo script.
- L'episodio viene salvato come file hdf5. Per cambiare la durata dell'episodio e altre impostazioni, modifica direttamente constants.py.
- Per visualizzare un episodio: python3 visualize_episodes.py --dataset_dir <data save dir> --episode_idx 0
- Per riprodurre un episodio con il robot reale: python3 replay_episodes.py --dataset_dir <data save dir> --episode_idx 0
- Per abbassare i 4 robot prima, per esempio, di togliere l'alimentazione: python3 sleep.py
- Per addestrare policy di apprendimento per imitazione, il README rimanda ad ACT for Mobile ALOHA, nel repository separato act-plus-plus.