// ST4-ESP32 Basic GPIO Example
// Cycles through all axis directions to verify wiring
// Use multimeter or logic analyzer on TLP521-4 outputs to verify

#include <ST4.h>

ST4Axis ra;
ST4Axis dec;

void setup() {
    Serial.begin(115200);
    Serial.println("ST4 Basic GPIO Test");

    ra.begin(ST4_PIN_RA_PLUS, ST4_PIN_RA_MINUS);
    dec.begin(ST4_PIN_DEC_PLUS, ST4_PIN_DEC_MINUS);

    Serial.println("Pins initialized. Cycling directions...");
}

void loop() {
    Serial.println("RA+");
    ra.plus();
    delay(2000);

    Serial.println("RA stop");
    ra.stop();
    delay(1000);

    Serial.println("RA-");
    ra.minus();
    delay(2000);

    Serial.println("RA stop");
    ra.stop();
    delay(1000);

    Serial.println("DEC+");
    dec.plus();
    delay(2000);

    Serial.println("DEC stop");
    dec.stop();
    delay(1000);

    Serial.println("DEC-");
    dec.minus();
    delay(2000);

    Serial.println("All stop");
    dec.stop();
    delay(3000);
}