차고와 도어락 다시 질문드립니다
페이지 정보
작성자 코시 작성일19-05-30 00:52 조회17,205회 댓글2건본문
마스터님 계속 같은 질문 드려서 죄송합니다.
차고와 도어락 코드를 하나로 묶어 차고 등을 빼고 복도등만 남긴 채 원래 차고등이 있던 핀에 서보모터 하나 더 추가하여 문 2개를 제어하려고 합니다. 물론 문은 rfid로 열리는 도어락 하나와 초음파센서와 가변저항을 통해 열리는 차고 하나이며 각각의 동작은 별개입니다.
저번에 올려주신 차고를 리모컨으로 컨트롤하는 코드가 작동이 안되서 그러는데 다시 한 번 부탁드리며 두 코드를 묶을때 지금 타이머가 첨부한 사진과 같이 루프 한 번당 하나씩 돌아가는 오류를 해결하는 방법 또한 알려주실 수 있나요?
매번 감사드립니다.
#include <Servo.h>
#include <MFRC522.h>
#include <MFRC522Extended.h>
#include <SPI.h>
const int RST_PIN = 9;
const int SS_PIN = 10;
MFRC522 mfrc(SS_PIN, RST_PIN); // MFR522를 이용하기 위해 mfrc객체를 생성
Servo servo, servo2;
bool state=0; //Servo Moter 상태값
int angle = 0; // 모터 동작 각도 인수
int trig1 = 7; // 차고 입구 초음파센서 trig1 핀 지정
int echo1 = 8; // 차고 입구 초음파센서 echo1 핀 지정
int trig2 = 2; // 차고 내부 초음파센서 trig2 핀 지정
int echo2 = 4; // 차고 내부 초음파센서 echo2 핀 지정
int resPin = A3; // 가변저항 핀 지정
//int light1 = 5; // 차고 등
int light2 = 6; // 복도 등
int timer = 0;
float duration1;
float distance1; // 위 아래 둘 다 초음파센서용
float duration2;
float distance2;
/*
RST --> Pin 9
SS --> Pin 10
MOSI --> Pin 11
MISO --> Pin 12
SCK --> Pin 13
*/
void setup() {
Serial.begin(9600);
servo.attach(3); //서브모터 핀 지정
servo2.attach(5);
pinMode(trig1, OUTPUT);
pinMode(echo1, INPUT);
pinMode(trig2, OUTPUT);
pinMode(echo2, INPUT);
//pinMode(light1, OUTPUT);
pinMode(light2, OUTPUT);
while (!Serial);
SPI.begin(); // Init SPI bus
mfrc.PCD_Init(); //Init MFRC522
Serial.println(F("Warning: this example clears your mifare UID, use with care!"));
servo.write(0);//모터 0도 설정
servo2.write(0);
delay(500);
}
void loop(){
int resVal = analogRead(resPin);
int resOut = map(resVal, 0, 1023, 0, 1000); // 저항값을 0~1000사이로 맵핑
Serial.print("Resistor value:");
Serial.println(resOut); // 가변저항 저항값 출력
digitalWrite(trig1, HIGH); // 차고 문 초음파센서
delayMicroseconds (10);
digitalWrite(trig1,LOW);
duration1 = pulseIn(echo1,HIGH);
distance1 = ((340*duration1) / 10000) / 2;
Serial.print("Door - Vehicle: ");
Serial.print(distance1); // 차고 문과 차량 사이 거리
Serial.println("cm");
if (resOut > 500 && distance1 < 70) // 저항값과 초음파센서 거리값이 임계값을 만족할 때
{
Serial.println("Open");
angle = 90;
servo2.write(angle);
delayMicroseconds (10);
digitalWrite(trig2, HIGH); // 차고 내부 초음파 센서 동작
delayMicroseconds (10);
digitalWrite(trig2,LOW);
duration2 = pulseIn(echo2,HIGH); // pulseln 단위 ms(microsecond) 초음파 시간차 duration값에 입력
distance2 = ((340*duration2) / 10000) / 2; // 초음파 속도 (34000) * 센서 시간차 / 100000 / 2
Serial.print("Celling - Vehicle: ");
Serial.print(distance2); // 차고 천장과 차량 사이 거리
Serial.println("cm");
//digitalWrite(light1, HIGH); // 차고 점등
if (distance2 < 50) // 복도에 사람 진입
{
digitalWrite(light2, HIGH); // 복도 점등
for (timer = 0; timer <= 30; timer++)
{
Serial.println(timer);
delay(100); // 30초 동안 점등이지만 빠른 결과 위해 3초로 설정
if (timer == 30)
{
//digitalWrite(light1, LOW);
digitalWrite(light2, LOW);
Serial.println("Turn off the Lights");
}
}
}
else if (distance2 >= 50)
digitalWrite(light2, LOW);
}
else if (resOut <= 500 && distance1 >=70)
{
//digitalWrite(light1, LOW);
angle = 0;
Serial.println("Close");
delay (10);
}
servo2.write(angle);
delay(1000); // 루프 속도
////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
{
if(mfrc.PICC_IsNewCardPresent()){ // 새 카드
if(mfrc.PICC_ReadCardSerial()){ // 카드 읽기
if(mfrc.uid.uidByte[0] == 119 && mfrc.uid.uidByte[1] == 85 && mfrc.uid.uidByte[2] == 201 && mfrc.uid.uidByte[3] == 59){ // UID 체크
Serial.println("ID Conformed");
state^=1;
if(state)
{ Serial.println("Door Open");
angle=90;
timer=4;
}
else
{
Serial.println("Door Close");
angle=0;
timer= 0;
}
}
else
{
angle=0;
Serial.println("ID not Matched");
}
servo.write(angle);
}
}
delay(1000);
if(timer){ Serial.println(timer);
if(--timer==0){ Serial.println("Door Close"); angle=0; servo.write(angle); }
}
}
}
댓글 : 2
조회수 : 17,205
master님의 댓글
master 작성일
디버깅을 할 때 동작을 시켜가면서 해야지 수월한 경우가 대부분입니다.
머리속으로 시뮬레이션해서 버그를 찾아서 수정하는 것은 쉽지 않기 때문이죠
즉, 물건을 보유하고 있는 사람만 가능하다는 뜻입니다.
특히 소스가 커질 수록 더욱 그렇습니다.
복잡한 소스의 알고리즘 문제는 타인에게 설명하기도 어려우므로
직접 해결하셔야합니다.
코시님의 댓글
코시 작성일
리모컨은 루프 돌아서 다시 신호를 받아들일 수 있게 만들면 될거같은데 어느부분이 문제여서 못읽는건지를 모르겠네요...
그리고 두 소스코드를 합쳤을 경우 위에 첨부한 사진처럼 루프돌면서 타이머가 하나씩 가는 문제는 타이머 줄이는걸로 해결해 보려고 했으나 이러면 led가 1초마다 깜빡깜빡 거리는데 어디부터 수정해나갈지 모르겠습니다. ㅠㅠ