Page 57 - MDP2020-1

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

Read();
calculate();
Step = 0;
digitalWrite(13, LOW);

}
else {
arrayStep = 0;
calc_pause();

countverz = 0;
while(countverz < verz)
{
countverz += 1;
calc_pause();
digitalWrite(13, HIGH); delay(25);

digitalWrite(13, LOW); delay(975);
}
}
}

else
{
if (currentMicros - previousMicros > time)
{
previousMicros = currentMicros;
play_servo();

}
}
}
}

if(digitalRead(4) == true)
isBluetoothmode = false;
else {
servo_0.write(servo0Ppos);
servo_1.write(servo1Ppos);

servo_2.write(servo2Ppos);
servo_3.write(servo3Ppos);
isBluetoothmode = true;
}
}

void calc_pause()