Questa è una vecchia versione del documento!
Indice
Project Work 3A
Idee
- dirigibile stile blimpduino, molto d'impatto ma serve elio e palloncino
- robot semplice 2 DOF tipo
Laser pointerlaser-pointer da archivive.org - robot scara tipo
Pybotpybot da archive.org - nastro trasportatore tipo questo su thingiverse con profili alluminio tipo questi di MISUMI (in alternativa si compra qualcosa tipo questo desktop conveyor)
Robot 2 DOF
E' un progetto ben documentato di jjrobots con software e modelli 3D disponibili da qui.
Mi piace perché:
- è semplice, sono solo due motori, non ci sono barre filettate
- è abbastanza facile stampare le parti 3D
- abbiamo già a scuola i motori e i driver
Pensato come robot a 2 assi per orientare un puntatore laser può montare anche altri payload (webcam, “pistole”, ecc.). La BOM è abbastanza ridotta:
| descrizione | numero | disponibile | prototipo |
|---|---|---|---|
| pezzi 3D stampati | 11 | manca solo il supporto payload che va creato su misura | |
| stepper nema17 | 2 | sì | da L03 |
| driver stepper | 2 | sì | a4988 da L03? |
| cavi motore | 2 | venduti col motore | come collegarli al driver? |
| puleggia GT2 20 denti | 2 | da kit amazon | |
| cuscinetti 6002RS or 6002ZZ | 2 | 5€ da cesena cuscinetti | |
| fascette 100x5mm | 10 | sì | nessuna |
| cinghia 200mm 200 GT2 | 3 | da acquistare | da kit amazon |
| fascetta avvolgi-cavo | 1 | opzionale | nessuna |
| ventose/piedini (rubber suction pad) | 3 | da acquistare | piedini da L51 o si fa senza |
| arduino zero | 1 | usare ESP32? | arduino uno |
| alimentatore 12V | 1 | sì | da laboratorio |
| viti M3 6mm | 6 | ? | 8mm e 3-4 6mm da lab51 |
| viti M3 10mm | 14 | da magazzino Comandini P09 | |
| viti M3 15mm | 10 | da lab51 | |
| viti M3 45mm | 4 | ? | 40mm da lab51 |
| dati M3 | 6 | ? | da lab51 |
Ho preso questo kit da amazon con due pulegge 20 denti (foro 5mm), due 60 denti e due cinghie (larghezza 6mm) lunghezza 200mm GT2. I cuscinetti li ho presi da cesena cuscinetti (i più economici 5€).
Il motore è collegato alla breadboard in questo modo:
In generale tutto il cablaggio è estremamente fragile e sarebbe opportuno progettare un PCB con driver e morsetti e un supporto stampato in PLA per alloggiare il tutto.
L'assemblaggio pone questi problemi:
- viti 6mm: ne ho poche, dove posso uso quelle da 8mm trovate nel lab51
- il pezzo cap non è chiaro da che verso si monti, seguo quello della foto anche se sembra strano
- motore: i NEMA17 di L03 sono compatibili con le misure di quelli indicati nel progetto ma poi non si riesce a fissarli con le viti da 40mm
- upper arm motor holder left: quello stampato non permette di montare il motore (la lunghezza delle viti da 40mm non è sufficiente e innestare il filetto del motore) e non si riesce a fissare upper arm motor right su upper right (i fori sono 2mm prima)
- seguendo le istruzioni di montaggio se si fissa prima il secondo motore poi non si riesce a montare la cinghia; l'ho fatto e ho spezzato il perno del cuscinetto in un pezzo
- anche la base non è adatta al nostro NEMA17 e le viti da 40mm non arrivano ad impegnare il filetto. Bisognerebbe rifare il pezzo ma ho preferito scavare i fori con una punta da 5mm guadagnando i 2-3mm che mancavano
Rifaccio il pezzo upper arm motor holder left ma lo traslo in basso di 2,7mm tagliando di fatto la parte che finisce sotto il piatto. Di fatto lo accorcio di quasi 3mm sperando che si adattino sia le viti che i fori dell'altro motor holder.
Software
// basato sugli esempi di AccelStepper (multiple steppers e proportional) // joystick analogico comanda la velocità ma c'è una posizione limite che non viene superata // il pulsante del joystick abilita/disabilita il driver (LED13 acceso se abilitato) // il pulsante è gestito con un interrupt sul fronte di discesa e il rimbalzo è gestito // trascurando commutazioni che si ripetono prima di 200ms // rapporti di riduzione altezza 64:20 (3,2), rotazione 80:20 (4) // 200 passi/giro diventano 640 e 800 passi/giro per altezza e rotazione // NB il driver disturba molto l'ingresso analogico -> servono alimentazioni separate // NB la seriale disturba il pilotaggio del motore, se attivata non gira correttamente! // libreria per gestire i motori stepper con driver A4988 #include <AccelStepper.h> // istanza con opzione DRIVER, pin 9 STEP e pin 8 DIR per rotazione AccelStepper stepper1(AccelStepper::DRIVER, 9, 8); // istanza con opzione DRIVER, pin 11 STEP e pin 10 DIR per altezza AccelStepper stepper2(AccelStepper::DRIVER, 11, 10); // piedini int pinPulsante = 2; int pinEnable = 7; // variabili aggiornate dall'interrupt service routine (ISR) volatile int enable = 1; // di default disabilitato perché attivo basso volatile unsigned long last_interrupt_time = 0; // ultimo interrupt volatile unsigned long interrupt_time = 0; // interrupt corrente // input dal joystick int analogX; // comanda la rotazione (0 = estremo sinistro) int analogY; // comanda l'altezza (0 = estremo superiore) int offset = 512; // posizione di riposo del joystick // controllo motori int velX = 0; // velocità in passi/s per stepper1 int velY = 0; // velocità in passi/s per stepper2 int posX = 120; // posizione limite per stepper1 (+-60° circa) int posY = 70; // posizione limite per stepper2 (+-45° circa) void setup() { // pullup interno per il pulsante joystick pinMode(pinPulsante, INPUT_PULLUP); // pin ENABLE del driver pinMode(pinEnable, OUTPUT); // disabilito driver digitalWrite(pinEnable, enable); // interrupt quando è premuto il pulsante abilitazione attachInterrupt(digitalPinToInterrupt(pinPulsante), toggle, FALLING); // impostazioni driver stepper1.setMaxSpeed(500); // 1 giri/s stepper -> 0.3 giri/s laser stepper2.setMaxSpeed(500); // debug seriale // NB il driver non funziona correttamente se attivata // Serial.begin(9600); } void loop() { // lettura posizione jostick analogX = analogRead(A0); analogY = analogRead(A1); // calcolo velocità velX = ((analogX - offset) / 10) * 8; // dividendo si elimina l'ultima cifra che è incerta velY = ((analogY - offset) / 10) * 8; // moltiplicando si ottiene un valore tra 0 e 204 passi/s // Serial.print(analogX); // Serial.print(" "); // Serial.print(analogY); // Serial.print(" "); // Serial.print(velX); // Serial.print(" "); // Serial.print(velY); // Serial.print(" "); // Serial.print(enable); // Serial.print(" "); // Serial.print(stepper1.speed()); // Serial.println(); // segnalazione dell'abilitazione col LED 13 if (enable) { digitalWrite(13, LOW); } else { digitalWrite(13, HIGH); } // movimento stepper1 if (velX > 0) { stepper1.moveTo(posX); // posizione da raggiungere stepper1.setSpeed(velX); // velocità con cui raggiungerla stepper1.runSpeedToPosition(); // muove il motore fino a destinazione } else if (velX < 0) { stepper1.moveTo(-posX); stepper1.setSpeed(velX); stepper1.runSpeedToPosition(); } else { stepper1.moveTo(posX); // probabilmente bastava mettere un blocco di codice vuoto stepper1.setSpeed(0); stepper1.runSpeedToPosition(); } // movimento stepper2 if (velY > 0) { stepper2.moveTo(posY); stepper2.setSpeed(velY); stepper2.runSpeedToPosition(); } else if (velY < 0) { stepper2.moveTo(-posY); stepper2.setSpeed(velY); stepper2.runSpeedToPosition(); } else { stepper2.moveTo(posY); stepper2.setSpeed(0); stepper2.runSpeedToPosition(); } } // ISR pressione pulsante void toggle() { // serve un debounce o commuta a caso per i rimbalzi // così commuta solo ogni 200 ms interrupt_time = millis(); // leggo il tempo dell'interrupt if (interrupt_time - last_interrupt_time > 200) { // se sono passati 200ms enable = !enable; // commuto enable digitalWrite(pinEnable, enable); // imposto il piedino corrispondente } last_interrupt_time = interrupt_time; // aggiorno il tempo dell'ultimo interrupt }

