#include <Stepper.h>
#include <Servo.h>
const int stepPerRevolution = 100;
const int MotorSpeed = 10;
Stepper myst(stepPerRevolution, 2, 3, 4, 5);
Servo mys;
#define trig 6
#define echo 7

void setup() {
  myst.setSpeed(MotorSpeed);
  mys.attach(8);
  pinMode(trig, OUTPUT);
  pinMode(echo, INPUT);
  pinMode(13, OUTPUT);
  mys.write(90);
}
float JarakCm(){
  digitalWrite(trig, HIGH);
  delay(10);
  digitalWrite(trig, LOW);
  int durasi = pulseIn(echo, HIGH);
  return durasi / 58.475;
}

void loop() {
  float Jarak = JarakCm();
  if(Jarak <= 50){
    digitalWrite(13, HIGH);
    myst.step(0);
    mys.write(180);
    delay(250);
    mys.write(90);
    delay(250);
    mys.write(180);
    delay(250);
    mys.write(90);
    delay(250);
    mys.write(180);
    delay(250);
    mys.write(90);
    delay(250);
    mys.write(180);
    delay(250);
    mys.write(90);
    delay(250);
    myst.step(50);
  }else{
    myst.step(1);
    mys.write(90);
  }
  

}