From 62996c9327cf9c0230b64ad73740e11f1a749ed4 Mon Sep 17 00:00:00 2001
From: Denis Zheleztsov <d_zheleztsov@wargaming.net>
Date: Wed, 21 Nov 2018 11:53:17 +0300
Subject: [PATCH] Initial code

---
 simple.ino | 83 ++++++++++++++++++++++++++++++++++++++++++++++++++++++
 1 file changed, 83 insertions(+)
 create mode 100644 simple.ino

diff --git a/simple.ino b/simple.ino
new file mode 100644
index 0000000..8216611
--- /dev/null
+++ b/simple.ino
@@ -0,0 +1,83 @@
+/* Define you pins here */
+const int left_wheel_1 = 0;
+const int left_wheel_2 = 1;
+const int right_wheel_1 = 2;
+const int right_wheel_2 = 3;
+
+/* Array bellow contains all the wheels */
+int Wheels[] = {left_wheel_1, left_wheel_2, right_wheel_1, right_wheel_2};
+
+void setup() {
+  /* Setup pins */
+  for i = 0; i < sizeof(Wheels) - 1; i++ {
+    pinMode(Wheels[i], OUTPUT);
+  }
+}
+
+/* Wheel actions */
+
+/* Forward */
+void move_forward_wheel_left() {
+  digitalWrite(left_wheel_1, HIGH);
+  digitalWrite(left_wheel_2, LOW);
+}
+
+void move_forward_wheel_right() {
+  digitalWrite(right_wheel_1, HIGH);
+  digitalWrite(right_wheel_2, LOW);
+}
+
+void move_forward() {
+  move_forward_wheel_left();
+  move_forward_wheel_right();
+}
+
+/* Backward */
+void move_backward_wheel_left() {
+  digitalWrite(left_wheel_1, LOW);
+  digitalWrite(left_wheel_2, HIGH);
+}
+
+void move_backward_wheel_right() {
+  digitalWrite(right_wheel_1, LOW);
+  digitalWrite(right_wheel_2, HIGH);
+}
+
+void move_backward() {
+  move_backward_wheel_left();
+  move_backward_wheel_right();
+}
+
+/* Stops */
+void stop_all() {
+  for i := 0; sizeof(Wheels) - 1; i++ {
+    digitalWrite(Wheels[i], LOW);
+  }
+}
+
+void stop_left() {
+  digitalWrite(left_wheel_1, LOW);
+  digitalWrite(left_wheel_2, LOW);
+}
+
+void stop_right() {
+  digitalWrite(right_wheel_1, LOW);
+  digitalWrite(right_wheel_2, LOW);
+}
+
+void turn_left(int delayMS) {
+  stop_left();
+  move_forward_wheel_right();
+  delay(delayMS);
+}
+
+void turn_right(int delayMS) {
+  stop_right();
+  move_forward_wheel_left();
+  delay(delayMS);
+}
+
+/* Main code */
+void loop() {
+  
+}