dc 모터를 블루투스랑 초음파 센서를 같이 이용해서 제어해보고 싶은데 블루투스는 제어가 지금 되는데 초음파는 안되는 것 같더라구요 컴파일도 되고 업로드도 되는데 뭐가 문제인지 초보자인 저로서는 감이 잘 오지 않습니다.
밑에서 어떤 부분이 틀렸고 혹은 바꿔야 제어가 가능한지 고수분들께서 좀 알려주시면 좋겠습니다. 부탁드립니다~~
#include <SoftwareSerial.h>
SoftwareSerial BTS(3,2);
int motor=11;
int trig=13;
int echo=12;
void setup() {
Serial.begin(9600);
BTS.begin(9600);
pinMode(trig,OUTPUT);
pinMode(echo,INPUT);
pinMode(motor,OUTPUT);
}
void loop() {
if(BTS.available()>0){
char data=BTS.read();
if(data=='b'){
analogWrite(motor,50);
}else if(data=='w'){
analogWrite(motor,120);
}else if(data=='c'){
analogWrite(motor,255);
}else if(data=='s'){
analogWrite(motor,0);
}
digitalWrite(trig,LOW);
delayMicroseconds(2);
digitalWrite(trig,HIGH);
delayMicroseconds(10);
digitalWrite(trig,LOW);
long duration = pulseIn(echo,HIGH);
long distance = (duration*340)/2/10000;
if(distance<=10){
int spin = map(distance, 10,0,0,255);
}
}
}
|