Học

Cánh tay robot bốn servo trên một driver servo PCA9685

Nâng cao

Hoặc xem mọi bài học.

  • 526linh kiện trên bàn làm mạch
  • 46bo mạch đang chạy
  • 1.00xthời gian thực, trên mọi bo mạch
Arduino Uno: cánh tay robot trên PCA9685trực tiếp0.000 s 0.00x
Nhấp để mở trong trình soạn thảo
Ví dụ Pick and place arm trên ATmega328P mô phỏng: bốn servo, hai dây I2C.

PCA9685 là bo màu xanh có mười sáu header servo dọc theo một cạnh. Nó tự tạo các xung servo, nên Arduino của bạn chỉ cần nói mỗi servo nên đến đâu. Bo mạch chỉ cần hai dây, các chân I2C, dù bạn chạy một hay mười sáu servo. Đó là lý do các bộ kit cánh tay robot và hexapod dùng nó.

Mạch trên là một Arduino Uno điều khiển cánh tay robot để bàn bốn servo qua PCA9685. Cánh tay nhặt một linh kiện bên trái, xoay sang, đặt xuống bên phải rồi về vị trí gốc, lặp đi lặp lại. Mỗi bước chuyển động được in trong serial monitor. Nó chạy ngay trong trình duyệt với sketch bên dưới.

Những gì bạn cần

  • Một Arduino Uno
  • Bo driver servo 16 kênh PCA9685
  • Up to sixteen hobby servos (four SG90s in a robot arm here)
  • Một nguồn 5 V riêng cho các servo
  • Dây cắm

Đi dây

Linh kiện và chânNối tớiGhi chú
Chân SDA của PCA9685A4Chân dữ liệu I2C của Uno
Chân SCL của PCA9685A5Xung clock I2C của Uno; bo mạch có điện trở kéo của riêng nó
PCA9685 VCC5 VNguồn logic chỉ cho con chip
PCA9685 GNDGNDDùng chung với Uno và nguồn cấp servo
PCA9685 V+Nguồn 5 V riêngNguồn cho các servo, không lấy từ Uno
Kênh 0Servo đếXoay toàn bộ cánh tay
Kênh 1Servo vaiNghiêng đoạn cánh tay trên
Kênh 2Servo khuỷuNghiêng đoạn cẳng tay
Kênh 3Servo càngMở và đóng càng

Hai nguồn, một mass

PCA9685 có hai nguồn riêng biệt. VCC cấp cho con chip và lấy từ chân 5 V của Uno. V+ cấp cho các servo và nên lấy từ nguồn 5 V riêng. Servo ngốn dòng điện khá lớn khi chuyển động, nhiều hơn nhiều so với mức chân 5 V của Uno đáp ứng nổi. Tất cả các mass nối chung với nhau.

Đây là nguyên nhân gây rắc rối lớn nhất trên mạch thật. Servo rung nhẹ, hoặc Uno bị reset khi cánh tay chuyển động, gần như luôn do servo chạy từ chính chân 5 V của bo mạch.

Code: từ góc sang xung

Sketch dùng thư viện Adafruit PWM Servo Driver, đã được tích hợp sẵn trong Mokxi. pwm.begin() đánh thức con chip. pwm.setPWMFreq(50) đặt tần số xung mà servo cần: năm mươi lần mỗi giây.

Sau đó setAngle() đổi góc thành độ rộng xung. Sketch dùng khung giá trị của thư viện Servo Arduino, 544 microgiây cho 0 độ và 2400 microgiây cho 180 độ, nên map() chuyển từ cái này sang cái kia, và writeMicroseconds() gửi nó vào một kênh.

glide() chuyển cả bốn khớp đến tư thế mới cùng lúc, trong 25 bước nhỏ cách nhau 30 ms. Đó là cách một cánh tay thật tránh làm hỏng bánh răng và làm văng thứ nó đang cầm.

Phần cài đặt và một khớp, từ ví dụ Pick and place arm
#include <Wire.h>
#include <Adafruit_PWMServoDriver.h>

Adafruit_PWMServoDriver pwm = Adafruit_PWMServoDriver();

const int MIN_US = 544;
const int MAX_US = 2400;

void setAngle(int channel, int degrees) {
  pwm.writeMicroseconds(channel, map(degrees, 0, 180, MIN_US, MAX_US));
}

