jak sobie poradzić kiedy silnik cały czas zwiera krańcówkę,
nie wiem jak to zapisać abym mógł ruszyć silnikiem kiedy jest wciśnięta krańcówka
[syntax=cpp]void go(int steps)
{
// jesli krańcówka górna aktywna a kietunek kroków dodatni
if (steps > 0 && digitalRead(MAX) == LOW)
{
Serial.print("MAX");
return;
}
// jesli krańcówka dolna aktywna a kietunek kroków ujemny
if (steps < 0 && digitalRead(MIN) == LOW)
{
Serial.print("MIN");
return;
}
if (steps > 0) // ustalenie kierunku
// znak wartosci decyduje o kierunku
digitalWrite(Z3_DIR_PIN,LOW);
else
{
digitalWrite(Z3_DIR_PIN,HIGH);
steps = steps * (-1);
}
for(int i = 0; i<steps; i++) // wykonaj odpowienią ilość kroków
{
digitalWrite(Z3_STEP_PIN,HIGH);
delay(1);
digitalWrite(Z3_STEP_PIN,LOW);
delay(1);
// sprawdzenie krańcówek
if(digitalRead(MAX)==LOW)
{
Serial.println(MAX);
break;
}
if(digitalRead(MIN)==LOW)
{
Serial.println("MIN");
break;
}
}
}[/syntax]
PozdrawiamStatystyki: Napisane przez stachu — 2 wrz 2014, o 23:04
]]>