From f4f1b9c3005d006cc87790e8be947ab4a960c378 Mon Sep 17 00:00:00 2001
From: mrbesen <y.g.2@gmx.de>
Date: Thu, 19 Dec 2019 09:16:48 +0100
Subject: [PATCH] SimpleBot init

---
 SimpleBot/SimpleBot.ino | 54 +++++++++++++++++++++++++++++++++++++++++
 1 file changed, 54 insertions(+)
 create mode 100644 SimpleBot/SimpleBot.ino

diff --git a/SimpleBot/SimpleBot.ino b/SimpleBot/SimpleBot.ino
new file mode 100644
index 0000000..16ff274
--- /dev/null
+++ b/SimpleBot/SimpleBot.ino
@@ -0,0 +1,54 @@
+#define OVERTURN 200  //ms um wieviel überdreht wird
+
+#define MOTORL 4     //motor pin links, on/off
+#define MOTORLMODE 5 //motor pin links, mode
+#define MOTORRMODE 6
+#define MOTORR 7
+
+#define SR analogRead(1) < 500  //Bedining, rechts - Schwarz
+#define SL analogRead(2) < 500  //Bedining, links  - Schwarz
+
+
+void setup() {
+ 
+ pinMode(4, OUTPUT);
+ pinMode(5, OUTPUT);
+ pinMode(6, OUTPUT);
+ pinMode(7, OUTPUT);
+
+
+ stop();
+}
+
+void vor() {
+  
+}
+
+void links() {
+  
+}
+
+void rechts() {
+  
+}
+
+void ruck() {
+  
+}
+
+void stop() {
+
+}
+
+void loop() {
+  vor();
+  if(SR) {
+    rechts();
+    delay(OVERTURN);
+  }
+  if(SL) {
+    links();
+    delay(OVERTURN);
+  }
+}
+