BASIC4MCU | 질문게시판 | 아두이노 블루투스제어를 이용한 초음파+모터제어 질문있습니다.
페이지 정보
작성자 catsoup 작성일2021-06-16 00:45 조회19,587회 댓글4건본문
//전체코딩
#include <DHT11.h>
#include <Wire.h>
#include <LiquidCrystal_I2C.h>
#include <SoftwareSerial.h>
LiquidCrystal_I2C lcd(0x27, 16, 2);
#define LIMITPIN1 10
#define LIMITPIN2 11
#define pinDHT 8
DHT11 dht11(pinDHT);
SoftwareSerial BTSerial(2, 3);
int in1 = 7; //모터1
int in2 = 5; //모터2
void setup()
{
lcd.init(); // initialize the lcd
lcd.backlight();
pinMode(A0,INPUT);
pinMode(in1,OUTPUT);
pinMode(in2,OUTPUT);
pinMode (LIMITPIN1, INPUT_PULLUP) ;//10번포트 리밋스위치
pinMode (LIMITPIN2, INPUT_PULLUP) ;//11번포트 리밋스위치
Serial.begin(9600);
BTSerial.begin(9600);
while (!Serial) {
;
}
}
void loop(){
int water = analogRead(A0);
int err;
float temp, humi;
if(BTSerial.available()){ //블루투스 사용가능
char BT =BTSerial.read();
lcd.clear();
Serial.println(analogRead(A0));
if(BT == '1'){
if((err = dht11.read(humi, temp)) == 0);{
BTSerial.print(" 온도 :");
BTSerial.print(temp);
BTSerial.print("℃");
BTSerial.print(" 습도:");
BTSerial.print(humi);
BTSerial.print("%");
BTSerial.println();
lcd.setCursor(0, 0);
lcd.print("Temp:");
lcd.print(temp);
lcd.print("C");
lcd.setCursor(0, 1);
lcd.print("Humi:");
lcd.print(humi);
lcd.print("%");
delay(3000);
lcd.init();
if((water = analogRead(A0)) == 0);{
if(water >800){
BTSerial.print("강수량 : ");
BTSerial.print(water);
BTSerial.print("mm");
lcd.setCursor(0,0);
lcd.print("RAINFALL " );
lcd.setCursor(0,1);
lcd.print("DON'T UMBRELLA");
}
else {
lcd.setCursor(0,0);
lcd.print("RAINFALL " );
lcd.setCursor(0,1);
lcd.print("USE UMBRELLA");
}
}
}
}
else if(BT =='2'){
while(digitalRead(LIMITPIN1) == HIGH)
{
digitalWrite(in1,HIGH);
digitalWrite(in2,LOW);
analogWrite(8, 127);
}
digitalWrite(in1,LOW);
digitalWrite(in2,LOW);
}
else if (BT =='3')
while(digitalRead(LIMITPIN2) == HIGH)
{
digitalWrite(in1,LOW);
digitalWrite(in2,HIGH);
analogWrite(8, 127);
}
digitalWrite(in1,LOW);
digitalWrite(in2,LOW);
}
}
-------------------------------
BT = 블루투스
LIMITPIN = 리밋스위치
---------------------------------
// 초음파센서
#define TRIG_PIN 12
#define ECHO_PIN 13
#define LED_PIN 8
void setup() {
pinMode(TRIG_PIN, OUTPUT);
pinMode(ECHO_PIN, INPUT);
pinMode(LED_PIN, OUTPUT);
}
void loop()
{
int distance = 0;
digitalWrite(TRIG_PIN, HIGH);
delayMicroseconds(10);
digitalWrite(TRIG_PIN, LOW);
distance = pulseIn(ECHO_PIN, HIGH)/23; /* 센치미터(cm) */
if (distance <= 10) {
digitalWrite(LED_PIN, HIGH);
} else {
digitalWrite(LED_PIN, LOW);
}
}
---------------------------------------------------------
블루투스버튼으로 제어를 하며 2번을 눌렀을때 모터제어까지는 되었는데
2번버튼 실행 -> 모터 동작 -> 도중에 초음파 센서 설정한 거리에 손이 오면 모터가 정지하고 손을빼면 3초후 다시 모터가 동작하고 리미트스위치 실행하게 만들 예정입니다만.. 여러번 시도를 해봤는데도 원하는 결과가 나오질 않아서 문의 드려요...
(위에 있는 코딩이랑 밑에 있는 코딩은 별개입니다.)
(이전에도 질문 드렸던 게시글에도 답변주셔서 감사드립니다.)
댓글 4
조회수 19,587master님의 댓글
master 작성일
#include <DHT11.h>
#include <Wire.h>
#include <LiquidCrystal_I2C.h>
#include <SoftwareSerial.h>
LiquidCrystal_I2C lcd(0x27,16,2);
#define LIMITPIN1 10
#define LIMITPIN2 11
#define pinDHT 8
DHT11 dht11(pinDHT);
SoftwareSerial BTSerial(2,3);
//
int in1=7,in2=5; //모터
int TRIG_PIN=12,ECHO_PIN=13,LED_PIN=8;
//
int distance=0;
//
void setup(){
pinMode(A0,INPUT);
pinMode(TRIG_PIN,OUTPUT); pinMode(ECHO_PIN,INPUT); pinMode(LED_PIN,OUTPUT);
pinMode(in1,OUTPUT); pinMode(in2,OUTPUT);
pinMode(LIMITPIN1,INPUT_PULLUP); pinMode(LIMITPIN2,INPUT_PULLUP); // 리밋스위치
lcd.init(); lcd.backlight();
Serial.begin(9600); while (!Serial);
BTSerial.begin(9600);
analogWrite(8,127);
}
//
void sonar(){
delay(100);
digitalWrite(TRIG_PIN,1); delayMicroseconds(10); digitalWrite(TRIG_PIN,0);
distance=pulseIn(ECHO_PIN,1)/23; /* 센치미터(cm) */
}
//
void loop(){
int err;
float temp,humi;
int water=analogRead(A0); Serial.println(water);
//
if(BTSerial.available()){ //블루투스 사용가능
char BT=BTSerial.read();
lcd.clear();
Serial.println(BT);
if(BT=='1'){
if((err=dht11.read(humi,temp))==0){
BTSerial.print(" 온도 :"); BTSerial.print(temp); BTSerial.print("℃");
BTSerial.print(" 습도:"); BTSerial.print(humi); BTSerial.println("%");
lcd.setCursor(0,0); lcd.print("Temp:"); lcd.print(temp); lcd.print("C");
lcd.setCursor(0,1); lcd.print("Humi:"); lcd.print(humi); lcd.print("%");
delay(3000);
lcd.init();
if(water>800){
BTSerial.print("강수량 : "); BTSerial.print(water); BTSerial.print("mm");
lcd.setCursor(0,0); lcd.print("RAINFALL ");
lcd.setCursor(0,1); lcd.print("DON'T UMBRELLA");
}
else{
lcd.setCursor(0,0); lcd.print("RAINFALL ");
lcd.setCursor(0,1); lcd.print("USE UMBRELLA");
}
}
else if(BT=='2'){
while(digitalRead(LIMITPIN1)==1){
sonar();
if(distance<=10){ digitalWrite(LED_PIN,1); digitalWrite(in1,0); digitalWrite(in2,0); delay(3000); }
else { digitalWrite(LED_PIN,0); digitalWrite(in1,1); digitalWrite(in2,0); }
}
digitalWrite(in1,0); digitalWrite(in2,0);
}
else if (BT=='3'){
while(digitalRead(LIMITPIN2)==1){
sonar();
if(distance<=10){ digitalWrite(LED_PIN,1); digitalWrite(in1,0); digitalWrite(in2,0); delay(3000); }
else { digitalWrite(LED_PIN,0); digitalWrite(in1,0); digitalWrite(in2,1); }
}
digitalWrite(in1,0); digitalWrite(in2,0);
}
}
}
catsoup님의 댓글
catsoup
댓글에 있는 코딩으로 해봤는데 모터자체가 작동이 되지가 않네요 ㅜㅜ
핀번호 중복되어있는것도 있어서 고쳐도 보았습니다.
블루투스 버튼2를 누르면 모터동작(정방향)하고 초음파센서에서 설정한 거리범위에서 모터동작이 멈추고 범위밖이면 모터가 다시 동작되게 하고싶습니다.. (LED제외)
저 코딩만 해결이 되면 끝이라서 부탁드립니다..!
catsoup님의 댓글
catsoup
#include <DHT11.h>
#include <Wire.h>
#include <LiquidCrystal_I2C.h>
#include <SoftwareSerial.h>
LiquidCrystal_I2C lcd(0x27, 16, 2);
#define pinDHT 8
#define LIMITPIN1 10
#define LIMITPIN2 11
#define TRIG 12
#define ECHO 13
DHT11 dht11(pinDHT);
SoftwareSerial BTSerial(2, 3);
int in1 = 7; //모터1
int in2 = 5; //모터2
int distance =0;
void setup()
{
lcd.init(); // initialize the lcd
lcd.backlight();
pinMode(A0,INPUT);
pinMode(in1,OUTPUT);
pinMode(in2,OUTPUT);
pinMode(LIMITPIN1, INPUT_PULLUP) ;//10번포트 리밋스위치
pinMode(LIMITPIN2, INPUT_PULLUP) ;//11번포트 리밋스위치
pinMode(TRIG,OUTPUT);
pinMode(ECHO,INPUT);
Serial.begin(9600);
BTSerial.begin(9600);
while (!Serial) {
;
}
}
void sonar() {
long duration;
digitalWrite(TRIG,1);
delayMicroseconds(10);
digitalWrite(TRIG,0);
distance= pulseIn(ECHO,HIGH)/23; /* 센치미터(cm) */
distance = ((float)(340 * duration) / 1000) / 2;
}
void loop(){
int water = analogRead(A0);
int err;
float temp, humi;
if(BTSerial.available()){ //블루투스 사용가능
char BT =BTSerial.read();
lcd.clear();
Serial.println(analogRead(A0));
if(BT == '1'){
if((err = dht11.read(humi, temp)) == 0);{
BTSerial.print(" 온도 :");
BTSerial.print(temp);
BTSerial.print("℃");
BTSerial.print(" 습도:");
BTSerial.print(humi);
BTSerial.print("%");
BTSerial.println();
lcd.setCursor(0, 0);
lcd.print("Temp:");
lcd.print(temp);
lcd.print("C");
lcd.setCursor(0, 1);
lcd.print("Humi:");
lcd.print(humi);
lcd.print("%");
delay(3000);
lcd.init();
if((water = analogRead(A0)) == 0);{
if(water >800){
BTSerial.print("강수량 : ");
BTSerial.print(water);
BTSerial.print("mm");
lcd.setCursor(0,0);
lcd.print("RAINFALL " );
lcd.setCursor(0,1);
lcd.print("DON'T UMBRELLA");
}
else {
lcd.setCursor(0,0);
lcd.print("RAINFALL " );
lcd.setCursor(0,1);
lcd.print("USE UMBRELLA");
}
}
}
}
else if(BT =='2'){
while(digitalRead(LIMITPIN1) == HIGH)
{
digitalWrite(in1,HIGH);
digitalWrite(in2,LOW);
analogWrite(9, 187);
}
if(distance <= 20)
{
sonar();
digitalWrite(in1,LOW);
digitalWrite(in2,LOW);
}
else {
delay(3000);
digitalWrite(in1,HIGH);
digitalWrite(in2,LOW);
}
digitalWrite(in1,LOW);
digitalWrite(in2,LOW);
}
else if (BT =='3')
while(digitalRead(LIMITPIN2) == HIGH)
{
digitalWrite(in1,LOW);
digitalWrite(in2,HIGH);
analogWrite(9, 127);
}
digitalWrite(in1,LOW);
digitalWrite(in2,LOW);
}
}
이런식으로 다시 코딩해봤는데 모터는 돌아가고 리미트스위치로 모터정지까지는 되는데 초음파센서로 인하여 모터정지 후 입력거리에서 벗어나면 3초후 동작이 될지 않습니다.
master님의 댓글
master 작성일
char BT; // 전역변수로 변경
//
void loop(){
int err;
float temp,humi;
int water=analogRead(A0);
//
if(BTSerial.available()){ //블루투스 사용가능
BT=BTSerial.read();
lcd.clear();
digitalWrite(in1,0); digitalWrite(in2,0);
}
//
if(BT=='1'){
Serial.println(analogRead(A0));
if((err=dht11.read(humi, temp))==0){
BTSerial.print(" 온도 :"); BTSerial.print(temp); BTSerial.print("℃");
BTSerial.print(" 습도:"); BTSerial.print(humi); BTSerial.println("%");
lcd.setCursor(0, 0); lcd.print("Temp:"); lcd.print(temp); lcd.print("C");
lcd.setCursor(0, 1); lcd.print("Humi:"); lcd.print(humi); lcd.print("%");
delay(3000);
lcd.init();
if(water >800){
BTSerial.print("강수량 : "); BTSerial.print(water); BTSerial.print("mm");
lcd.setCursor(0,0); lcd.print("RAINFALL " );
lcd.setCursor(0,1); lcd.print("DON'T UMBRELLA");
}
else{
lcd.setCursor(0,0); lcd.print("RAINFALL " );
lcd.setCursor(0,1); lcd.print("USE UMBRELLA");
}
}
}
else if(BT=='2'){
sonar();
if(distance>20 && digitalRead(LIMITPIN1)){ digitalWrite(in1,1); digitalWrite(in2,0); analogWrite(9,187); }
else{ digitalWrite(in1,0); digitalWrite(in2,0); }
}
else if (BT=='3'){
sonar();
if(distance>20 && digitalRead(LIMITPIN2)){ digitalWrite(in1,0); digitalWrite(in2,1); analogWrite(9,187); }
else{ digitalWrite(in1,0); digitalWrite(in2,0); }
}
}
}
우선 위 코드가 정상적으로 동작하는지 확인한 후 3초 딜레이는 어디에 넣어야 하는지 고민해보세요
c언어 기초부터 공부하셔야겠습니다.