Franzls Technik Forum

Code: Alles auswählen

// Ansteuerung eines Schrittmotors

// Mit 2 Tastern kann die Drehrichtung gewählt und der Schrittmotor gestartet werden.
// Der Schrittmotor läuft nur so lange, wie der Taster EINSCHALTER am Port 2 gedrückt wird.
// Standardmäßig läuft der Schrittmotor rechts herum - also im Uhrzeigersinn.
// Nur bei gedrücktem Taster DREHRICHTUNG an Port 3 dreht der Schrittmotor links herum.

// P1x sind die Eingänge des Controllers
// P11 = Port 8, P12 = Port 9, P13 = Port 10, P14 = Port 11:
#define P11 8
#define P12 9
#define P13 10
#define P14 11

#define EINSCHALTER 2
#define DREHRICHTUNG 3
#define LINKS 0
#define RECHTS 1

// Länge der  Stepper-Phase
#define STEPLENGTH 5 // Minimaler Wert = 4!

// Rechtslauf
int arrayStepsP11[] = {1, 1, 0, 0};
int arrayStepsP12[] = {0, 0, 1, 1};
int arrayStepsP13[] = {0, 1, 1, 0};
int arrayStepsP14[] = {1, 0, 0, 1};

// Schalter-Variable definieren
boolean varEinschalter = 0;
// Drehrichtungs-Variable definieren
// 1 = RECHTS = Rechtslauf, 0 = LINKS = Linkslauf
boolean varDrehrichtung = LINKS;

void setup() {
  pinMode(P11, OUTPUT);
  pinMode(P12, OUTPUT);
  pinMode(P13, OUTPUT);
  pinMode(P14, OUTPUT);

  // Schalter-Port auf Eingang setzen
  pinMode(EINSCHALTER, INPUT);
  // Drehrichtungs-Port auf Eingang setzen
  pinMode(DREHRICHTUNG, INPUT);  
}

void loop() {

  // Einschalter abfragen
  varEinschalter = digitalRead(EINSCHALTER);
  // Drehrichtungsschalter abfragen
  varDrehrichtung = digitalRead(DREHRICHTUNG);
 
  if (varEinschalter == 1)
  {
    if (varDrehrichtung == RECHTS)
    {
      // Rechtslauf
      // Es sind definitiv 4 Phasen beim Vollschrittbetrieb:
      for (int i = 0; i < 4; i++)
      {
        if (arrayStepsP11[i] == 1)
        {
          digitalWrite(P11, HIGH);
        }
        else
        {
          digitalWrite(P11, LOW);
        }
        if (arrayStepsP12[i] == 1)
        {
          digitalWrite(P12, HIGH);
        }
        else
        {
          digitalWrite(P12, LOW);
        }
        if (arrayStepsP13[i] == 1)
        {
          digitalWrite(P13, HIGH);
        }
        else
        {
          digitalWrite(P13, LOW);
        }
        if (arrayStepsP14[i] == 1)
        {
          digitalWrite(P14, HIGH);
        }
        else
        {
          digitalWrite(P14, LOW);
        }
       delay(STEPLENGTH);
      }
    }
    else
    {
      // Linkslauf
      // Es sind definitiv 4 Phasen beim Vollschrittbetrieb:
      for (int i = 3; i >= 0; i--)
      {
        if (arrayStepsP11[i] == 1)
        {
          digitalWrite(P11, HIGH);
        }
        else
        {
          digitalWrite(P11, LOW);
        }
        if (arrayStepsP12[i] == 1)
        {
          digitalWrite(P12, HIGH);
        }
        else
        {
          digitalWrite(P12, LOW);
        }
        if (arrayStepsP13[i] == 1)
        {
          digitalWrite(P13, HIGH);
        }
        else
        {
          digitalWrite(P13, LOW);
        }
        if (arrayStepsP14[i] == 1)
        {
          digitalWrite(P14, HIGH);
        }
        else
        {
          digitalWrite(P14, LOW);
        }
       delay(STEPLENGTH);
      }
    }
  }
}