-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathTest_ruote.ino
87 lines (70 loc) · 2.88 KB
/
Test_ruote.ino
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
//***************************************************************************
//Programma test per il robot Poor versione 2
//Setto le porte di uscita per le funzioni:
//Integrato trovato sulla macchinetta SM6135W oppure RX2-C
//Avanti PIN 10 ---- Integrato 11
//Indieto PIN 9 ---- Integrato 10
//Destra PIN 5 ---- Integrato 6
//Sinistra PIN 6 ---- Integrato 7
//
//Realizzato da: Daniele loddo alias Ivotek
//Data: 22/08/2015
//Web: www.mignololab.org www.ivotek.it
//Email: [email protected] [email protected]
//***************************************************************************
//Dichiaro le variabili per utilizzare i nomi al posto dei numeri
//Spreco memoria ma il codice risulta leggibile al principiante
int Destra = 5;
int Sinistra = 6;
int Avanti = 10;
int Indietro = 9;
void setup() {
//Setto i PIN come out per pilotare i motori del robot.
pinMode(Avanti,OUTPUT); //Setto la porta Avanti come uscita
pinMode(Indietro,OUTPUT); //Setto la porta Indietro come uscita
pinMode(Destra,OUTPUT); //Setto la porta Destra come uscita
pinMode(Sinistra,OUTPUT); //Setto la porta Sinistra come uscita
}
void loop() {
//Porto le porte a livelo logico uno per mandare avanti il motorino
digitalWrite(Avanti, HIGH); // Il robot va avanti
digitalWrite(Indietro, LOW);
//Attendo un secondo
delay(1000);
//Porto le porte a livello logico zero per fermare il motorino
digitalWrite(Avanti, LOW); //Il robot si ferma
digitalWrite(Indietro, LOW);
//Attendo due secondo
delay(2000);
//Porto le porte a livello logico uno per mandare indietro il motorino
digitalWrite(Indietro, HIGH); //Il robot va indietro
digitalWrite(Avanti, LOW);
//Attendo un secondo
delay(1000);
//Porto le porte a livello logico zero per fermare il motorino
digitalWrite(Indietro, LOW); //Il robot si ferma
digitalWrite(Avanti, LOW);
//Attendo 2 secondi
delay(2000);
//Porto le porte a livelo logico uno per mandare avanti il motorino dello sterzo
digitalWrite(Destra, HIGH); // Il robot posiziona le ruote a destra
digitalWrite(Sinistra, LOW);
//Attendo un secondo
delay(1000);
//Porto le porte a livello logico zero per fermare il motorino
digitalWrite(Destra, LOW); //Il robot posiziona le ruote dritte
digitalWrite(Sinistra, LOW);
//Attendo due secondo
delay(2000);
//Porto le porte a livello logico uno per mandare indietro il motorino dello sterzo
digitalWrite(Sinistra, HIGH); //Il robot posiziona le ruote a sinistra
digitalWrite(Destra, LOW);
//Attendo un secondo
delay(1000);
//Porto le porte a livello logico zero per fermare il motorino
digitalWrite(Sinistra, LOW); //Il robot posiziona le ruote dritte
digitalWrite(Destra, LOW);
//Attendo 2 secondi
//Attendi 3 secondi prima di ripetere il ciclo
delay(3000);
}