Facebook
From Ivory Parrot, 2 Years ago, written in Plain Text.
Embed
Download Paste or View Raw
Hits: 236
  1.  
  2. int opoz = 1;
  3.  
  4. int IN1 = 2;
  5. int IN2 = 3;
  6. int IN3 = 4;
  7. int IN4 = 5;
  8. int led = 13;
  9.  
  10. void turn(int krok){
  11. switch(krok){
  12.    case 0:
  13.      digitalWrite(IN1, LOW);
  14.      digitalWrite(IN2, LOW);
  15.      digitalWrite(IN3, LOW);
  16.      digitalWrite(IN4, HIGH);
  17.    break;
  18.    case 1:
  19.      digitalWrite(IN1, LOW);
  20.      digitalWrite(IN2, LOW);
  21.      digitalWrite(IN3, HIGH);
  22.      digitalWrite(IN4, HIGH);
  23.    break;
  24.    case 2:
  25.      digitalWrite(IN1, LOW);
  26.      digitalWrite(IN2, LOW);
  27.      digitalWrite(IN3, HIGH);
  28.      digitalWrite(IN4, LOW);
  29.    break;
  30.    case 3:
  31.      digitalWrite(IN1, LOW);
  32.      digitalWrite(IN2, HIGH);
  33.      digitalWrite(IN3, HIGH);
  34.      digitalWrite(IN4, LOW);
  35.    break;
  36.    case 4:
  37.      digitalWrite(IN1, LOW);
  38.      digitalWrite(IN2, HIGH);
  39.      digitalWrite(IN3, LOW);
  40.      digitalWrite(IN4, LOW);
  41.    break;
  42.    case 5:
  43.      digitalWrite(IN1, HIGH);
  44.      digitalWrite(IN2, HIGH);
  45.      digitalWrite(IN3, LOW);
  46.      digitalWrite(IN4, LOW);
  47.    break;
  48.      case 6:
  49.      digitalWrite(IN1, HIGH);
  50.      digitalWrite(IN2, LOW);
  51.      digitalWrite(IN3, LOW);
  52.      digitalWrite(IN4, LOW);
  53.    break;
  54.    case 7:
  55.      digitalWrite(IN1, HIGH);
  56.      digitalWrite(IN2, LOW);
  57.      digitalWrite(IN3, LOW);
  58.      digitalWrite(IN4, HIGH);
  59.    break;
  60.    default:
  61.      digitalWrite(IN1, LOW);
  62.      digitalWrite(IN2, LOW);
  63.      digitalWrite(IN3, LOW);
  64.      digitalWrite(IN4, LOW);
  65.    break;
  66. }
  67. }
  68.  
  69. void setup() {
  70. pinMode(IN1, OUTPUT);
  71. pinMode(IN2, OUTPUT);
  72. pinMode(IN3, OUTPUT);
  73. pinMode(IN4, OUTPUT);
  74. pinMode(led, OUTPUT);
  75.  
  76. }
  77.  
  78. void loop() {
  79. //for(int b = 1; b < 17; b++){ //pełen obrót wału silnika
  80.         for(int a = 0; a < 8; a++){ //peĹ‚na sekwencja, 4 kroki
  81.         turn(a);
  82.         delay(opoz);
  83.         }
  84. //}
  85.  
  86.  
  87. }