#define PWM 9 /* กำหนดชื่อ PWM แทนขา 9 ( ขา PWM
ของเซอร์โวมอเตอร์ต่อกับขา 9 ของ Arduino ) */
#define t 90 // t แทนค่าเวลาของการหน่วง ที่ 0.09 วินาที่ (sec)
#include<Servo.h> /* นำเข้าไลบรารี่ ของเซอร์โวมอเตอร์เข้ามาใช้งาน
ในโปรแกรม */
Servo myservo; /* นำเข้าไลบรารี่โดยกำหนดชื่อ myservo ให้แทน
Servo motor ที่ใช้งาน */
int pos;
void setup()
{ // เริ่มการทำงานฟังก์ชั่น setup ทำแค่ครั้งเดียว
myservo.attach(9); // กำหนดขาพอร์ตที่ใช้เชื่อมต่อกับ Servo motor
} // จบการทำงานฟังก์ชั่น setup
void loop()
{ // เริ่มการทำงานฟังก์ชั่น loop ทำวนซ้ำ
for(pos = 0;pos<180;pos++) /* กำหนดให้ pos เท่ากับ 0 ถ้าค่า pos น้อยกว่า 180
ให้เพิ่มค่า pos */
{
myservo.write(pos); // สั่งให้ Servo motor หมุนไปที่มุม ที่กำหนดด้วย pos
delay(t); // หน่วงเวลา 0.09 วินาที (sec)
}
for(pos = 180;pos>0;pos--) /* กำหนดให้ pos เท่ากับ 180 ถ้าค่า pos มากกว่า 0
ให้ลดค่า pos */
{ // เริ่มการทำงานฟังก์ชั่น for
myservo.write(pos); // สั่งให้ Servo motor หมุนไปที่มุม ที่กำหนดด้วย pos
delay(t); // หน่วงเวลา 0.09 วินาที (sec)
} // จบการทำงานฟังก์ชั่น for
} // จบการทำงานฟังก์ชั่น loop
/* ผลการทำงานของโปรแกรม
===================================================
โปรแกรมจะควบคุมให้ Servo Motor หมุนจาก 0 - 180 องศา แล้วหมุนกลับ 180 - 0 องศาวนรอบ
หมุนไปกลับ */