motortest.cpp

#include <Arduino.h>

#define EnablePin 3
#define PhasePin 4
#define CSPin A0

unsigned long lastTime = 0;
int highestCurrent = 0;
int direction = HIGH;

void setup() {
  Serial.begin(9600);
  pinMode(EnablePin, OUTPUT);
  pinMode(PhasePin, OUTPUT);
  pinMode(CSPin, INPUT);
}

void loop() {

  if (millis() - lastTime >= 5000) {
    digitalWrite(EnablePin, HIGH);
    digitalWrite(PhasePin,direction);
    direction = !direction;
    lastTime = millis();
  }

  int currentSense = analogRead(CSPin);
  if (currentSense > highestCurrent) {
    Serial.print("Highest: " + currentSense); // 2500 mV/A
    float inAmps = map(currentSense,0,1023,0,2);
    Serial.print("aka, in Amps: ");
    Serial.print(inAmps, 3);
    highestCurrent = currentSense;
  }

}