초음파 센서를 통해 5센치 이상이면 일정 수 스텝모터가 회전하고 5센치 이하면 원래대로 돌아오는 코드를 작성하고 싶습니다.
(속도는 최대로 하고싶습니다.)
도움을 주시면 감사합니다ㅠㅠ
#include<Stepper.h>
#define STEPS 2048
int StepperAngle = 60;
Stepper myStepper(StepperAngle, 11, 9, 10, 8);
int trigPin = 7;
int echoPin = 6;
float duration;
//float distance;
void setup() 
{
myStepper.setSpeed(30);
pinMode(echoPin, INPUT);
pinMode(trigPin, OUTPUT);
Serial.begin(9600);
}
 
void loop()
{
long duration;
digitalWrite(trigPin, HIGH);
delay(10);
digitalWrite(trigPin, LOW);
long value = duration / 29/ 0.2;
duration = pulseIn(echoPin, HIGH);
//DIstance = ((float)(340 * duration) / 10000) / 2; 
 
Serial.println(duration);
Serial.print("\nDIstance:");
Serial.print(value);
Serial.println("cm");
delay(100);
 
if( value > 5) 
  {
    //StepperAngle = 2037;
    myStepper.step(StepperAngle);
    delay(10);
  }
else if( value < 5)
  {
    //StepperAngle = -2037;
    myStepper.step(-StepperAngle);
 
  delay(10);
  }
}