// các hàm cơ bản của dộng cơ servo
// tạo đối tượng
// Servo tên;
// Kết nối một chân trên Arduino với động cơ servo.
// Servo. attach(pin) pin là chân mà bạn muốn kết nối
// Đặt góc quay của servo.
// servo.write(degrees); degrees là góc 0 -->180 độ
#include <Servo.h>
Servo servo1;//tạo một đối tượng servo mới có tên là servo1.
// Bạn có thể sử dụng đối tượng này để điều khiển một động cơ servo kết nối với Arduino.
Servo servo2;
int x = A1;
int y = A0;
int goc1=0;
int goc2=0;
int a;
int b;
void setup() {
Serial.begin(9600);
servo1.attach(9);// kết nối động cơ 1 với chân số 9
servo2.attach(10);
pinMode(x, INPUT);
pinMode(y, INPUT);
}
void loop() {
a = analogRead(x); // giá trị analog của x
b = analogRead(y);
// điều khiển led
if (a==0){
digitalWrite(3, HIGH);
}
else{digitalWrite(3, LOW);}// chú ý hàm else khi sử dụng với digital phải
// sử dụng với dấu ngoặc nhọn
if (a==1023){
digitalWrite(2, HIGH);
}
else{digitalWrite(2,LOW); }
if (b==0){
digitalWrite(4, HIGH);
}
else {digitalWrite(4, LOW); }
if (b==1023){
digitalWrite(7, HIGH);
}
else {digitalWrite(7, LOW); }
// điều khiển servo1
if (a==0){
if (goc1<=180)
{
if (a==0) {goc1=goc1+10;
delay(50);
servo1.write(goc1);} }
}
else if (a==1023) {
if (goc1>=0)
{ if (a==1023){
goc1=goc1-10;
delay(50);
servo1.write(goc1);
}
}
}
// điều khiển servo 2
if (b==0){
if (goc2<=180)
{
if (b==0) {goc2=goc2+10;
delay(50);
servo2.write(goc2);} }
}
else if (b==1023) {
if (goc2>=0)
{ if (b==1023){
goc2=goc2-10;
delay(50);
servo2.write(goc2);
}
}
}
}