Page 55 - 2

8. 소프트웨어 작성하기
가 프로그램 흐름도.

나. Arduino 에서 데이터 처리를 위한 프로그램 소스
#include <StepperMulti.h>
#include <Servo.h>
#define servoPin 3

Servo servo;

const int stepsPerRevolution = 200; // 360 ( 1.8 * 200 ) 도
int val, pdataX, pdataY, dataX = 0, dataY = 0, stepsX, stepsY, pmouse;

StepperMulti myStepper1(stepsPerRevolution, 8, 9, 10, 11); // 모터 1 X
StepperMulti myStepper2(stepsPerRevolution, 4, 5, 6, 7); // 모터 2 Y

void setup(){
Serial.begin(9600);
myStepper1.setSpeed(300); // 변경할 것
myStepper2.setSpeed(300); // 변경할 것
servo.attach(servoPin);
}

void loop(){
if(Serial.available() > 3){
val = Serial.read();
if(val == 'S'){ // 통신 시작
pdataX = Serial.read(); // 현재 X 좌표
pdataY = Serial.read(); // 현재 Y 좌표
pmouse = Serial.read(); // 서보 모터

- 55 -