Login▼/회원가입BASIC4MCU | 질문게시판 | 답변 : 아두이노 스텝모터관련 문의 드립니다(꼭 봐주세요 ㅠㅠ)
페이지 정보
작성자 master 작성일2018-12-08 16:52 조회4,590회 댓글1건
https://www.basic4mcu.com/bbs/board.php?bo_table=gac&wr_id=6554
본문
// MCU BASIC: https://www.basic4mcu.com// DateTime : 2018-12-08 오후 4:57:49// by Ok-Hyun Park//#define TRIG_PIN 2#define ECHO_PIN 3//int mPin1=10,mPin2=11,mPin3=12,mPin4=13; //스텝모터 핀//스텝모터의 스텝설정const byte numbers[16]={0b11111100,0b01100000,0b11011010,0b11110010,0b01100110,0b10110110,0b10111110,0b11100000,0b11111110,0b11100110,0b11101110,0b00111110,0b10011100,0b01111010,0b10011110,0b10001110};//int elevator=1; // the value represents where elevator stayint distance=0;//void setup(){pinMode(TRIG_PIN,OUTPUT); pinMode(ECHO_PIN,INPUT);pinMode(mPin1,OUTPUT); pinMode(mPin2,OUTPUT);pinMode(mPin3,OUTPUT); pinMode(mPin4,OUTPUT);Serial.begin(9600);}//void HCSR04(){delay(100);digitalWrite(TRIG_PIN,1); delayMicroseconds(5); digitalWrite(TRIG_PIN,0);distance=pulseIn(ECHO_PIN,1)/5.8;}//void loop(){HCSR04();//---------------------------------------------------Serial.print("distance="); Serial.print(distance); Serial.println("mm");if(distance<=30){ // 센서 감지up(); elevator++;do{ HCSR04(); } while(distance<=30); // 센서 감지를 벗어날 때까지 대기if(elevator==3){ elevator=0; // 3층이면 지하1층으로 이동down(); down(); down();}Serial.print(elevator); Serial.println(" floor");}}//-------up function which is for to go up elevatorvoid up(){ // each floor distance where it works to upfor(int b=0; b<450; b++){digitalWrite(mPin1,0); digitalWrite(mPin2,0);digitalWrite(mPin3,0); digitalWrite(mPin4,1); delay(3);digitalWrite(mPin1,0); digitalWrite(mPin2,0);digitalWrite(mPin3,1); digitalWrite(mPin4,0); delay(3);digitalWrite(mPin1,0); digitalWrite(mPin2,1);digitalWrite(mPin3,0); digitalWrite(mPin4,0); delay(3);digitalWrite(mPin1,1); digitalWrite(mPin2,0);digitalWrite(mPin3,0); digitalWrite(mPin4,0); delay(3);}}//void down(){ // each floor distance where it works to downfor(int a=0; a<450; a++){digitalWrite(mPin1,1); digitalWrite(mPin2,0);digitalWrite(mPin3,0); digitalWrite(mPin4,0); delay(3);digitalWrite(mPin1,0); digitalWrite(mPin2,1);digitalWrite(mPin3,0); digitalWrite(mPin4,0); delay(3);digitalWrite(mPin1,0); digitalWrite(mPin2,0);digitalWrite(mPin3,1); digitalWrite(mPin4,0); delay(3);digitalWrite(mPin1,0); digitalWrite(mPin2,0);digitalWrite(mPin3,0); digitalWrite(mPin4,1); delay(3);}}
- BASIC4MCU 작성글 SNS에 공유하기
댓글 1
조회수 4,590융추님의 댓글
융추 작성일
정말 감사합니다. ㅠㅠㅠㅠ 진짜 감사해요 ㅠㅠ