include

void setup()
{
oled.text(0, 0, “Hello POP-32”);
oled.show();
waitSW_OK();
beep();
oled.clear();
oled.text(0, 0, “RUN”);
oled.show();
//servo1 เลขมาก ไปทาง ซ้าย
//servo2 เลขมาก ไปทาง ก้ม
//servo3 เลขมาก ไปทาง ก้ม
//servo4 เลขมาก ไปทาง หนีบ แนะนำ 150
}
void stanby() {
servo(4, 150);
servo(2, 146);
delay(500);
servo(3, 8);
delay(500);
servo(4, 12);
delay(1000);
servo(1, 100);
}
void up() {
//servo(4, 150);
//delay(500);
servo(3, 15);
delay(500);
servo(2, 146);
delay(1000);
servo(1, 100);
}
void jub() {
servo(1, 176);
delay(500);
servo(2, 179);
delay(1000);
servo(3, 73);
delay(1000);
servo(4, 150);
delay(500);
}
void phoy() {
servo(1, 15);
delay(500);
servo(2, 179);
delay(500);
servo(3, 73);
delay(1000);
servo(4, 100);
delay(1000);
}
void testKN() {
oled.text(1, 0, “Knob:%d”, knob(180));
oled.show();
int KN = knob(180);
servo(1, KN);
delay(1000);
servo(2, 146);
delay(1000);
servo(3, 8);
delay(1000);
servo(4, 12);
}
void loop()
{
oled.clear();
if (SW_B()) {
oled.text(0, 0, “stanby”);
oled.show();
sound(1200, 1000);
stanby();
}
if (SW_A()) {
oled.text(0, 0, “jub-up-phoy”);
oled.show();
sound(3200, 800);
jub();
sound(4200, 800);
up();
sound(3200, 800);
phoy();
}
delay(10);
}

}