Firefighting Robot (8 / 8 stap)

Stap 8: Programma en draad van de Arduino

Hier is de code die we gebruikt te maken van de motoren en water cannon werk wanneer aangesloten op een knop/trigger. (zie bijgevoegde afbeelding om te zien hoe de arduino verbinden met het breadboard.)
VOID Setup
{
Serial.begin(9600);
pinMode (2, OUTPUT);
pinMode (3, OUTPUT);
pinMode (7, INPUT);
pinMode (12, OUTPUT);
pinMode (13, OUTPUT);
pinMode (8, INPUT);
pinMode (4, OUTPUT);
pinMode (5, OUTPUT);
pinMode (6, OUTPUT);
}

Motors-werk maken met de knop code (het is gestuurd met behulp van een potentiometer (potmeter):
void loop
{
Als (digitalRead(7) == laag)
{
digitalWrite (13, hoge);
int x = analogRead(1);
Serial.Print(x);
Serial.Print("\n");
Als (x < 1023/3) {}
Sla linksaf
digitalWrite (2, laag);
digitalWrite (3, hoge);
}
anders als (x > 2 * 1023/3) {}
Sla rechtsaf
digitalWrite (2, HIGH);
digitalWrite (3, laag);
}
else {}
voorwaarts
digitalWrite (2, HIGH);
digitalWrite (3, hoge);
}
}
anders
{
digitalWrite (13, laag);
digitalWrite (2, laag);
digitalWrite (3, laag);
}

Code om te laten de waterkanonnen werken met een knop:
Als (digitalRead(8) == laag)
{
Releases ventiel
digitalWrite (12, hoge);
}
anders
{
digitalWrite (12, laag);
}

Code om te vertellen welke richting de robot wordt verplaatst wanneer de trigger wordt gedrukt met behulp van een drie gekleurde LED licht:
int x = analogRead(1);
Als (x < 1023/3) {}
digitalWrite (4, HIGH);
digitalWrite (5, laag);
digitalWrite (6, laag);
}
anders als (x > 2 * 1023/3) {}
digitalWrite (6, hoge);
digitalWrite (4, laag);
digitalWrite (5, laag);
}
else {}
digitalWrite (5, hoge);
digitalWrite (4, laag);
digitalWrite (6, laag);
}
}

Hieronder is een afbeelding van de arduino bekabeld volgens de pinnen die we geprogrammeerd.
De blauwe draden verbonden met de de MOSFET gaan in digitale pinnen 2 en 3 om te controleren van de motoren; de LED is aangesloten op de digitale pinnen 4, 5 en 6; de knoppen zijn aangesloten op pinnen 12 en 13. De potentiometer is aangesloten op de analoge pin 1.