질문게시판 > 아두이노 질문있습니다.

인기검색어 > 아두이노 센서 ATMEGA128

최신글 질문게시판 동영상강좌 가입하기

▼ BASIC4MCU 후원업체 신제품 정보 ▼

▲ BASIC4MCU 후원업체 신제품 정보 ▲

BASIC4MCU > 질문게시판

아두이노 질문있습니다.

페이지 정보

작성자 헤헿 작성일20-11-14 19:04 조회5,790회 댓글2건

본문

아래 코드에서 void setup()구문안에 gate(0);를 세팅해 뒀습니다.

gate(0)는 차단바를 내리고 gate(1)는 차단바를 올리게 세팅해 뒀습니다. 

그런데 loop문 내부에 

  if(a1!=0){

    tone(music1,800);

    tone(music2,800);

    digitalWrite(warning1,HIGH);

    digitalWrite(warning2,HIGH);

    time_alart1=millis();

    time_alart2=millis();

    if(distance<20){

      tone(music3,800);

      time_screen_alart=millis();

    }

    gate(0);  

  }            

  if(a2!=0){

    tone(music2,800);

    digitalWrite(warning2,HIGH);

    time_alart2=millis();

    if(distance<20){

      tone(music3,800);

      time_screen_alart=millis();

    }

    gate(0);

  }

 

이 구문을 집어넣으면 gate(0);가 실행되다 엉켜서 gate(1);이 실행되고 있습니다.

저 부분을 제외하고 실행하면 제대로 gate(0);가 초기값으로 실행됩니다.

제가 보기엔 start1, start2함수와 gate함수는 관련이 없는데 왜 저러는지 모르겠습니다.

 

 

#include <Servo.h>

//

int red1=2;    // 차량 신호등 핀 설정

int red2=5;    // 보행자 신호등 핀 설정

int green1=4;  // 차량 신호등 핀 설정

int green2=6;  // 보행자 신호등 핀 설정

int yellow=3;  // 신호등 핀 설정

int music1=7;  // 부저 핀 설정1

int music2=8;  // 부저 핀 설정2

int music3=39;  // 스크린도어 부저

int Sigpin1=32;  // start1 함수 입력 핀 설정

int Sigpin2=33;  // start2 함수 입력 핀 설정 

int trigPin=22; // 동작감지 아웃풋 핀 설정

int echoPin=23; // 동작감지 인풋 핀 설정

int warning1=24; // 경고등 동작 핀 설정1

int warning2=25; // 경고등 동작 핀 설정2

double time_screen=0;  // 스크린도어 동작감시 시간

double time_screen_alart=0; // 스크린도어 경고 시간

double time_alart1=0; // 경고 시간

double time_alart2=0; // 경고 시간

Servo myservo1; // 모터 설정1

Servo myservo2; // 모터 설정2

//

void setup(){

  pinMode(Sigpin1,INPUT);  //속도 측정 핀1

  pinMode(Sigpin2,INPUT);  //속도 측정 핀2

  pinMode(red1,OUTPUT);    // 차량 신호등 핀

  pinMode(red2,OUTPUT);    // 보행자 신호등 핀

  pinMode(green1,OUTPUT);  // 차량 신호등 핀

  pinMode(green2,OUTPUT);  // 보행자 신호등 핀

  pinMode(yellow,OUTPUT);  // 신호등 핀

  pinMode(trigPin,OUTPUT); // 동작감지 아웃풋

  pinMode(echoPin,INPUT);  // 동작감지 인풋

  pinMode(warning1,OUTPUT); // led 핀1

  pinMode(warning2,OUTPUT); // led 핀2

  myservo1.attach(12);     // 모터 아날로그 핀1

  myservo2.attach(13);    // 모터 아놀로그 핀2                 

  Serial.begin(9600);

  gate(0);  //게이트 초기상태

}

//

