Cơ cấu servo và điều khiển góc quay

Cơ cấu servo và điều khiển góc quay

Servo SG90 — linh kiện chính của tay robot

1. Motor DC + hộp số + encoder vị trí trong một vỏ nhỏ
2. Tín hiệu PWM: xung 50Hz, độ rộng 1–2ms điều khiển góc 0°–180°
3. Nguồn: 4.8–6V, dòng tải 100–900mA (cần nguồn riêng, không qua Arduino)
4. Moment xoắn: SG90 = 1.8 kg·cm, MG90S (metal gear) = 2.2 kg·cm

Cấu trúc tay robot 3 bậc tự do (DOF)

        [Gripper (servo 3)]
            |
      [Link 2 (forearm)]
            |
      [Servo 2 (elbow)]
            |
      [Link 1 (upper arm)]
            |
      [Servo 1 (shoulder)]
            |
      [Base (servo 0 — xoay)]
            |
         [Đế robot]

Điểm chính bài video:

1. Tại sao dùng servo thay vì DC motor cho tay robot
2. Sơ đồ kết nối 3 servo với Arduino (nguồn riêng)
3. Thư viện Servo.h — dùng ngay không cần cài thêm
4. Demo code điều khiển 3 servo cùng lúc
5. Lưu ý về nguồn điện — servo cần ít nhất 1A/servo

Giáo án giảng dạy

Mục tiêu bài học

• Học viên giải thích được vai trò của bài Cơ cấu servo và điều khiển góc quay trong mạch robot tay gắp mini dùng servo.
• Học viên đọc được sơ đồ chân, nhận biết nguồn, GND và đường tín hiệu trước khi cấp điện.
• Học viên chạy được ví dụ mẫu, quan sát hiện tượng, rồi sửa một tham số để hiểu tác động kỹ thuật.

Kiến thức nền

Bài này đặt trong khóa Robot Tay Gắp Mini. Phần cứng trung tâm là Arduino Uno/Nano hoặc ESP32, cơ cấu chấp hành gồm servo SG90/MG90S cho đế, vai, khuỷu và kẹp, cảm biến hoặc tín hiệu liên quan gồm nút nhấn, biến trở hoặc joystick tùy bài. Khi dạy, giáo viên nên nhấn mạnh quan hệ giữa 3 lớp: phần cứng nhận tín hiệu, chương trình xử lý logic, và cơ cấu tạo chuyển động thật.

Linh kiện và dụng cụ

Sơ đồ nối dây khuyến nghị

Quy trình thực hành trên lớp (30-45 phút)

1. Giáo viên giới thiệu mục tiêu và chỉ ra linh kiện thật trên bàn học.
2. Học viên nối dây khi chưa cấp nguồn tải, sau đó kiểm tra chéo theo cặp.
3. Upload code mẫu, mở Serial Monitor nếu bài có dữ liệu cần quan sát.
4. Chạy thử ở tốc độ/tham số thấp để giảm rủi ro va chạm hoặc quá dòng.
5. Học viên thay đổi một tham số: tốc độ PWM, ngưỡng cảm biến, góc servo hoặc thời gian giữ.
6. Cả lớp ghi lại hiện tượng: robot nhanh/chậm hơn, lệch hướng, rung, mất line hoặc phản ứng trễ.
7. Giáo viên tổng kết bằng sơ đồ "input → xử lý → output" của bài học.

Code mẫu nền tảng

#include <Servo.h>

Servo baseServo, shoulderServo, gripperServo;

void moveSmooth(Servo &servo, int fromDeg, int toDeg) {
  int step = fromDeg < toDeg ? 1 : -1;
  for (int a = fromDeg; a != toDeg; a += step) {
    servo.write(a);
    delay(12);
  }
  servo.write(toDeg);
}

void setup() {
  baseServo.attach(5);
  shoulderServo.attach(6);
  gripperServo.attach(9);
}

Giải thích kỹ thuật

• Nguồn quyết định độ ổn định: motor và servo kéo dòng cao nên cần nguồn riêng, tụ lọc và dây đủ chắc.
• Tín hiệu điều khiển chỉ mang lệnh, không mang công suất. Board điều khiển gửi HIGH/LOW/PWM, driver mới cấp dòng cho tải.
• Calibration giúp robot hoạt động lặp lại được: cảm biến cần ngưỡng, servo cần góc home, motor cần bù sai lệch hai bên.
• Tách hàm làm code dễ dạy: một hàm cho đọc input, một hàm xử lý quyết định, một hàm điều khiển output.

Checklist an toàn phần cứng

• không ép servo quá hành trình; luôn về home trước khi chạy chuỗi tự động.
• Kiểm tra cực dương/âm của pin bằng mắt và bằng đồng hồ đo nếu có.
• Không để dây nguồn trần chạm nhau hoặc chạm khung kim loại.
• Khi motor/servo nóng bất thường, dừng nguồn tải trước rồi mới sửa code hoặc sửa dây.
• Với pin Li-ion/LiPo, không sạc khi không giám sát và không dùng pin phồng.

Lỗi thường gặp và cách debug

Bài tập trên lớp

• Hoàn thành mạch và chạy code mẫu ổn định ít nhất 3 lần liên tiếp.
• Giải thích bằng lời vai trò của từng dây: VCC, GND, signal/PWM và nguồn tải.
• Thay đổi một tham số trong code và ghi lại hiện tượng trước/sau.

Bài tập về nhà

• Viết lại kiến thức chính bằng sơ đồ khối và liên hệ với một lỗi phần cứng có thể xảy ra.
• Vẽ lại sơ đồ nối dây của bài vào vở hoặc slide nhóm.
• Chuẩn bị một câu hỏi debug cho buổi sau: "Nếu robot không chạy, em sẽ kiểm tra gì đầu tiên?"

Tiêu chí đánh giá

Gợi ý cho giáo viên

Với học viên mới, đừng bắt đầu bằng code dài. Hãy cho học viên chạm linh kiện, đoán chức năng, rồi mới nối dây. Khi có lỗi, yêu cầu các nhóm đọc lỗi theo thứ tự: nguồn → GND → chân tín hiệu → code → cơ khí. Cách này hình thành tư duy hardware engineering thay vì chỉ sửa mò.