1. #include<Servo.h>      // Thư viện điều khiển servo

2.  

3. // Khai báo đối tượng myservo dùng để điều khiển servo

4. Servomyservo;          

6. intbientro=A0;       // Khai báo chân analog đọc biến trở điều khiển servo

7. intservoPin=9;       // Khai báo chân điều khiển servo

8. 

9. voidsetup()

10.  {

11.      // Cài đặt chức năng điều khiển servo cho chân servoPin

12.      myservo.attach(servoPin);

14.      Serial.begin(9600);// Mở giao tiếp Serial ở baudrate 9600

15.  }

16.   

17.  voidloop()

18.  {

19.      intvalue=analogRead(bientro);// Đọc giá trị biến trở

21.      // Chuyển giá trị analog (0-1023) đọc được từ biến trở sang số đo độ (0-180độ)

22.      // dùng để điều khiển góc quay cho servo

23.      intservoPos=map(value,0,1023,0,180);

25.      // Cho servo quay một góc là servoPos độ

26.      myservo.write(servoPos);

28.      Serial.println(servoPos);

30.      delay(100);

31.  }