Skype robot (3 / 5 steg)
Steg 3: kod
-> Använda arduino compiler ladda upp följande kod till arduino
Skype robot kod
Skrivet av vineethvarma.inventions / / Besök www.vineethvarma.com
void setup()
{
pinMode(2,INPUT); ansluta dtmf modul stift d1, d2, d3, d4 till 2,3,4,5 stiften i arduino
pinMode(3,INPUT);
pinMode(4,INPUT);
pinMode(5,INPUT);
pinMode(7,OUTPUT); / / Anslut 7.8 pins till motor1 i motor driver
pinMode(8,OUTPUT);
pinMode(9,OUTPUT); ansluta 9,10 stift till motor2 i motor driver
pinMode(10,OUTPUT); }
void loop()
{
int d1, d2, d3, d4;
D1=digitalRead(2);
D2=digitalRead(3);
D3=digitalRead(4);
D4=digitalRead(5);
om (d1 == 0 & & d2 == 0 & & d3 == 1 & & d4 == 0) / / om 2 trycks robo rör sig framåt
{
digitalWrite(7,1);
digitalWrite(8,0);
digitalWrite(9,1);
digitalWrite(10,0);
}
annars om (d1 == 0 & & d2 == 1 & & d3 == 0 & & d4 == 0) / / om 4 trycks robo varv vänster
{
digitalWrite(7,1);
digitalWrite(8,0);
digitalWrite(9,0);
digitalWrite(10,1);
}
annars om (d1 == 0 & & d2 == 1 & & d3 == 1 & & d4 == 0) / / om 6 trycks robo varv rätt
{
digitalWrite(7,0);
digitalWrite(8,1);
digitalWrite(9,1);
digitalWrite(10,0);
}
annars om (d1 == 1 & & d2 == 0 & & d3 == 0 & & d4 == 0) / / om 8 trycks robo rör sig bakåt
{
digitalWrite(7,0);
digitalWrite(8,1);
digitalWrite(9,0);
digitalWrite(10,1);
}
annars om (d1 == 0 & & d2 == 1 & & d3 == 0 & & d4 == 1) / / om 5 trycks robo hållplatser
{digitalWrite(7,0);
digitalWrite(8,0);
digitalWrite(9,0);
digitalWrite(10,0);
}
}