Page 56 - 2
P. 56
}
}
setStep();
setServo();
myStepper1.moveStep();
myStepper2.moveStep();
}
void setStep(){
/********************* X DATA ************************/
if(dataX != pdataX){ // 과거 X 좌표와 현재 X 좌표가 다를 때
if(dataX < pdataX){ // 현재 X 좌표가 더 클 때
stepsX = (pdataX - dataX) * 1;
myStepper1.setStep(stepsX); // 펜 X 좌표 이동
myStepper1.setStep(0);
}
else{ // 현재 X 좌표가 더 작을 때
stepsX = (dataX - pdataX) * 1;
myStepper1.setStep(-stepsX); // 펜 X 좌표 이동
myStepper1.setStep(0);
}
}
dataX = pdataX; // 현재 X 좌표를 과거 X 좌표로 저장
/********************* Y DATA ************************/
if(dataY != pdataY){ // 과거 Y 좌표와 현재 Y 좌표가 다를 때
if(dataY < pdataY){ // 현재 Y 좌표가 더 클 때
stepsY = (pdataY - dataY) * 1;
myStepper2.setStep(stepsY); // 펜 Y 좌표 이동
myStepper2.setStep(0);
}
else{ // 현재 Y 좌표가 더 작을 때
stepsY = (dataY - pdataY) * 1;
myStepper2.setStep(-stepsY); // 펜 Y 좌표 이동
myStepper2.setStep(0);
}
}
dataY = pdataY; // 현재 Y 좌표를 과거 Y 좌표로 저장
}
void setServo(){
- 56 -
