Stap 3: Code
-> Using arduino compiler uploaden met de volgende code in arduino
Skype robot-code
geschreven door vineethvarma.inventions / / bezoek www.vineethvarma.com
VOID Setup
{
pinMode(2,INPUT); dtmf module pinnen d1, d2, d3, d4 verbinden met 2,3,4,5 pinnen in arduino
pinMode(3,INPUT);
pinMode(4,INPUT);
pinMode(5,INPUT);
pinMode(7,OUTPUT); / / 7,8 pinnen verbinden met motor1 in motor-stuurprogramma
pinMode(8,OUTPUT);
pinMode(9,OUTPUT); 9,10 pinnen verbinden motor2 in motor-stuurprogramma
pinMode(10,OUTPUT); }
void loop
{
int d1, d2, d3, d4;
D1=digitalRead(2);
D2=digitalRead(3);
D3=digitalRead(4);
D4=digitalRead(5);
Als (d1 == 0 & & d2 == 0 & & d3 == 1 & & d4 == 0) / / als 2 is ingedrukt robo gaat vooruit
{
digitalWrite(7,1);
digitalWrite(8,0);
digitalWrite(9,1);
digitalWrite(10,0);
}
anders als (d1 == 0 & & d2 == 1 & & d3 == 0 & & d4 == 0) / / als 4 wordt gedrukt robo draait links
{
digitalWrite(7,1);
digitalWrite(8,0);
digitalWrite(9,0);
digitalWrite(10,1);
}
anders als (d1 == 0 & & d2 == 1 & & d3 == 1 & & d4 == 0) / / als 6 wordt ingedrukt robo draait rechts
{
digitalWrite(7,0);
digitalWrite(8,1);
digitalWrite(9,1);
digitalWrite(10,0);
}
anders als (d1 == 1 & & d2 == 0 & & d3 == 0 & & d4 == 0) / / als 8 wordt gedrukt robo achterwaarts verplaatst
{
digitalWrite(7,0);
digitalWrite(8,1);
digitalWrite(9,0);
digitalWrite(10,1);
}
anders als (d1 == 0 & & d2 == 1 & & d3 == 0 & & d4 == 1) / / als 5 robo stopt wordt ingedrukt
{digitalWrite(7,0);
digitalWrite(8,0);
digitalWrite(9,0);
digitalWrite(10,0);
}
}