Co tohle.

[code]


#include <Keypad.h>
#include <Servo.h> // Knihovna pro ovladani serva

  Servo myservo; // vytvori objekt myservo

int LED_CLOSE = 11;
int LED_OPEN = 12;

  int servo_close = 0; // Servo position 0 derees
  int servo_open = 1023; // Servo position 180 degrres

const byte ROWS = 4;
const byte COLS = 3;


char pressedKey[5] = {'0','0','0','0'};
char code[5] = {'7','3','1','0'};


char hexaKeys[ROWS][COLS] = {
{'1','2','3'},
{'4','5','6'},
{'7','8','9'},
{'*','0','#'}
};
byte rowPins[ROWS] = {9, 8, 7, 6};
byte colPins[COLS] = {5, 4, 3};

customKeypad
Keypad customKeypad = Keypad( makeKeymap(hexaKeys), rowPins, colPins, ROWS, COLS);

void setup(){
pinMode(LED_OPEN, OUTPUT);
pinMode(LED_CLOSE, OUTPUT);
digitalWrite(LED_CLOSE, HIGH);

  myservo.attach(2); // Servo pripojene na pinu 2
  myservo.write(servo_close); // Zavri servo

}

void loop(){
char customKey = customKeypad.getKey();

if (customKey){
if (customKey == '#')
{
if ((pressedKey[0] == code[0]) && (pressedKey[1] == code[1]) && (pressedKey[2] == code[2]) && (pressedKey[3] == code[3]))
{

digitalWrite(LED_CLOSE, LOW);
digitalWrite(LED_OPEN, HIGH);
  myservo.write(servo_open); // Otevri servo
tone(10,2400,1200);
delay(6000);
digitalWrite(LED_OPEN, LOW);
digitalWrite(LED_CLOSE, HIGH);
  myservo.write(servo_close); // Zavri servo
tone(10,1900,1200);
pressedKey[0] = '0';
pressedKey[1] = '0';
pressedKey[2] = '0';
pressedKey[3] = '0';
}
else tone(10,500,1000);
}


else
{

pressedKey[0] = pressedKey[1];
pressedKey[1] = pressedKey[2];
pressedKey[2] = pressedKey[3];
pressedKey[3] = customKey; 

tone(10,1200,80);
}
}
}


[/code]