#include <Servo.h>
Servo coxa;
Servo femur;
Servo tibia;
void setup() {
// My PWM pins (3, 5, and 6) as now
coxa.attach(3);
femur.attach(5);
tibia.attach(6);
}
void loop() {
// Standing Position
coxa.write(90);
femur.write(45);
tibia.write(90);
delay(1000);
// Step movements
femur.write(20); // Lift
delay(500);
coxa.write(120); // Move forward
delay(500);
femur.write(45); // Put down
delay(500);
}
Coxa -> 3~
Femur -> 5~
Tibia -> 6~