Stap 5: De voorbeeldcode voor de robot hand beweging:
#include
Servo servo1, servo2, servo3, servo4, servo5;
int pos = 0;
VOID Setup
{
servo1.attach(8);
servo2.attach(9);
servo3.attach(10);
servo4.attach(11);
servo5.attach(12);
}
void loop
{
voor (pos = 180; pos > = 0; pos-= 1)
{
servo1.write(POS);
servo2.write(POS);
servo3.write(POS);
servo4.write(POS);
servo5.write(POS);
delay(15);
}
voor (pos = 0; pos < = 180; pos += 1)
{
servo1.write(POS);
servo2.write(POS);
servo3.write(POS);
servo4.write(POS);
servo5.write(POS);
delay(15);
}
}