void setup() {
  Serial.begin(115200);
  pwm.begin();
  pwm.setPWMFreq(50);
  setAngle(0, 90);  // the base to the middle
}

setPWM và các giá trị đếm

Nhiều bài hướng dẫn dùng pwm.setPWM(channel, 0, count) thay cho writeMicroseconds(). Con chip chia mỗi chu kỳ thành 4096 giá trị đếm. Ở 50 Hz, một giá trị đếm khoảng 4,9 microgiây, nên xung servo từ 544 đến 2400 microgiây tương ứng khoảng 111 đến 492 giá trị đếm. Cả hai cách gọi đều chạy được ở đây.

Dòng oscillator trong ví dụ của Adafruit

Sketch ví dụ của Adafruit có dòng pwm.setOscillatorFrequency(27000000). Dòng đó chỉnh thư viện cho đúng một con chip thật cụ thể, vì chip thật thường lệch vài phần trăm so với chuẩn 25 MHz ghi trên nó.

Con chip mô phỏng chạy đúng chính xác 25 MHz. Nếu copy dòng đó vào Mokxi thì mọi xung sẽ ngắn hơn khoảng 8 phần trăm so với yêu cầu. Ở đây đừng thêm dòng này. Trên bo mạch thật của bạn, hãy đo và chỉnh nếu servo của bạn lệch một chút.

Thử trong trình soạn thảo

Đổi các góc trong loop để dạy cánh tay một động tác mới. Đổi 25 bước thành 50 trong glide() thì mọi động tác sẽ mượt và chậm hơn.

Hãy so sánh với dự án Robot arm with joysticks. Dự án đó điều khiển cùng cánh tay từ bốn chân Uno bằng thư viện Servo và không cần PCA9685. Bốn servo vẫn vừa trên một Uno theo cả hai cách; PCA9685 mới là thứ cho bạn nâng lên mười sáu servo chỉ trên hai dây.

Hãy quan sát PCA9685 khi nó chạy. Dưới mỗi kênh, bo mạch hiển thị độ rộng xung đang gửi, tính bằng microgiây.

Những lỗi thường gặp

Cấp nguồn servo từ chân 5 V của Uno. Hãy cho V+ nguồn riêng và nối chung mass.

Quên gọi setPWMFreq(50). Servo cần xung năm mươi lần mỗi giây.

Giới hạn xung không khớp với servo của bạn. Mỗi loại servo khác nhau: loại cần 1000 đến 2000 microgiây, loại khác 500 đến 2500. Hãy kiểm tra servo của bạn, và đặt min_pulse và max_pulse của servo ở đây cho khớp, nếu không bạn sẽ không đạt được toàn bộ dải góc.

Hai bo mạch cùng một địa chỉ. Mọi PCA9685 đều bắt đầu ở 0x40. Để nối thêm, hãy hàn các jumper địa chỉ trên các bo mạch thêm sao cho mỗi bo có địa chỉ riêng.

Mở mạch này trong trình soạn thảo. Arduino Uno: cánh tay robot trên PCA9685, nối dây như đang chạy ở đầu trang này. Đổi một linh kiện hoặc một giá trị rồi chạy lại.

Mở mạch

Câu hỏi

Một PCA9685 điều khiển được bao nhiêu servo?

Mười sáu servo mỗi bo mạch. Các bo có thể dùng chung hai dây I2C nếu mỗi bo có địa chỉ riêng, đặt bằng các jumper hàn.

PCA9685 dùng những chân nào trên Arduino Uno?

SDA vào A4 và SCL vào A5, cộng thêm 5 V và mass cho con chip. Các servo lấy nguồn từ V+.

Sao servo của tôi bị rung trên PCA9685?

Phổ biến nhất là nguồn servo quá yếu hoặc dùng chung với Arduino. Hãy cho V+ nguồn 5 V riêng đủ sức chịu khi tất cả servo chuyển động cùng lúc.

Mokxi không mô phỏng gì trên PCA9685?

Độ lệch của oscillator thật, ngõ vào clock ngoài, các địa chỉ phụ và lệnh software reset. Con chip chạy đúng chính xác 25 MHz.

Lắp mạch này ngoài đời

Mở trình soạn thảo, đổi một giá trị và xem con số thay đổi theo. Không cần cài gì, không cần tài khoản.