Điều khiển động cơ servo với một ESP32
Cơ bản
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
Để điều khiển servo bằng ESP32, cấp nguồn 5 V cho servo, nối chung đất, nối dây tín hiệu của nó vào một chân GPIO, và gửi xung rộng từ 544 đến 2400 micro giây năm mươi lần mỗi giây. Trên ESP32, ngoại vi LEDC tạo xung đó bằng phần cứng: ledcAttach(pin, 50, 14) dựng khung và ledcWrite(pin, duty) đặt góc quay.
Mạch trên là một servo kiểu SG90 nối vào chân GPIO 4 của bo mạch ESP32-C3, quét từ 0 đến 180 độ rồi quay lại. Nó chạy ngay trong trình duyệt trên một ESP32-C3 được mô phỏng, và sketch chính là sketch bạn sẽ nạp vào bo mạch thật.
Những gì bạn cần
- Một bo mạch ESP32 (ở đây là ESP32-C3-DevKitM-1; ESP32 DevKit cổ điển được nối dây theo cách giống hệt)
- Một servo hobby SG90 (hoặc tương tự)
- Dây cắm và một breadboard cho các đường nguồn
Đi dây
| Linh kiện và chân | Nối tới | Ghi chú |
|---|---|---|
| Dây nâu của servo (GND) | GND | Qua đường GND chung của breadboard |
| Dây đỏ của servo (VCC) | 5V | Không phải 3V3: một SG90 cần 4 V trở lên |
| Dây cam của servo (tín hiệu) | GPIO 4 | Bất kỳ GPIO nào còn tự do và có thể làm chân xuất |
Bước 1: nối nguồn trước
Servo có ba dây. Dây nâu (hoặc đen) là GND, dây đỏ là nguồn, và dây cam (hoặc vàng, hoặc trắng) là tín hiệu. ESP32 là bo mạch 3.3 volt, nhưng SG90 cần bốn volt trở lên mới quay được, nên dây đỏ của nó nối vào chân 5V của bo mạch, chân này lấy nguồn từ USB, chứ không nối vào 3V3. Trong trình mô phỏng, cũng như trên bàn thí nghiệm, servo chạy 3.3 V sẽ không quay.
GND là dây hay bị quên nhất. Tín hiệu được đo so với GND của chính servo, nên servo và ESP32 phải dùng chung một GND. Ở đây cả hai cùng nối vào đường GND của breadboard. Nếu bạn cấp nguồn cho servo thật từ một nguồn riêng, hãy nối GND của nguồn đó với GND của bo mạch.
Bước 2: hiểu về xung
Servo dạng này nghe theo độ rộng xung, chứ không theo chu kỳ nhiệm vụ theo nghĩa điều sáng của PWM. Theo số liệu của thư viện Servo Arduino, 544 microgiây đưa cánh quay về một đầu, 2400 microgiây đưa sang đầu kia và 1472 microgiây về giữa, lặp lại mỗi 20 mili giây. Giữa các xung, servo giữ nguyên góc cuối cùng nó được lệnh.
Đó vẫn là sóng PWM, chỉ là chậm, nên ngoại vi LEDC của ESP32 tạo được. Tạo bằng phần cứng tốt hơn bật tắt một chân trong vòng lặp: độ rộng chính xác, ngắt nào cũng không làm xung bị giãn ra, và lõi xử lý rảnh giữa các chu kỳ.
Tín hiệu 3.3 volt từ ESP32 được hầu hết servo kiểu SG90 chấp nhận, nên dây tín hiệu thường không cần mạch chuyển mức, dù bản thân servo chạy bằng 5 volt.
Bước 3: giải thích đoạn code
ledcAttach(SERVO_PIN, 50, 14) cấp cho GPIO 4 một chu kỳ 50 hertz chia thành 16384 đơn vị đếm, nên mỗi đơn vị là 20000 / 16384, khoảng 1.22 microgiây. writeAngle() đổi 0 đến 180 độ thành 544 đến 2400 microgiây, đúng khoảng của thư viện Servo và mặc định của linh kiện servo, rồi đổi thành đơn vị đếm: 544 microgiây là 445 đơn vị và 2400 là 1966. Phép nhân đặt trước phép chia để không mất gì vì làm tròn.
setup() đưa cánh quay về 90 độ và đợi nửa giây. loop() rồi cho nó đi từ 0 đến 180 từng năm độ một, cách nhau 40 mili giây, in "at 180", đi ngược lại và in "back at 0". Mở serial monitor để thấy hai dòng này hiện ra sau mỗi lần quét.
const uint8_t SERVO_PIN = 4;
const uint32_t FRAME_HZ = 50;
const uint8_t FRAME_BITS = 14;
const uint32_t FRAME_US = 1000000UL / FRAME_HZ; // 20000
const uint32_t FRAME_COUNTS = 1UL << FRAME_BITS; // 16384
const uint32_t MIN_US = 544;
const uint32_t MAX_US = 2400;
uint32_t countsForMicros(uint32_t us) {
return (us * FRAME_COUNTS) / FRAME_US;
}
void writeAngle(int degrees) {
degrees = constrain(degrees, 0, 180);
uint32_t us = MIN_US + ((MAX_US - MIN_US) * (uint32_t)degrees) / 180;
ledcWrite(SERVO_PIN, countsForMicros(us));
}
void setup() {
Serial.begin(115200);
ledcAttach(SERVO_PIN, FRAME_HZ, FRAME_BITS);
writeAngle(90);
delay(500);
}
void loop() {
for (int angle = 0; angle <= 180; angle += 5) {
writeAngle(angle);
delay(40);
}
Serial.println("at 180");
for (int angle = 180; angle >= 0; angle -= 5) {
writeAngle(angle);
delay(40);
}
Serial.println("back at 0");
}Mở sketch này trong trình soạn codeChỉ riêng phần code: trình soạn code sẽ tự đặt bo mạch và các linh kiện mà nó đọc được từ sketch.
Bước 4: hoặc dùng thư viện ESP32Servo
Hầu hết hướng dẫn servo ESP32 dùng thư viện ESP32Servo, có các lệnh giống thư viện Servo Arduino: attach(pin) rồi write(angle). Trong Mokxi, ESP32Servo.h cũng là lớp giống Servo.h nhưng mang tên mà các hướng dẫn đó dùng, nên sketch của chúng biên dịch được nguyên vẹn. attach(pin) không kèm độ rộng xung dùng mặc định của ESP32Servo, 544 đến 2400 microgiây, nên write(90) là 1472 microgiây và 90 độ trên servo.
Cách dùng LEDC ở trên vẫn đáng để biết. Nó cho thấy thư viện làm gì giúp bạn, không cần thư viện nào cả, và là lựa chọn khi bạn muốn tần số chu kỳ hay khoảng xung mà thư viện không cung cấp.
Thử trong trình soạn thảo
Mở mạch trong trình soạn thảo và đổi bước từ 5 thành 1 độ cùng thời delay từ 40 thành 10 mili giây: vòng quét mượt hơn và nhanh gần như cũ. Sau đó đổi MIN_US và MAX_US thành 1200 và 1800. Cánh quay giờ chỉ quét một cung hẹp hơn, đó là cách giữ servo tránh xa điểm giới hạn cơ khí.
Chuyển dây tín hiệu sang GPIO khác và đổi SERVO_PIN cho khớp. LEDC có thể định tuyến tới bất kỳ chân xuất nào, nên servo theo ngay. Chọn servo để xem thuộc tính của nó, gồm khoảng xung và tốc độ quay.
Những lỗi thường gặp
Cấp nguồn cho servo từ 3V3. Servo không quay, hoặc trên bàn thí nghiệm thật nó chỉ giật yếu và không chịu quay. Hãy dùng 5V, hoặc một nguồn 5 volt riêng với hai GND nối chung.
Dùng code cho core ESP32 cũ. Các hướng dẫn viết cho core Arduino-ESP32 phiên bản 2 gọi ledcSetup() và ledcAttachPin() kèm số kênh. Phiên bản 3 thay bằng ledcAttach(pin, frequency, resolution) và ledcWrite(pin, duty), đó là những lệnh sketch này dùng.
Kỳ vọng bo mạch nuôi được servo bị kẹt. Một SG90 thật có thể hút vài trăm mili amp khi bị kẹt, đủ để reset một ESP32 đang chạy từ USB. Trình mô phỏng không mô phỏng dòng nguồn, nên nếu bạn làm mạch này thật, hãy cấp nguồn riêng cho servo.
Chọn sai độ phân giải. Ở 8 bit, một chu kỳ 50 hertz chỉ có 256 đơn vị đếm, mỗi đơn vị 78 microgiây, nên servo chỉ có khoảng 13 bước trên toàn hành trình. Mười bốn bit cho khoảng 819 bước.
Mở mạch này trong trình soạn thảo. ESP32-C3: quét servo, nối dây như đoạn chạy ở đầu trang này. Thay một linh kiện hoặc một giá trị rồi chạy lại.
Mở mạchCâu hỏi
Những chân ESP32 nào điều khiển được servo?
Bất kỳ GPIO nào có thể làm chân xuất. LEDC có thể định tuyến tới mọi chân đó. Tránh các chân mà bo mạch dùng cho flash hoặc khi khởi động, chúng được ghi chú trên sơ đồ chân của bo mạch.
Có thể cấp nguồn cho SG90 từ chân 3.3 V của ESP32 không?
Không. SG90 cần khoảng 4 đến 6 volt mới quay. Hãy cấp từ 5V hoặc từ nguồn 5 volt riêng, và nối chung GND với ESP32. Riêng tín hiệu 3.3 volt thì vẫn ổn.
Thư viện Servo Arduino có chạy được trên ESP32 không?
Không phải bản gốc, vì nó viết cho timer của AVR. Thư viện ESP32Servo có các lệnh giống hệt và là thứ các hướng dẫn ESP32 dùng. Trong Mokxi, cả Servo.h lẫn ESP32Servo.h đều biên dịch được cho các bo mạch ESP32.
Một ESP32 điều khiển được bao nhiêu servo?
Bao nhiêu servo tùy số kênh LEDC và chân xuất còn tự do: ESP32-C3 có sáu kênh LEDC và ESP32 cổ điển có mười sáu. Cần nhiều hơn, hoặc để tiết kiệm chân, một bo mạch PCA9685 điều khiển mười sáu servo qua I2C.
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.