Stepper: Add demo (untested)

firmware/src/constants.h

@@ -27,3 +27,9 @@
 
 // Used by keyboard and encoder switch
 #define DEBOUNCE_MS 10
+
+// --- Z axis motor
+
+#define STEPPER_ENABLE 8
+#define STEPPER_DIR 9
+#define STEPPER_STEP 10

firmware/src/main.cpp

@@ -8,10 +8,13 @@
 #include "encoder.h"
 #include "debug.h"
 #include "timer.h"
+#include "stepper.h"
 
 void setup() {
   setupDebug();
   setupEncoder();
+  setupTimer();
+  setupStepper();
 
   Wire.begin();
 
@@ -27,6 +30,7 @@ void loop() {
 
   // debugScanI2C();
   // demoScreen();
+  // demoStepper();
 
   demoTimer();
 

firmware/src/stepper.cpp

@@ -0,0 +1,25 @@
+#include <Arduino.h>
+#include "constants.h"
+
+void setupStepper() {
+  pinMode(STEPPER_ENABLE, OUTPUT);
+  pinMode(STEPPER_DIR, OUTPUT);
+  pinMode(STEPPER_STEP, OUTPUT);
+
+  // low = enabled
+  digitalWrite(STEPPER_ENABLE, LOW);
+}
+
+bool stepperDir = HIGH;
+
+void demoStepper() {
+  Serial.println("Demoing stepper motor - rotating 200 steps");
+  stepperDir = !stepperDir;
+  digitalWrite(STEPPER_DIR, stepperDir);
+  for (int i = 0; i < 200; i++) {
+    digitalWrite(STEPPER_STEP, HIGH);
+    delay(2);
+    digitalWrite(STEPPER_STEP, LOW);
+    delay(7);
+  }
+}

firmware/src/stepper.h

@@ -0,0 +1,4 @@
+#pragma once
+
+void setupStepper();
+void demoStepper();