#include<Servo.h>
#define doba 5000
Servo myservo;
int uhol_start_stop[2]={0,90};
unsigned long servoStartTime;
bool stav=0;
void setup() {
  Serial.begin(9600);
  myservo.attach(5);
  myservo.write(0);
  delay(500);
  servoStartTime=millis();
}

void loop() {
  unsigned long progress=millis();
  if(progress-servoStartTime<=doba){
    int uhol=map(progress,servoStartTime,servoStartTime+doba,uhol_start_stop[stav],uhol_start_stop[!stav]);
    myservo.write(uhol);
    Serial.println(uhol);
  }
  else{
    servoStartTime=progress;
    stav=!stav;
  }
}