L6470 Probleme mit SW PIN

Hallo Leute,

ich bin derzeit fast am Verzweifeln. Ich habe ein L6470 und an dem SW
PIN ist eine Lichtschranke adaptiert, sobald der Treiber auf RESET HIGH
gesetzt wird und die Lichtschrank aktiv(Motor auf Linksanschlag) macht
der Motor hochfrequente Geräusche und zudem werden die Mircosteps falsch
berechnet.
Ich hab einiges versucht, aber ich komme nicht weiter, wenn jemand einen
Hinweis oder Rat weiß, dann immer her damit. Hier mal der Code:

Code:

---

void setup()
{
  // set SPI pins
  pinMode(PIN_CS, OUTPUT);
  digitalWrite(PIN_CS, HIGH);
  pinMode(PIN_MOSI, OUTPUT);
  pinMode(PIN_MISO, INPUT);
  pinMode(PIN_SCK, OUTPUT);
  pinMode(PIN_BUSYN, INPUT);
  pinMode(PIN_RESET, OUTPUT);
  // reset controller
        //Something is happend here, when light switch 1 is activ
  delay(1);
  digitalWrite(PIN_RESET, HIGH);
  delay(1);
  digitalWrite(PIN_RESET, LOW);
  delay(1);
  digitalWrite(PIN_RESET, HIGH);
  delay(1);
  // join SPI bus
  SPI.begin();
  SPI.setBitOrder(SPI_BIT_ORDER);
  SPI.setClockDivider(SPI_CLOCK_FREQUENCY);
  SPI.setDataMode(SPI_MODE);
  comStack.COM_init();
  comStack.COM_addCallbacks(callbacks);
  cmd_Init();
} // setup

---

Vielen Dank im Voraus.

Gruß
Michi