SOFTPWM

Multi-line description of commit,
feel free to be detailed.

[Issue: X]

1 files changed, 32 insertions, 0 deletions

diff --git a/code/debug/motors/basic-motor-dr/basic-motor-dr.ino b/code/debug/motors/basic-motor-dr/basic-motor-dr.ino
new file mode 100755
index 0000000..b7f3b36
--- /dev/null
+++ b/code/debug/motors/basic-motor-dr/basic-motor-dr.ino
@@ -0,0 +1,32 @@
+int m1enA = 6;
+int m1enB = 5;
+int m1pwm1 = 4;
+int m1pwm2 = 3;
+int m1encoA = 32;
+int m1encoB = 31;
+
+void setup() {
+  Serial.begin(9600);
+
+  pinMode(m1enA, OUTPUT);
+  pinMode(m1enB, OUTPUT);
+  pinMode(m1pwm1, OUTPUT);
+  pinMode(m1pwm2, OUTPUT);
+
+  pinMode(m1pwm1, INPUT);
+  pinMode(m1pwm2, INPUT);
+  
+}
+
+void loop() {
+  digitalWrite(m1enA, HIGH);
+  digitalWrite(m1enB, LOW);
+  digitalWrite(m1pwm1, HIGH);
+  digitalWrite(m1pwm2, LOW);
+  delay(500);
+  digitalWrite(m1enA, HIGH);
+  digitalWrite(m1enB, LOW);
+  digitalWrite(m1pwm1, LOW);
+  digitalWrite(m1pwm2, HIGH);
+  delay(500);
+}