Kendalikan motor servo dengan ESP32
Pemula
Atau lihat semua pelajaran.
- 526komponen di meja kerja
- 46board sedang berjalan
- 1.00xwaktu nyata, di semua board
Untuk mengendalikan servo dengan ESP32, beri daya servo dari 5 V, satukan ground, sambungkan kabel sinyalnya ke pin GPIO, dan kirim pulsa selebar 544 sampai 2400 mikrodetik lima puluh kali per detik. Di ESP32, peripheral LEDC membuat pulsa itu di hardware: ledcAttach(pin, 50, 14) mengatur frame-nya dan ledcWrite(pin, duty) mengatur sudutnya.
Rangkaian di atas adalah servo model SG90 pada GPIO 4 board ESP32-C3, yang bergerak dari 0 ke 180 derajat dan kembali. Semuanya berjalan di browser-mu pada ESP32-C3 tersimulasi, dan sketch-nya adalah sketch yang akan kamu flash ke board sungguhan.
Yang kamu butuhkan
- Sebuah board ESP32 (di sini ESP32-C3-DevKitM-1; ESP32 DevKit klasik disambung dengan cara yang sama)
- Motor servo SG90 (atau sejenisnya)
- Kabel jumper, dan breadboard untuk jalur daya
Pengkabelan
| Komponen dan pin | Disambung ke | Catatan |
|---|---|---|
| Kabel cokelat servo (GND) | GND | Melalui jalur ground breadboard |
| Kabel merah servo (VCC) | 5V | Bukan 3V3: SG90 butuh 4 V atau lebih |
| Kabel oranye servo (sinyal) | GPIO 4 | GPIO bebas apa pun yang bisa menjadi output |
Langkah 1: sambungkan daya dulu
Servo punya tiga kabel. Cokelat (atau hitam) adalah ground, merah adalah daya, dan oranye (atau kuning, atau putih) adalah sinyal. ESP32 adalah board 3,3 volt, tapi SG90 butuh empat volt atau lebih untuk bergerak, jadi kabel merahnya disambungkan ke pin 5V board, yang membawa daya dari USB, bukan ke 3V3. Di simulator, seperti di meja kerja, servo pada 3,3 V tidak berputar.
Ground adalah kabel yang sering dilupakan orang. Sinyal diukur terhadap ground servo itu sendiri, jadi servo dan ESP32 harus berbagi satu ground. Di sini keduanya menuju jalur ground breadboard. Jika kamu memberi daya servo sungguhan dari catu daya tersendiri, sambungkan ground catu daya itu ke ground board.
Langkah 2: pahami pulsenya
Servo hobby mendengarkan lebar pulsa, bukan siklus kerja dalam arti peredupan cahaya. Menurut angka library Servo Arduino, 544 mikrodetik mengirim horn ke satu ujung, 2400 mikrodetik ke ujung lain, dan 1472 mikrodetik ke tengah, diulang setiap 20 milidetik. Di antara pulsa, servo menahan sudut terakhir yang diterimanya.
Itu tetap gelombang PWM, hanya yang lambat, jadi peripheral LEDC di ESP32 bisa membuatnya. Membuatnya di hardware lebih baik daripada menyalakan-matikan pin dalam loop: lebarnya tepat, tidak ada interupsi yang bisa memanjangkannya, dan inti prosesor bebas di antara frame.
Sinyal 3,3 volt dari ESP32 diterima oleh kebanyakan servo model SG90, jadi kabel sinyalnya biasanya tidak perlu level shifter, meskipun servo itu sendiri berjalan pada 5 volt.
Langkah 3: kodenya, dijelaskan
ledcAttach(SERVO_PIN, 50, 14) memberi GPIO 4 frame 50 hertz yang dibagi menjadi 16384 hitungan, jadi satu hitungan adalah 20000 / 16384, sekitar 1,22 mikrodetik. writeAngle() mengubah 0 sampai 180 derajat menjadi 544 sampai 2400 mikrodetik, jendela library Servo dan bawaan komponen servo, lalu menjadi hitungan: 544 mikrodetik adalah 445 hitungan dan 2400 adalah 1966. Perkalian dilakukan sebelum pembagian agar tidak ada yang hilang karena pembulatan.
setup() menempatkan horn di 90 derajat dan menunggu setengah detik. loop() lalu menggerakkannya dari 0 ke 180 dengan langkah lima derajat, berjarak 40 milidetik, mencetak "at 180", menggerakkannya kembali dan mencetak "back at 0". Buka Serial Monitor untuk melihat dua baris itu muncul setiap kali sapuan selesai.
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");
}Buka sketch ini di editorKodenya saja: editor menempatkan board dan komponen yang bisa dibacanya dari sketch.
Langkah 4: atau gunakan library ESP32Servo
Kebanyakan tutorial servo ESP32 menggunakan library ESP32Servo, yang punya pemanggilan yang sama dengan library Servo Arduino: attach(pin), lalu write(angle). Di Mokxi, ESP32Servo.h adalah kelas yang sama dengan Servo.h dengan nama yang dipakai tutorial-tutorial itu, jadi sketch mereka dikompilasi apa adanya. attach(pin) tanpa lebar pulsa memakai bawaan ESP32Servo sendiri, 544 sampai 2400 mikrodetik, jadi write(90) adalah 1472 mikrodetik dan 90 derajat pada servo.
Versi LEDC di atas tetap layak kamu kenal. Dia menunjukkan apa yang library lakukan untukmu, tidak butuh library sama sekali, dan adalah pilihan yang tepat saat kamu ingin frame rate atau jendela pulsa yang tidak disediakan library.
Coba di editor
Buka rangkaian di editor dan ubah langkah dari 5 menjadi 1 derajat dan delay dari 40 menjadi 10 milidetik: sapuannya jadi lebih halus dan kira-kira sama cepat. Lalu ubah MIN_US dan MAX_US menjadi 1200 dan 1800. Horn kini menempuh busur yang lebih sempit, itulah cara menjauhkan servo dari batas mekanis.
Pindahkan kabel sinyal ke GPIO lain dan ubah SERVO_PIN agar cocok. LEDC bisa diarahkan ke pin output mana pun, jadi servo mengikuti. Pilih servo untuk melihat propertinya, termasuk jendela pulsa dan seberapa cepat ia berputar.
Kesalahan umum
Memberi daya servo dari 3V3. Servo tidak bergerak, atau di meja kerja sungguhan ia bergetar dan macet. Gunakan 5V, atau catu daya 5 volt terpisah dengan ground yang disatukan.
Memakai kode untuk core ESP32 lama. Tutorial yang ditulis untuk versi 2 core Arduino-ESP32 memanggil ledcSetup() dan ledcAttachPin() dengan nomor channel. Versi 3 menggantinya dengan ledcAttach(pin, frequency, resolution) dan ledcWrite(pin, duty), itulah yang dipakai sketch ini.
Berharap board memberi daya servo yang macet. SG90 sungguhan bisa menarik beberapa ratus miliampere saat macet, cukup untuk me-reset ESP32 yang berjalan dari USB. Simulator tidak memodelkan arus catu daya, jadi jika kamu membangun ini sungguhan, beri servo catu daya tersendiri.
Memilih resolusi yang salah. Pada 8 bit, frame 50 hertz hanya punya 256 hitungan masing-masing 78 mikrodetik, jadi servo hanya mendapat sekitar 13 langkah di seluruh jalurnya. Empat belas bit memberi sekitar 819.
Buka rangkaian ini di editor. ESP32-C3: sapuan servo, tersambung seperti yang berjalan di bagian atas halaman ini. Ubah satu komponen atau nilai lalu jalankan lagi.
Buka rangkaian iniPertanyaan
Pin ESP32 mana saja yang bisa mengendalikan servo?
GPIO mana pun yang bisa menjadi output. LEDC bisa diarahkan ke salah satunya. Hindari pin yang board-mu pakai untuk flash atau untuk booting, yang ditandai pada pinout-nya.
Bisakah aku memberi daya SG90 dari pin 3,3 V ESP32?
Tidak. SG90 butuh sekitar 4 sampai 6 volt untuk bergerak. Beri daya dari 5V atau dari catu daya 5 volt tersendiri, dan bagikan ground dengan ESP32. Sinyal 3,3 volt itu sendiri tidak masalah.
Apakah library Servo Arduino bekerja di ESP32?
Bukan yang asli, karena ditulis untuk timer AVR. Library ESP32Servo punya pemanggilan yang sama dan dipakai oleh tutorial-tutorial ESP32. Di Mokxi, Servo.h dan ESP32Servo.h keduanya bisa dikompilasi untuk board ESP32.
Berapa banyak servo yang bisa dikendalikan satu ESP32?
Sebanyak channel LEDC dan pin output bebas yang dimilikinya: ESP32-C3 punya enam channel LEDC dan ESP32 klasik punya enam belas. Untuk lebih banyak, atau untuk menghemat pin, board PCA9685 mengendalikan enam belas servo lewat I2C.
Lanjutkan
Rakit versi nyatanya
Buka editor, ubah sebuah nilai, dan lihat angkanya ikut berubah. Tidak ada yang perlu dipasang, dan tidak perlu akun.