void loop(){

  char num; // 컴퓨터로 입력 숫자, 신호등 제어

  int a1, a2, b;  // 속도측정 함수1, 속도측정함수 2, 신호등 함수

  int com_a1,com_a2; 

  double distance; // 스크린도어 센서 함수 받기

  a1=start1();

  a2=start2();

  distance=sensor();

     

  if(Serial.available()){

    num=Serial.read();

    b=traffic(num);

  }

  // 문제되는 부분 시작         

  if(a1!=0){

    tone(music1,800);

    tone(music2,800);

    digitalWrite(warning1,HIGH);

    digitalWrite(warning2,HIGH);

    time_alart1=millis();

    time_alart2=millis();

    if(distance<20){

      tone(music3,800);

      time_screen_alart=millis();

    }

    gate(0);  

  }            

  if(a2!=0){

    tone(music2,800);

    digitalWrite(warning2,HIGH);

    time_alart2=millis();

    if(distance<20){

      tone(music3,800);

      time_screen_alart=millis();

    }

    gate(0);

  }

  // 문제되는 부분 끝              

  switch(b){

    case 1:              

            gate(1);            

            break;           

    case 2:     

            if(distance<20){

              tone(music3,800);

              time_screen_alart=millis();

            }  

            gate(0);                   

            break;

    case 3:      

            if(distance<20){

              tone(music3,800);

              time_screen_alart=millis();

            }  

            gate(0);                  

            break;        

    case 4:  

            if(distance<20){

              tone(music3,800);

              time_screen_alart=millis();

            }  

            gate(0);

            break;

  }            

  

  if(millis()-time_alart1>1000){ 

    time_alart1=millis();

    time_alart2=millis();            

    digitalWrite(warning1,LOW);

    digitalWrite(warning2,LOW);

    noTone(music1);

    noTone(music2);

  }  

  if(millis()-time_alart2>1000){ 

    time_alart2=millis();            

    digitalWrite(warning2,LOW);

    noTone(music2);

  } 

  if(millis()-time_screen_alart>1000){

    noTone(music3);

    time_screen_alart=millis();

  }

}

//

void gate(int set){ // 모터 동작 함수

  if(set==0){ //low

    myservo1.write(0);

    myservo2.write(180);

  }

  if(set==1){ // high

    myservo1.write(180);

    myservo2.write(0);

  }

}

//

int start1 (){ //속도 측정 함수

  double v, vmax;

  int trg; // 출력

  unsigned  long T;  // 주기

  double f;          // 주파수

  vmax=0;

  trg=0;

  while(digitalRead(Sigpin1));

  while(!digitalRead(Sigpin1));

  T=pulseIn(Sigpin1,HIGH)+pulseIn(Sigpin1,LOW); // 주기 측정

  f=1/(double)T;      // 주파수 측정

  v=((f*1e6)/44.0); // 속도 측정 

  if(v>10) v=0;              // 튀는 값 정리하기

  vmax=max(v,vmax);    // 속도의 Max값 측정

  if(vmax>30)trg=1; else trg=0; 

  return trg;

}

//

int start2 (){ //속도 측정 함수

  double v, vmax;

  int trg; // 출력

  unsigned  long T;  // 주기

  double f;          // 주파수

  vmax=0;

  trg=0;

  while(digitalRead(Sigpin2));

  while(!digitalRead(Sigpin2));

  T=pulseIn(Sigpin2,HIGH)+pulseIn(Sigpin2,LOW); // 주기 측정

  f=1/(double)T;      // 주파수 측정

  v=((f*1e6)/44.0); // 속도 측정 

  if(v>10) v=0;              // 튀는 값 정리하기

  vmax=max(v,vmax);    // 속도의 Max값 측정

  if(vmax>30)trg=1; else trg=0;    

  return trg;

}

//

int traffic(char a){ //신호등 함수

  int output;

  switch(a){

    case '1': traffic_sig1(); traffic_sig5(); output=1; break; //차량 빨강, 보행자 파랑

    case '2': traffic_sig1(); traffic_sig4(); output=2; break; //차량 빨강, 보행자 빨강

    case '3': traffic_sig2(); traffic_sig4(); output=3; break; // 차량 노랑, 보행자 빨강

    case '4': traffic_sig3(); traffic_sig4(); output=4; break; // 차량 파랑, 보행자 빨강

  }   

  return output;

}

//

double sensor(){ // 동작감지 함수

  long duration;

  double  distance;

  digitalWrite(trigPin, LOW); delayMicroseconds(2);

  digitalWrite(trigPin, HIGH); delayMicroseconds(10); digitalWrite(trigPin, LOW);

  duration=pulseIn(echoPin, HIGH);

  distance=duration*0.034/2; //Cm

  if(distance>24) distance=0;

  return distance;

}

// 신호등 색 결정 함수들

void traffic_sig1(){ digitalWrite(red1, HIGH); digitalWrite(yellow,LOW); digitalWrite(green1,LOW); }

