Arduino-Robot/WirelessControl.ino at main · TodorAndrei/Arduino-Robot · GitHub

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
88
89
90
91
92
93
94
95
#include <IRremote.h>

const int RECV_PIN = 13;
IRrecv irrecv(RECV_PIN);
decode_results results;

int enA=5;
int in1=7;
int in2=8;
int enB=6;
int in3=9;
int in4=10;

void setup(){
  pinMode(enA, OUTPUT);
  pinMode(in1, OUTPUT);
  pinMode(in2, OUTPUT);

  pinMode(enB, OUTPUT);
  pinMode(in3, OUTPUT);
  pinMode(in4, OUTPUT);

  Serial.begin(9600);
  irrecv.enableIRIn();
}

void loop(){
  if (irrecv.decode(&results)){
        Serial.println(results.value);

        switch(results.value) {
          case 16718055:
            pedala(255, 255);
            break;

          case 16734885:
            pedala(160, -160);
            break;

          case 16730805:
            pedala(-255, -255);
            break;

          case 16716015:
            pedala(-160, 160);
            break;

          case 16726215:
            pedala(0, 0);
            break;
        }
        irrecv.resume();
  }

}

void pedala(int left, int right)
{
  if (left < 0)
  {
    digitalWrite(in1,LOW);
    digitalWrite(in2,HIGH);
    analogWrite(enA, abs(left));
  }
  if (left > 0)
  {
    digitalWrite(in1,HIGH);
    digitalWrite(in2,LOW);
    analogWrite(enA, left);
  }
  if (left == 0)
  {
    digitalWrite(in1, LOW);
    digitalWrite(in2, LOW);
    analogWrite(enA, 0);
  }
  if (right < 0)
  {
    digitalWrite(in3, LOW);
    digitalWrite(in4, HIGH);
    analogWrite(enB, abs(right));
  }
  if (right > 0)
  {
    digitalWrite(in3, HIGH);
    digitalWrite(in4, LOW);
    analogWrite(enB, right);
  }
  if (right == 0)
  {
    digitalWrite(in3, LOW);
    digitalWrite(in4, LOW);
    analogWrite(enB, 0);
  }
}