Login▼/회원가입BASIC4MCU | 질문게시판 | 답변 : 2개의 초음파센서로 서보모터 하나 작동
페이지 정보
작성자 master 작성일2022-12-03 17:32 조회367회 댓글1건본문
#include <Servo.h>
Servo myservo;
//
int Trig=8,Echo=9;
int Trig1=11,Echo1=12;
//
int k=0;
//
void setup() {
Serial.begin(9600);
pinMode(Trig,OUTPUT); pinMode(Echo,INPUT);
pinMode(Trig1,OUTPUT); pinMode(Echo1,INPUT);
myservo.attach(6); myservo.write( 90);
}
//
void loop() {
digitalWrite(Trig,1); delayMicroseconds(10); digitalWrite(Trig,0);
unsigned long duration=pulseIn(Echo,HIGH);
float distance=((340.*(float)duration)/10000.)/2.;
Serial.print(distance); Serial.println("cm");
delay(100);
//
digitalWrite(Trig1,1); delayMicroseconds(10); digitalWrite(Trig1,0);
unsigned long duration1=pulseIn(Echo1,HIGH);
float distance1=((340.*(float)duration1)/10000.)/2.;
Serial.print(distance1); Serial.println("cm");
delay(100);
//
if(distance<30)||((distance1<30))){ myservo.write(180); k=5; }
else{
if(k==0)){ myservo.write(90); }
else k--;
}
}
- BASIC4MCU 작성글 SNS에 공유하기
댓글 1
조회수 367승천님의 댓글
승천 작성일정말 감사합니다!!!!