Page 55 - MDP2020-1

················································································ 명장양성프로젝트 【MDP】 과제발표회 자료집 Ⅰ | 49

for(int j = servo0Ppos; j <= servo0Pos; j++) {
servo_0.writeMicroseconds(j);
}
}

servo0Ppos = servo0Pos;
}

if(dataIn.startsWith("s2")) {

String dataInS = dataIn.substring(2, dataIn.length());
servo1Pos = dataInS.toInt();
if(servo1Ppos > servo1Pos) {
for(int j = servo1Ppos; j >= servo1Pos; j--) {
servo_1.writeMicroseconds(j);
}

}
if(servo1Ppos < servo1Pos) {
for(int j = servo1Ppos; j <= servo1Pos; j++) {
servo_1.writeMicroseconds(j);

}
}
servo1Ppos = servo1Pos;
}

if(dataIn.startsWith("s3")) {

String dataInS = dataIn.substring(2, dataIn.length());
servo2Pos = dataInS.toInt();
if(servo2Ppos > servo2Pos) {
for(int j = servo2Ppos; j >= servo2Pos; j--) {
servo_2.writeMicroseconds(j);

}
}
if(servo2Ppos < servo2Pos) {
for(int j = servo2Ppos; j <= servo2Pos; j++) {
servo_2.writeMicroseconds(j);

}
}
servo2Ppos = servo2Pos;
}

if(dataIn.startsWith("s4")) {
String dataInS = dataIn.substring(2, dataIn.length());