LAB 9 การใช้งานเซอโวมอเตอร์

#include <Servo.h>     //เรียกใช้งาน library เซอโว

Servo sv1;                  // กำหนดชื่อเซอโวตัวที่ 1 ว่า sv1  

Servo sv2;                 // กำหนดชื่อเซอโวตัวที่ 2 ว่า sv2  

const int buttonPin = 2;  //ประกาศตัวแปร  buttonPin  แทน Pin ของปุ่มกด ซึ่งต่อไว้กับ D2

void setup() {

  sv1.attach(7);         //กำหนดขา Servo ตัวที่ 1  ตัวบีบ เป็น Pin 7

  sv2.attach(8);        //กำหนดขา Servo ตัวที่ 2  ตัวบีบ เป็น Pin 8

}

void loop(){

int sw = digitalRead(buttonPin);

if (sw == 1){

sv1.write(60);  // เซอโว 1 หมุนไปที่ ตำแหน่ง 60 ํ

sv2.write(90);  //เซอโว 2 หมุนไปที่ ตำแหน่ง 90 ํ

delay(300);   // หน่วงเวลาเพื่อรอให้เซอโวเคลื่อนที่ไปยังตำแหน่ง

sv1.write(30);  // เซอโว 1 หมุนไปที่ ตำแหน่ง 30 ํ

sv2.write(120);  //เซอโว 2 หมุนไปที่ ตำแหน่ง 120 ํ

delay(300);   // หน่วงเวลาเพื่อรอให้เซอโวเคลื่อนที่ไปยังตำแหน่ง

  }

}