Arduino.ru

#include <Servo.h>

//объявляем переменную порта
int portServ = 9;
int portBut1 = 2;
int portBut2 =4;
int portLed = 13;
int firstPos = 0;//первое положение сервы
int partblock=45; //второе положение
int block=90; //третье положение
int counter=0; //счетчик

Servo myservo;

boolean lastButton1=LOW;
boolean currentButton1 = LOW;
boolean lastButton2=LOW;
boolean currentButton2 = LOW;

boolean ledOn1=false;

void setup() {
  // put your setup code here, to run once:
  myservo.attach(portServ); //attach our servo to the port 9
  myservo.write(0);
  
  pinMode(portBut1, INPUT);
  pinMode(portBut2, INPUT);
  pinMode(portLed, OUTPUT);
}

boolean debounce (boolean last, int button) //функция, где мы устраняем дребезг
//передаём последнее значение нажата ли кнопка.
{
  boolean current = digitalRead(button); //считываем текущее значение кнопки
  if (last!=current) //если значение последнего состояния кнопки не совпадает с текущим
  {
    delay(5); //ждём 5 мс, это мало, но хватит, чтобы кнопка узбагоилась
    current = digitalRead(button); //текущему значению присваеваем считываемое состояние кнопки
  }
  return current;//возвращаем текущее значение, вроде как то что мы чётко считали
}

void loop() {
  counter=0;
 start:
  currentButton1=debounce(lastButton1,portBut1);
  currentButton2=debounce(lastButton2,portBut2);
   
   counter=counter+1;
 
  if(currentButton1==HIGH&&counter%2==0)//нечётный счетчик
  {
     {
    ledOn1= !ledOn1;
  }
    digitalWrite(portLed, ledOn1); //собственно взаимодействие с диодом
    myservo.write(partblock);              // tell servo to go to position in variable 'pos'
    delay(15);                       // waits 15ms for the servo to reach the position
  
   lastButton1=currentButton1; //ну и наш настояший превратился в бывшего
  lastButton2=currentButton2; //ну и наш настояший превратился в бывшего
    goto start;
  }
    
    if(currentButton1==HIGH&&counter%2!=0)
  {
     {
    ledOn1= !ledOn1;
  }
    digitalWrite(portLed, ledOn1); //собственно взаимодействие с диодом
     myservo.write(block);               // tell servo to go to position in variable 'pos'
    delay(15);                       // waits 15ms for the servo to reach the position
    lastButton1=currentButton1; //ну и наш настояший превратился в бывшего
  lastButton2=currentButton2; //ну и наш настояший превратился в бывшего
    goto start;
   
    }
   if(currentButton2==HIGH)
  {
    myservo.write(firstPos);
    
    counter=0;
    lastButton1=currentButton1; //ну и наш настояший превратился в бывшего
  lastButton2=currentButton2; //ну и наш настояший превратился в бывшего
    goto start;
  }
  
   else
   {}
   lastButton1=currentButton1; //ну и наш настояший превратился в бывшего
  lastButton2=currentButton2; //ну и наш настояший превратился в бывшего
  
}