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
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ân | Nối tới | Ghi chú |
|---|---|---|
| Chân SDA của PCA9685 | A4 | Chân dữ liệu I2C của Uno |
| Chân SCL của PCA9685 | A5 | Xung clock I2C của Uno; bo mạch có điện trở kéo của riêng nó |
| PCA9685 VCC | 5 V | Nguồn logic chỉ cho con chip |
| PCA9685 GND | GND | Dùng chung với Uno và nguồn cấp servo |
| PCA9685 V+ | Nguồn 5 V riêng | Nguồn cho các servo, không lấy từ Uno |
| Kênh 0 | Servo đế | Xoay toàn bộ cánh tay |
| Kênh 1 | Servo vai | Nghiêng đoạn cánh tay trên |
| Kênh 2 | Servo khuỷu | Nghiêng đoạn cẳng tay |
| Kênh 3 | Servo càng | Mở 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.
#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ạchCâ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.
Tiếp tục nào
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.