Download as docx, pdf, or txt
Download as docx, pdf, or txt
You are on page 1of 4

HT NHUNG

B1:
#include <Servo.h>
Servo servo1;
Servo servo2;
const int Servo1Pin = 9, Servo2Pin = 10;
int pos1 = 0, pos2= 180;
int sign1 = 1, sign2 = -1;
void setup() {
servo1.attach(Servo1Pin);
servo2.attach(Servo2Pin);
servo1.write(pos1);
servo2.write(pos2);

}
void loop() {
servo1.write(pos1); servo2.write(pos2);
pos1 = pos1 + sign1 ; pos2 = pos2 + sign2;
if(pos1 == 181){
pos1 = 180; sign1 = -sign1;
}
if(pos1 == -1){
pos1 = 0; sign1 = -sign1;
}
if(pos2 == -1){
pos2 = 0; sign2 = -sign2;
}
if(pos2 == 181){
pos2 = 180 ; sign2 = -sign2;
}
delay(20);
}
B2.
#include <Servo.h>
const int Servo1Pin = 9, Servo2pin = 10;
int Button1 = 4, Button2 = 5;
Servo servo1;
Servo servo2;
void setup() {
servo1.attach(Servo1Pin);
servo2.attach(Servo2pin);
pinMode(Button1,INPUT_PULLUP);//dtro keo len
pinMode(Button2,INPUT_PULLUP);
servo1.write(0);
servo2.write(0);
}
void loop() {
Button1 = digitalRead(4);
Button2 = digitalRead(5);
if(Button1 == 0){
servo1.write(45);
}
else{
servo1.write(0);
}
if(Button2 == 0){
servo2.write(90);
}
else{
servo2.write(0);
}

}
B3.
#include <Servo.h>
Servo servo1;
const int Servo1Pin = 9;
int pos1 = 0;
int sign1 = 1;
void setup() {
servo1.attach(Servo1Pin);
servo1.write(pos1);
}
void loop() {
servo1.write(pos1);
pos1 = pos1 + sign1;
if(pos1 == 181){
pos1 = 180; sign1 = -sign1;
}
if(pos1 == -1){
pos1 = 0; sign1 = -sign1;
}
delay(30);
}
B5.

#include <Servo.h>
Servo servo1;
const int servo1Pin =9;
int pos1 = 0;
void setup() {
servo1.attach(servo1Pin);
servo1.write(pos1);
}
void loop() {
servo1.write(45);
delay(5000);
servo1.write(90);
delay(5000);
servo1.write(180);
delay(5000);
}
B6.
#include <Servo.h>

Servo servo1; // Tạo đối tượng servo cho động cơ servo thứ nhất
Servo servo2; // Tạo đối tượng servo cho động cơ servo thứ hai

const int buttonPin1 = 2; // Chân nút nhấn cho động cơ servo thứ nhất
const int buttonPin2 = 3; // Chân nút nhấn cho động cơ servo thứ hai

int pos1 = 0; // Vị trí ban đầu của động cơ servo thứ nhất
int pos2 = 0; // Vị trí ban đầu của động cơ servo thứ hai

void setup() {
servo1.attach(9); // Gắn servo thứ nhất vào chân số 9
servo2.attach(10); // Gắn servo thứ hai vào chân số 10

pinMode(buttonPin1, INPUT_PULLUP); // Đặt chân nút nhấn thứ nhất vào chế độ
INPUT_PULLUP
pinMode(buttonPin2, INPUT_PULLUP); // Đặt chân nút nhấn thứ hai vào chế độ
INPUT_PULLUP
}

void loop() {
if (digitalRead(buttonPin1) == 1) {
// Nếu nút nhấn thứ nhất được nhấn
pos1 = 180; // Đặt vị trí của servo thứ nhất là 90 độ
servo1.write(pos1); // Điều khiển servo thứ nhất
delay(500); // Đợi 5ms
}

if (digitalRead(buttonPin2) == 1) {
// Nếu nút nhấn thứ hai được nhấn
pos2 = 90; // Đặt vị trí của servo thứ hai là 180 độ
servo2.write(pos2); // Điều khiển servo thứ hai
delay(500); // Đợi 5ms
}
}

You might also like