Sumo-Robot-Project/code/robot_control.ino at main · amssidds/Sumo-Robot-Project · 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
#include <Dabble.h>
#define INCLUDE_GAMEPAD_MODULE
#define CUSTOM_SETTINGS


int LEFT_WHEEL_FORWARD = 13;
int LEFT_WHEEL_BACKWARD = 12;
int RIGHT_WHEEL_BACKWARD = 10;
int RIGHT_WHEEL_FORWARD = 11;


void setup() {
  pinMode(LEFT_WHEEL_BACKWARD, OUTPUT);
  pinMode(LEFT_WHEEL_FORWARD, OUTPUT);
  pinMode(RIGHT_WHEEL_FORWARD, OUTPUT);
  pinMode(RIGHT_WHEEL_BACKWARD, OUTPUT);

  Serial.begin(9600);

  Dabble.begin(9600,0,1);
}

void loop() {

  Dabble.processInput();

 if (GamePad.isUpPressed()) {
      digitalWrite(LEFT_WHEEL_FORWARD, HIGH);
      digitalWrite(LEFT_WHEEL_BACKWARD, LOW);
      digitalWrite(RIGHT_WHEEL_BACKWARD, LOW);
      digitalWrite(RIGHT_WHEEL_FORWARD, HIGH);
      delay (10);
      digitalWrite(LEFT_WHEEL_FORWARD, LOW);
      digitalWrite(LEFT_WHEEL_BACKWARD, LOW);
      digitalWrite(RIGHT_WHEEL_BACKWARD, LOW);
      digitalWrite(RIGHT_WHEEL_FORWARD, LOW);
  }

  else if (GamePad.isDownPressed()) {
      digitalWrite(LEFT_WHEEL_FORWARD, LOW);
      digitalWrite(LEFT_WHEEL_BACKWARD, HIGH);
      digitalWrite(RIGHT_WHEEL_BACKWARD, HIGH);
      digitalWrite(RIGHT_WHEEL_FORWARD, LOW);
      delay (10);
      digitalWrite(LEFT_WHEEL_FORWARD, LOW);
      digitalWrite(LEFT_WHEEL_BACKWARD, LOW);
      digitalWrite(RIGHT_WHEEL_BACKWARD, LOW);
      digitalWrite(RIGHT_WHEEL_FORWARD, LOW);
  }

    else if (GamePad.isRightPressed()) {
      digitalWrite(LEFT_WHEEL_FORWARD, LOW);
      digitalWrite(LEFT_WHEEL_BACKWARD, HIGH);
      digitalWrite(RIGHT_WHEEL_BACKWARD, LOW);
      digitalWrite(RIGHT_WHEEL_FORWARD, HIGH);
      delay (10);
      digitalWrite(LEFT_WHEEL_FORWARD, LOW);
      digitalWrite(LEFT_WHEEL_BACKWARD, LOW);
      digitalWrite(RIGHT_WHEEL_BACKWARD, LOW);
      digitalWrite(RIGHT_WHEEL_FORWARD, LOW);

  }

  else if (GamePad.isLeftPressed()) {
      digitalWrite(LEFT_WHEEL_FORWARD, HIGH);
      digitalWrite(LEFT_WHEEL_BACKWARD, LOW);
      digitalWrite(RIGHT_WHEEL_BACKWARD, HIGH);
      digitalWrite(RIGHT_WHEEL_FORWARD, LOW);
      delay (10);
      digitalWrite(LEFT_WHEEL_FORWARD, LOW);
      digitalWrite(LEFT_WHEEL_BACKWARD, LOW);
      digitalWrite(RIGHT_WHEEL_BACKWARD, LOW);
      digitalWrite(RIGHT_WHEEL_FORWARD, LOW);
  }

  else if (GamePad.isSquarePressed()) {
       digitalWrite(LEFT_WHEEL_FORWARD, LOW);
       digitalWrite(LEFT_WHEEL_BACKWARD, LOW);
       digitalWrite(RIGHT_WHEEL_BACKWARD, LOW);
       digitalWrite(RIGHT_WHEEL_FORWARD, LOW);

  }

}