#include <Servo.h>
Servo L1, L2; // Servo 1 dan 2
#define TMIN1 500 // Lebar Pulsa MIN Servo1
#define TMAX1 2450 // Lebar Pulsa MAX Servo1
#define TMIN2 500 // Lebar Pulsa MIN Servo2
#define TMAX2 2450 // Lebar Pulsa MAX Servo2
int theta1 = 0; // Sudut lengan 1
int theta2 = 0; // Sudut lengan 2
void setup() {
L1.attach(8,TMIN1,TMAX1); // Servo 1 ke pin 8
L2.attach(9,TMIN2,TMAX2); // Servo 2 ke pin 9
}
void loop() {
L1.write(theta1);
L2.write(90-theta2); // Posisi Servo 2 dibalik
delay(20);
}