Added code for basic motor control

Author: wizardofrobots

README.md

@@ -0,0 +1,6 @@
+# BeachRover Repo Code
+Find here the code for the beachRover. Add and share code!
+## Folders
+
+1. **beachRover-v1-arduino** - code for the arduino
+2. **jetson-detector** - add code here for the nano

beachRover-v1-arduino/beachRover-v1-arduino.ino

@@ -0,0 +1,26 @@
+#ifndef MOTOR_DRIVER_H
+#include "motor_driver.h"
+#endif
+
+
+void setup() {
+  pinMode(LEFT_INPUT_1, OUTPUT);
+  pinMode(LEFT_INPUT_2, OUTPUT);
+  pinMode(RIGHT_INPUT_1, OUTPUT);
+  pinMode(RIGHT_INPUT_2, OUTPUT);
+}
+
+void loop() {
+  driveMotor(left_turn);
+  delay(500);
+  driveMotor(stop_moving);
+  delay(500);
+  driveMotor(right_turn);
+  delay(500);
+  driveMotor(stop_moving);
+  delay(500);
+  driveMotor(straight);
+  delay(500);
+  driveMotor(stop_moving);
+  delay(500);
+}

beachRover-v1-arduino/motor_driver.cpp

@@ -0,0 +1,49 @@
+#ifndef MOTOR_DRIVER_H
+#include "motor_driver.h"
+#endif
+#include<Arduino.h>
+
+int LEFT_INPUT_1 = 16;
+int LEFT_INPUT_2 = 17;
+int RIGHT_INPUT_1 = 14;
+int RIGHT_INPUT_2 = 15;
+
+
+void driveMotor(turn direction) {
+  switch (direction) {
+    case left_turn:
+      digitalWrite(LEFT_INPUT_1, 1);
+      digitalWrite(LEFT_INPUT_2, 1);
+      digitalWrite(RIGHT_INPUT_1, 1);
+      digitalWrite(RIGHT_INPUT_2, 0);
+      break;
+    case right_turn:
+      digitalWrite(LEFT_INPUT_1, 1);
+      digitalWrite(LEFT_INPUT_2, 0);
+      digitalWrite(RIGHT_INPUT_1, 1);
+      digitalWrite(RIGHT_INPUT_2, 1);
+      break;
+    case straight:
+      digitalWrite(LEFT_INPUT_1, 1);
+      digitalWrite(LEFT_INPUT_2, 0);
+      digitalWrite(RIGHT_INPUT_1, 1);
+      digitalWrite(RIGHT_INPUT_2, 0);
+      break;
+    case stop_moving:
+      digitalWrite(LEFT_INPUT_1, 1);
+      digitalWrite(LEFT_INPUT_2, 1);
+      digitalWrite(RIGHT_INPUT_1, 1);
+      digitalWrite(RIGHT_INPUT_2, 1);
+      break;
+    case reverse:
+      digitalWrite(LEFT_INPUT_1, 0);
+      digitalWrite(LEFT_INPUT_2, 1);
+      digitalWrite(RIGHT_INPUT_1, 0);
+      digitalWrite(RIGHT_INPUT_2, 1);
+    default:
+      digitalWrite(LEFT_INPUT_1, 0);
+      digitalWrite(LEFT_INPUT_2, 0);
+      digitalWrite(RIGHT_INPUT_1, 0);
+      digitalWrite(RIGHT_INPUT_2, 0);
+  }
+}

beachRover-v1-arduino/motor_driver.h

@@ -0,0 +1,14 @@
+extern int LEFT_INPUT_1;
+extern int LEFT_INPUT_2;
+extern int RIGHT_INPUT_1;
+extern int RIGHT_INPUT_2;
+
+enum turn {
+  left_turn,
+  right_turn,
+  straight,
+  stop_moving,
+  reverse
+};
+
+void driveMotor(turn direction);