In questa lezione mostrerò uno sketch di esempio in cui la velocità, il senso di rotazione e la durata di rotazione vengono passati come parametri alle funzioni che controllano il movimento del robot. Ovviamente potrete modificare e migliorare l’esempio proposto.
Si tenga in conto che questo tipo di controllo, sia per la bassa qualità dei servomotori utilizzati, e sia per la scelta del tipo di motore, non consente una regolazione precisa, ma in ogni caso ci permette di raggiungere gli obiettivi esposti nella lezione 1.
Lo schema di collegamento a cui farò riferimento sarà quello utilizzato nella lezione precedente, che indico di seguito.
L’inizializzazione dei servomotori viene eseguita nella stessa modalità come illustrato nella lezione 2.
Le funzioni principali di orientamento del robot permettono di controllare con discreta precisione:
- la velocità di rotazione;
- il senso di rotazione;
- il tempo di rotazione;
Le funzioni di controllo sono:
1 | antiorarioRobot() |
2 | orarioRobot() |
3 | stopRobot() |
Le tre funzioni al loro interno utilizzano il metodo write() sugli oggetti motoreDx e motoreSx.
Le funzioni prevedono due parametri di ingresso: velocità e durata della rotazione.
Con l’impostazione della velocità impostiamo anche il senso di rotazione. Nel caso di rotazione antioraria il valore dovrà essere compreso tra 90 e 180 ed il valore scelto stabilirà anche la velocità di rotazione.
La funzione antiorarioRobot() accetta due parametri di ingresso:
- velMaxAntioraria, massima velocità oraria
- durata, indica la durata della rotazione in millisecondi
in questo caso i valori inseriti per la velocità dovranno essere compresi tra 0 e 90:
1 | void antiorarioRobot(int velMaxAntioraria, int durata) { |
2 | motoreDX.write(velMaxAntioraria); // Rotazione antioraria del motore DX |
3 | motoreSX.write(velMaxAntioraria); // Rotazione antioraria del motore SX |
4 | delay(durata); // durata: durata della rotazione |
5 | } |
La funzione orarioRobot() funzionerà in modo simile:
1 | void orarioRobot(int velMaxOraria, int durata) { |
2 | motoreDX.write(velMaxOraria); // Rotazione oraria del motore DX |
3 | motoreSX.write(velMaxOraria); // Rotazione oraria del motore SX |
4 | delay(durata); // durata: durata della rotazione |
5 | } |
Come esercizio invito gli studenti a realizzare un’unica funzione di comando che ingloba le due precedenti in grado di realizzare qualsiasi tipo di movimento.
La funzione stopRobot() accetta come unico parametro la durata dello stop.
1 | void stopRobot(int ferma) { |
2 | motoreDX.write(90); // Ferma il motore DX |
3 | motoreSX.write(90); // Ferma il motore SX |
4 | delay(ferma); // Durata dello stop |
5 | } |
Lo sketch completo è il seguente:
1 | /* |
2 | * Prof. Maffucci Michele |
3 | * SumoRobot |
4 | * Data: 26.01.2021 |
5 | * |
6 | * Sketch 02: rotazione oraria e antioraria continua |
7 | * con funzioni parametrizzate |
8 | * |
9 | * Note: |
10 | * L'orientamento dei motori è fatto |
11 | * guardano il robot anteriormente |
12 | * |
13 | * 180: max velocità in senso antiorario |
14 | * 90 : servomotori fermi |
15 | * 0 : max velocità in senso orario |
16 | * |
17 | */ |
18 |
19 | // inclusione della libreria servo.h per il controllo dei servomotori |
20 | #include <Servo.h> |
21 |
22 | // Creazione oggetti servo |
23 | Servo motoreDX; // Inizializzazione del servomotore destro |
24 | Servo motoreSX; // Inizializzazione del servomotore sinistro |
25 |
26 | byte pinDx = 4; // Inizializza del pin 4 a cui è connesso il pin segnale del servo destro |
27 | byte pinSx = 5; // Inizializza del pin 5 a cui è connesso il pin segnale del servo sinistro |
28 |
29 | void setup() { |
30 |
31 | // attach() consente di definire a quale pin viene connesso il servomotore |
32 | // e lo collega all'oggetto che gestisce il servomotore |
33 | |
34 | motoreDX.attach(pinDx); // pinDx collegato al motore destro |
35 | motoreSX.attach(pinSx); // pinSx collegato al motore sinistro |
36 | } |
37 |
38 | void loop() { |
39 | orarioRobot(30, 250); // Rotazione in senso orario del robot |
40 | stopRobot(3000); // Stop rotazione per un tempo fissato (vedere variabile ferma) |
41 | antiorarioRobot(150, 250); // Rotazione in senso antiorario del robot |
42 | stopRobot(3000); // Stop rotazione per un tempo fissato (vedere variabile ferma) |
43 | } |
44 |
45 | // rotazione del robot in senso antiorario |
46 | // velMaxOraria: velocità massima in senso antiorario |
47 | // durata: durata della rotazione |
48 |
49 | void antiorarioRobot(int velMaxAntioraria, int durata) { |
50 | motoreDX.write(velMaxAntioraria); // Rotazione antioraria del motore DX |
51 | motoreSX.write(velMaxAntioraria); // Rotazione antioraria del motore SX |
52 | delay(durata); // durata: durata della rotazione |
53 | } |
54 |
55 | // rotazione del robot in senso orario |
56 | // velMaxOraria: velocità massima in senso orario |
57 | // durata: durata della rotazione |
58 |
59 | void orarioRobot(int velMaxOraria, int durata) { |
60 | motoreDX.write(velMaxOraria); // Rotazione oraria del motore DX |
61 | motoreSX.write(velMaxOraria); // Rotazione oraria del motore SX |
62 | delay(durata); // durata: durata della rotazione |
63 | } |
64 |
65 | // stop del robot |
66 | // ferma: durata dello stop del robot |
67 |
68 | void stopRobot(int ferma) { |
69 | motoreDX.write(90); // Ferma il motore DX |
70 | motoreSX.write(90); // Ferma il motore SX |
71 | delay(ferma); // Durata dello stop |
72 | } |
I tempi indicati inseriti nelle funzioni all’interno del loop potranno essere modificati secondo necessità.
Esercizio 01
Elenca le cause che provocano errori nel far ruotare precisamente di un determinato angolo scelto il robot.
Esercizio 02
Utilizzando un filo di connessione e modificando lo sketch precedente siete in grado di realizzare n sistema di START/STOP del robot.
Buon Coding a tutti 