Сортировщик Распаковщик Вкусностей — различия между версиями

 1 #include <Servo.h>          // Библиотека для сервопривода
 2 Servo servo1;               // Объявление переменных
 3 int timestep;
 4 int timestep1;
 5 boolean flag = 0;
 6 boolean flag1 = 0;
 7 boolean battle;
 8 byte i;
 9 byte j;
10 byte v;
11 byte c;
12 void setup() {
13   servo1.attach(4);         // Задание пинов на вход и выход
14   pinMode(3,INPUT_PULLUP);
15   pinMode(2,INPUT);
16   pinMode(9,OUTPUT);
17   Serial.begin(9600);
18   servo1.write(0);
19   // digitalWrite(9,LOW);  
20 }
21 
22 void loop() {
23   v = !digitalRead(2);
24   battle = !digitalRead(3);
25   if (battle==1 && flag==0 && (millis()-timestep)>300){  // Отрабатываем нажатие кнопки..
26     flag = 1;
27     i++;
28     Serial.println(i);
29     timestep = millis();
30   }
31   if (battle==0 && flag==1){  // ..и отжатие
32     flag = 0;
33   }
34   if ((millis()-timestep)>2500 && i>1){ // Через 2.5 секунды после последнего нажатия кнопки запускается дальнейший скрипт
35     j = i;
36   }
37   //if (j>0 && (millis()-timestep)>5000 && (millis()-timestep)<6000){    Прошивка для двигателя (не использовалась)
38   //  digitalWrite(9,HIGH);
39   //} else {
40   //  digitalWrite(9,LOW);
41   //}
42   if (j>0 && v==HIGH && flag1==0 && c<180 && (millis()-timestep1)>1000){ // Снятие показания с датчика препятствий и 
43     flag1 = 1;
44     timestep1 = millis();
45     c += 180/j;
46     servo1.write(c);                                                     // подача сигнала на сервопривод
47   }
48   if (j>0 && v==LOW && flag1==1 && (millis()-timestep1)>300){
49     flag1 = 0;
50     timestep1 = millis();
51   }
52 
53 }