void traffic_sig2(){ digitalWrite(red1, LOW); digitalWrite(yellow,HIGH); digitalWrite(green1,LOW); }

void traffic_sig3(){ digitalWrite(red1, LOW); digitalWrite(yellow,LOW); digitalWrite(green1,HIGH); }

void traffic_sig4(){ digitalWrite(red2,HIGH); digitalWrite(green2,LOW); }

void traffic_sig5(){ digitalWrite(red2,LOW); digitalWrite(green2,HIGH); }

  • BASIC4MCU 작성글 SNS에 공유하기
  • 페이스북으로 보내기
  • 트위터로 보내기
  • 구글플러스로 보내기
  • 카카오톡으로 보내기

댓글 : 2

조회수 : 5,790

master님의 댓글

master 작성일

sensor() 초음파 센서 측정 주기는 100ms 마다 해야합니다.
지금처럼 딜레이 없이 계속 측정하면 엉터리 값이 읽혀집니다.

master님의 댓글

master 작성일

나머지 질문은 소스만보고 답변하기 어려운 내용입니다.

게시물 검색

BASIC4MCU > 질문게시판 목록

제목 날짜
공지 MCU, AVR, 아두이노 등 전자공학에 관련된 질문은… 스태프  19-01-15
공지 사이트 이용 안내 댓글[25] master  17-10-29
질문 PIC 블루투스 연결 댓글[18] 픽공부 새글 10:28
질문 PIC18F452 블루투스 연결 댓글[4] 마이컴 새글 22-08-08
질문 아두이노 코드 해석을 못하겠습니다... 댓글[2] 김가헌 새글 22-08-08
질문 아두이노 코드를 avr로 변환해 주세요 ...ㅠ 댓글[3] 옹냥냥 새글 22-08-08
질문 아두이노 녹음-스피커모듈 관련 질문있습니다 ㅠㅠ 댓글[2] 방귀뿡뿡 새글 22-08-08
질문 Serial EEPROM 실수값 저장.. 댓글[2] 첨부파일광이  22-08-07
질문 STM32 Live Expression 값들이 깜빡이는… 댓글[3] 둠둠  22-08-05
질문 아두이노 ESP32 wifi module 댓글[1] Yoon  22-08-03
질문 atmega128과 dht11, lcd를 연결했는데 0… 댓글[1] 고양이33  22-08-02
질문 ATMEGA 128 코드를 합치려고 하는데 어렵네요 댓글[2] 고양이33  22-08-02
질문 서보모터 제어에 대해 질문있습니다. 댓글[2] 첨부파일뉴비에오  22-07-30
질문 적외선 통신 알려주실분있나요 ㅠㅠ 댓글[1] hkjsj10  22-07-30
질문 아두이노 관련 궁금합니다. 댓글[1] 뱝뱝  22-07-28
질문 아두이노 우노 MCP4725 댓글[3] opqr  22-07-27
질문 레오나르도 인체감지센서 알림 안옴 면지지  22-07-24
답변 답변 : 레오나르도 인체감지센서 알림 안옴 master  22-07-25
질문 Uno에서 엔코더값 놓치는 이유가 뭘까요... 댓글[3] MAKTUB  22-07-24
질문 아두이노 압력센서 연동 질문 댓글[4] dbice  22-07-23
질문 아두이노 버튼 누르기 문의 댓글[1] 김형근  22-07-23
질문 HM10 다중페어링 댓글[1] ㅎㅋㅎㅋㅎ  22-07-22
질문 모터드라이브 선정 댓글[6] 조숩인  22-07-22
질문 ad9850 sin파 2 댓글[6] 첨부파일opqr  22-07-21
질문 ad9850 sin파 합성 댓글[7] 첨부파일opqr  22-07-20
질문 특정값이 n초이상,n번 이상 연속될경우를 감지하는 함수… 댓글[4] 우수  22-07-17
질문 delay를 millis함수로 바꾸는데 질문있습니다. 댓글[12] 첨부파일뉴비에오  22-07-16
질문 피에조 부저로 맬로디 만들기인대 코딩 까지 했는데 아두… 댓글[2] 첨부파일mingu123  22-07-15
질문 블루투스와 안드로이드 연동관련 질문입니다! ㅎㅇㅎㅇ  22-07-14
질문 아두이노간 블루투스 통신에 대해서 질문있습니다 첨부파일뉴비에오  22-07-13
게시물 검색


Privacy Policy
MCU BASIC ⓒ 2017
PC버전