BASIC4MCU | 질문게시판 | 아두이노 스텝모터 리미트 문의드립니다.
페이지 정보
작성자 스트렌져 작성일2022-05-24 22:29 조회392회 댓글4건본문
안녕하세요 신입입니다.
요즘 공부하고 있는게 잘안되서 문의드려봅니다....
위 링크처럼 똑같이 코드, 우노 스위치등 셋팅해 놨고
맨위 사진처럼 양옆에 리밋스위치를 두고 움직임 제어를 하려고 합니다.
sw_01 택트 스위치 - 시계 반대방향 (역회전)
sw 02 택트 스위치 - 시계방향 (정회전)을 하고
누룸지속(홀드)이 아니고 한번만 눌러주면 회전합니다.
여기서부터 질문입니다.
__________________________
첨부한 사진의 bar가 sw_01이든 02든 클릭한 방향으로 회전할텐데
양옆에는 리밋스위치를 두고
sw_01을 눌렀을시 모터가 역회전을 하고 limit_01을 누룸과 동시에 정지
이때 sw_01은 동작되면 안되고 sw_02를 눌로 정방향으로 회전하게 하고
반대로 sw_02를 눌러 limit_02를 누름과 동시에 정지하고 sw_02는 눌러도 작동되면안되고
sw_01을 눌러야 역회전 되게 할려고합니다.
이게 우노에서 가능할것같은데 동영상에서는 스톱으로 설정된 택트스위치를 누루고 방향 스위치를 누루면
원하는데로 되질 않네요...아는게 없어서 문의드려봅니다.
소스는
에 있습니다.
만약 가능하다면 우노기준으로 위 소스로 원하는 작동이 되게
수정이 가능한지 문의드려봅니다. 안되면 사례도 가능합니다.
-----------------------------------------------------------------
int Pin1 = 10; // 28BJY-48 모터핀
int Pin2 = 11; // 28BJY-48 모터핀
int Pin3 = 12; // 28BJY-48 모터핀
int Pin4 = 13; // 28BJY-48 모터핀
int switchCW = 2; // 모터 정회선 택트 스위치 핀
int switchStop = 3; // 정지 택트스위치
int switchCCW = 4; // 모터 역회전 택트 스위치 핀
int pole1[] ={0,0,0,0, 0,1,1,1, 0}; //pole1, 8 step values
int pole2[] ={0,0,0,1, 1,1,0,0, 0}; //pole2, 8 step values
int pole3[] ={0,1,1,1, 0,0,0,0, 0}; //pole3, 8 step values
int pole4[] ={1,1,0,0, 0,0,0,1, 0}; //pole4, 8 step values
int poleStep = 0;
int dirStatus = 3; // stores direction status 3= stop (do not change)
void setup()
{
pinMode(Pin1, OUTPUT); //define pin for ULN2003 in1
pinMode(Pin2, OUTPUT); //define pin for ULN2003 in2
pinMode(Pin3, OUTPUT); //define pin for ULN2003 in3
pinMode(Pin4, OUTPUT); //define pin for ULN2003 in4
pinMode(switchCW,INPUT_PULLUP); // CW push button pin as input
pinMode(switchStop,INPUT_PULLUP); //Stop push button pin as input
pinMode(switchCCW,INPUT_PULLUP); //CCW push button pin as input
}
void loop()
{
if(digitalRead(switchCCW) == LOW)
{
dirStatus =1;
}else if(digitalRead(switchCW) == LOW)
{
dirStatus = 2;
}else if(digitalRead(switchStop) == LOW)
{
dirStatus =3;
}
if(dirStatus ==1){
poleStep++;
driveStepper(poleStep);
}else if(dirStatus ==2){
poleStep--;
driveStepper(poleStep);
}else{
driveStepper(8);
}
if(poleStep>7){
poleStep=0;
}
if(poleStep<0){
poleStep=7;
}
delay(1);
}
// loop
void driveStepper(int c)
{
digitalWrite(Pin1, pole1[c]);
digitalWrite(Pin2, pole2[c]);
digitalWrite(Pin3, pole3[c]);
digitalWrite(Pin4, pole4[c]);
}
//driveStepper end here
댓글 4
조회수 392master님의 댓글
master 작성일
int Pin1=10,Pin2=11,Pin3=12,Pin4=13; // 28BJY-48
int swCW=2,swStop=3,swCCW=4;
int LimitCW=5,LimitCCW=6;
//
int pole1[]={0,0,0,0,0,1,1,1,0}; //pole1,8 step values
int pole2[]={0,0,0,1,1,1,0,0,0}; //pole2
int pole3[]={0,1,1,1,0,0,0,0,0}; //pole3
int pole4[]={1,1,0,0,0,0,0,1,0}; //pole4
//
int poleStep=0;
int dirStatus=3; // stores direction status 3=stop (do not change)
//
void setup(){
pinMode(Pin1,OUTPUT); pinMode(Pin2,OUTPUT); pinMode(Pin3,OUTPUT); pinMode(Pin4,OUTPUT); // ULN2003 in
pinMode(swCW,INPUT_PULLUP); // CW push button pin as input
pinMode(swCCW,INPUT_PULLUP); // CCW push button pin as input
pinMode(swStop,INPUT_PULLUP); // Stop push button pin as input
}
//
void loop(){
if (digitalRead(swCCW )==0)dirStatus=1;
else if(digitalRead(swCW )==0)dirStatus=2;
else if(digitalRead(swStop)==0)dirStatus=3;
//
if(dirStatus==1){
if(digitalRead(LimitCW)==0){ // 리미트가 닿지 않았을 때만 실행
if(++poleStep>7)poleStep=0; drvStep(poleStep);
}
else{ dirStatus=3; } // 리미트가 닿으면 STOP 모드
}
else if(dirStatus==2){
if(digitalRead(LimitCCW)==0){ // 리미트가 닿지 않았을 때만 실행
if(--poleStep<0)poleStep=7; drvStep(poleStep);
}
else{ dirStatus=3; }
}
else{ drvStep(8); }
//
delay(1);
}
//
void drvStep(int c){
digitalWrite(Pin1,pole1[c]); digitalWrite(Pin2,pole2[c]);
digitalWrite(Pin3,pole3[c]); digitalWrite(Pin4,pole4[c]);
}
스트렌져님의 댓글
스트렌져 작성일
답장감사드립니다.
그런데 리밋스위치가 없어서 임시로 텍트 스위치를
리미트CW 5번핀, 리미트CCW 6번핀으로 연결하고 GND묶고
해봤는데 리미트텍트스위치가 작동을 하지 않는것같습니다.
저항같은걸 붙여줘야 되는지요..
그리고 CCW 텍트스위치는 꾹 누루고 있어야 작동을 하고 누룰때 모터가 ㄷㄷㄷ 거려요...
아는게 없어서 죄송하지만 시간나실때 한번 봐주시면 감사하겠습니다.^^;;;
master님의 댓글
master
pinMode(swCW,INPUT_PULLUP); // CW push button pin as input
리미트 스위치도 위 스위치처럼 INPUT_PULLUP으로 선언하세요
스트렌져님의 댓글
스트렌져 작성일
말씀해주신것처럼
void setup(){
pinMode(Pin1,OUTPUT); pinMode(Pin2,OUTPUT); pinMode(Pin3,OUTPUT); pinMode(Pin4,OUTPUT); // ULN2003 in
pinMode(swCW,INPUT_PULLUP); // CW push button pin as input
pinMode(swCCW,INPUT_PULLUP); // CCW push button pin as input
pinMode(swStop,INPUT_PULLUP); // Stop push button pin as input
pinMode(LimitCW,INPUT_PULLUP); // 추가
pinMode(LimitCCW,INPUT_PULLUP); // 추가
}
추가하고 업로드하고 작동을 시켜봤습니다.
1. LimitCW와 LimitCWW 둘다 눌러지지 않은 상태에선 CCW와 CW 스위치가 작동하지 않습니다.
리밋이 눌려지지 않은 상태에선 CCW와 CW가 자유롭게 움직여야됩니다.
2. LimitCW가 눌려져 있는 상태에서 CW는 작동하지 않고 CCW가 작동해서 이건정상입니다.
그러나 CCW를 눌러 반대로 회전하면서 눌러져 있던 LimitCWW가 푸쉬OFF 되자마자 모터가 정지합니다.
멈추지 말고 CCW방향으로 움직여야됩니다.
그래서 if(digitalRead(LimitCW)==0) <- if(digitalRead(LimitCW)==1) 로 바꾸니 작동을 하지만
리미트cw와 리미트 ccw가 반대로 작동해서 핀을 바꿔서 해보니 원하는 기능으로 작동했습니다.
많은 도움이 되었습ㄴ디ㅏ.도움주셔서 감사드립니다.