Kod: Zaznacz cały

//napunktuj silnik w prawo i silnik w lewo x razy silnik nr1
//przesun w bok w prawo x obr silnik nr2
//wykonaj to x razy i obrot walem silnik nr 3
//800 to chyba cwierc obrotu silnika

//ustawienia, zalezne od modelu walu, model nr1
int skokSpust = 400; //usatlenie jak bardzo naciskac spust mlotka pneumatycznego
int przesWbok = 800; //regulacja przesuniecia, skoku w bok na srubie trapezowej
int obrWal = 5; //ile razy ma sie wszystko powrorzyc, zaleznie od fi walu
int dlWal = 20; //ile razy ma zrobic punkt i przesuniecie w bok, zlezy od dlugosci walu
int odstepNaFi = 400; //o ile ma sie obrocic wal na obrotniku

void silnikNr1lewo(int n, int vObroty);
void silnikNr1prawo(int n, int vObroty);
void silnikNr2prawo(int n, int vObroty);
void silnikNr2lewo(int n, int vObroty);
void silnikNr3lewo(int n, int vObroty);
void punktIprzesun(int n);

void setup() {
  pinMode(4, OUTPUT); //ustawianie pinow jako wyjscia
  pinMode(5, OUTPUT);
  pinMode(6, OUTPUT);
  pinMode(7, OUTPUT);
  pinMode(8, OUTPUT);
  pinMode(9, OUTPUT);
  delay(3000);

for (int a = 0; a < obrWal; a++)  //wszystko wykonaj x razy, zaleznie od srednicy walu
{
punktIprzesun(dlWal); //wykonaj x razy punkt i przesun w bok
delay(1000);
silnikNr2lewo(dlWal*przesWbok, 1); //cofanie punktaka w lewo, mnozenie skoku razy ilosc przesuniec w bok, maks predkosc
delay(1000);
silnikNr2prawo(przesWbok/2, 1); //wykonaj pol skoku w prawo by zrobic przesuniecie punktow, z maks szybkosc za pomoca funkcji silnikNr2prawo
delay(1000);
silnikNr3lewo(odstepNaFi, 2); //obrot walu na obrotniku, dwa obr predkosc dwa
delay(1000);
punktIprzesun(dlWal);
delay(1000);
silnikNr2lewo(dlWal*przesWbok, 1);
delay(1000);
silnikNr2lewo(przesWbok/2, 1); //wykonaj dodatkowo pol skoku w lewo, by usunac przesuniecie punktow
delay(1000);
silnikNr3lewo(odstepNaFi, 2); //obrot walu, dwa obr predkosc dwa
delay(1000);
}
}

void loop() {
}

void silnikNr1lewo(int n, int vObroty) //ile razy ma sie obrocic 200 to 1 obr osi, z jaka szybkoscia 1 to najszybciej
{
for (int r = 0; r < n; r++)
{
     digitalWrite(5, LOW);       // Ustaw pin Pul na 0V.
     digitalWrite(4, HIGH);  // Ustaw pin Dir zgodnie z wybranym kierunkiem obrotu - 0 albo 1
     digitalWrite(5, HIGH);      // Ustaw pin Pul na 5V.
     delay(vObroty);
}
}
void silnikNr1prawo(int n, int vObroty) //ile razy ma sie obrocic 200 to 1 obr osi, z jaka szybkoscia 1 to najszybciej
{
for (int e = 0; e < n; e++)
{
     digitalWrite(5, LOW);       // Ustaw pin Pul na 0V.
     digitalWrite(4, LOW);  // Ustaw pin Dir zgodnie z wybranym kierunkiem obrotu - 0 albo 1
     digitalWrite(5, HIGH);      // Ustaw pin Pul na 5V.
     delay(vObroty);
}
}
void silnikNr2prawo(int n, int vObroty) //ile razy ma sie obrocic 200 to 1 obr osi, z jaka szybkoscia 1 to najszybciej
{
for (int w = 0; w < n; w++)
{
     digitalWrite(7, LOW);       // Ustaw pin Pul na 0V.
     digitalWrite(6, LOW);  // Ustaw pin Dir zgodnie z wybranym kierunkiem obrotu - 0 albo 1
     digitalWrite(7, HIGH);      // Ustaw pin Pul na 5V.
     delay(vObroty);
}
}
void silnikNr2lewo(int n, int vObroty) //ile razy ma sie obrocic 200 to 1 obr osi, z jaka szybkoscia 1 to najszybciej
{
for (int q = 0; q < n; q++)
{
     digitalWrite(7, LOW);       // Ustaw pin Pul na 0V.
     digitalWrite(6, HIGH);  // Ustaw pin Dir zgodnie z wybranym kierunkiem obrotu - 0 albo 1
     digitalWrite(7, HIGH);      // Ustaw pin Pul na 5V.
     delay(vObroty);
}
}
void silnikNr3lewo(int n, int vObroty) //ile razy ma sie obrocic 200 to 1 obr osi, z jaka szybkoscia 1 to najszybciej
{
for (int k = 0; k < n; k++)
{
     digitalWrite(9, LOW);       // Ustaw pin Pul na 0V.
     digitalWrite(8, HIGH);  // Ustaw pin Dir zgodnie z wybranym kierunkiem obrotu - 0 albo 1
     digitalWrite(9, HIGH);      // Ustaw pin Pul na 5V.
     delay(vObroty);
}
}
void punktIprzesun(int n) //ile razy ma wykonac punkt i przesunac w bok
{
for (int h = 0; h < n; h++)
{
     silnikNr1lewo(skokSpust, 1); //wykonaj 2obr z maks szybkosc za pomoca funkcji silnikNr1lewo
     delay(300);
     silnikNr1prawo(skokSpust, 1); //wykonaj 2obr z maks szybkosc za pomoca funkcji silnikNr1prawo
     delay(300);
     silnikNr2prawo(przesWbok, 1); //wykonaj 4obr z maks szybkosc za pomoca funkcji silnikNr2prawo
     delay(300);
}
}

Kod: Zaznacz cały

void setup() {
  pinMode(8, OUTPUT);
  pinMode(9, OUTPUT);
  void doStepPrawo()
     {
     digitalWrite(9, LOW);       // Ustaw pin Pul na 0V.
     digitalWrite(8, HIGH);  // Ustaw pin Dir zgodnie z wybranym kierunkiem - 0 albo 1
     digitalWrite(9, HIGH);      // Ustaw pin Pul na 5V.
     delay(1);
}


void loop() {
doStepsPrawo(1000,5,1)
{
  for (i = 0; i < 1000; i++)
  {
        doStep(direction);
        delay(msBetweenSteps);
  }
}
     

}

Kod: Zaznacz cały

void setup() {
  pinMode(8, OUTPUT);
  pinMode(9, OUTPUT);
}

// the loop function runs over and over again forever
void loop() {
     for (int i = 0; i < 400; i++) { //Wykonaj 2 obroty
     digitalWrite(9, LOW);       // Ustaw pin Pul na 0V.
     digitalWrite(8, HIGH);  // Ustaw pin Dir zgodnie z wybranym kierunkiem - 0 albo 1
     digitalWrite(9, HIGH);      // Ustaw pin Pul na 5V.
     delay(1);
     }
     for (int a = 0; a < 600; i++) { //Wykonaj 3 obroty
     digitalWrite(9, LOW);       // Ustaw pin Pul na 0V.
     digitalWrite(8, LOW);  // Ustaw pin Dir zgodnie z wybranym kierunkiem - 0 albo 1
     digitalWrite(9, HIGH);      // Ustaw pin Pul na 5V.
     delay(1);
}
}