Öğren

Bir ESP32 ile servo motor kontrolü

Başlangıç

Ya da tüm dersleri gör.

  • 526parça tezgahta
  • 46kart şu an çalışıyor
  • 1.00xgerçek zamanlı, her kartta
ESP32-C3: servo taramasıcanlı0.000 s 0.00x
Düzenleyicide açmak için tıkla
GPIO 4'te bir SG90, 50 Hz'lik bir LEDC kanalıyla 0'dan 180 dereceye ve geri taranır.

Bir ESP32 ile servo kontrol etmek için servoyu 5 V ile besle, toprakları birleştir, sinyalini bir GPIO pinine bağla ve saniyede elli kez 544 ile 2400 mikrosaniye genişliğinde bir sinyal gönder. Bir ESP32'de LEDC çevre birimi bu sinyali donanımda üretir: ledcAttach(pin, 50, 14) çerçeveyi kurar ve ledcWrite(pin, duty) açıyı ayarlar.

Yukarıdaki devre, bir ESP32-C3 kartının GPIO 4 pinine bağlı SG90 tarzı bir servo ile 0'dan 180 dereceye ve geri tarama yapıyor. Tarayıcında simüle edilmiş bir ESP32-C3 üzerinde çalışıyor ve kod, gerçek karta yükleyeceğin kodun aynısı.

Neye ihtiyacın var?

  • Bir ESP32 kart (burada bir ESP32-C3-DevKitM-1; klasik ESP32 DevKit aynı şekilde kablolanır)
  • Bir SG90 (ya da benzeri) hobi servosu
  • Jumper kablolar ve besleme hatları için bir breadboard

Kablolama

Parça ve pinGittiği yerNot
Servo kahverengi kablo (GND)GNDBreadboard'un toprak hattı üzerinden
Servo kırmızı kablo (VCC)5V3V3 değil: SG90 4 V veya daha fazlasını ister
Servo turuncu kablo (sinyal)GPIO 4Çıkış olarak kullanılabilen herhangi bir boş GPIO

Adım 1: önce beslemeyi kablolamak

Servonun üç kablosu vardır. Kahverengi (veya siyah) toprak, kırmızı besleme ve turuncu (veya sarı ya da beyaz) sinyaldir. ESP32 3.3 voltluk bir karttır ama SG90 hareket etmek için dört volt veya daha fazlasına ihtiyaç duyar, bu yüzden kırmızı kablosu USB beslemesini taşıyan kartın 5V pinine gider, 3V3'e değil. Simülatörde de tezgahta olduğu gibi, 3.3 V alan bir servo dönmez.

Toprak, insanların unuttuğu kablodur. Sinyal servonun kendi toprağına göre ölçülür, yani servo ile ESP32 aynı toprağı paylaşmalıdır. Burada ikisi de breadboard'un toprak hattına gidiyor. Gerçek bir servoyu kendi kaynağından beslersen, o kaynağın toprağını kartın toprağına bağla.

Adım 2: darbeyi anlamak

Hobi servosu, karartma anlamındaki görev çevrimine değil, darbenin genişliğine bakar. Arduino Servo kütüphanesinin rakamlarına göre 544 mikrosaniye boynuzu bir uca, 2400 mikrosaniye diğer uca ve 1472 mikrosaniye ortaya gönderir; bu, her 20 milisaniyede bir tekrarlanır. Darbeler arasında kendisine söylenen son açıyı korur.

Bu yine bir PWM dalga formudur, sadece yavaş olanı, dolayısıyla ESP32'nin LEDC çevre birimi bunu üretebilir. Bunu donanımda üretmek, bir pini döngü içinde açıp kapatmaktan iyidir: genişlik tamdır, bir kesmenin yapacağı hiçbir şey onu uzatamaz ve çekirdek kareler arasında boş kalır.

ESP32'den gelen 3.3 voltluk sinyali çoğu SG90 tarzı servo kabul eder, bu yüzden servonun kendisi 5 voltla çalışsa bile sinyal kablosuna genellikle seviye dönüştürücü gerekmez.

Adım 3: kod, açıklamalı

ledcAttach(SERVO_PIN, 50, 14), GPIO 4'e 16384 sayıma bölünmüş 50 hertzlik bir kare verir, yani bir sayım 20000 / 16384, yaklaşık 1.22 mikrosaniyedir. writeAngle(), 0 ile 180 dereceyi 544 ile 2400 mikrosaniyeye, yani Servo kütüphanesinin penceresine ve servo parçasının varsayılanına, sonra sayımlara çevirir: 544 mikrosaniye 445 sayım ve 2400 ise 1966 sayımdır. Çarpma bölmeden önce gelir, böylece yuvarlamaya hiçbir şey kaybolmaz.

setup() boynuzu 90 derecede park eder ve yarım saniye bekler. loop() sonra onu 0'dan 180'e beş derecelik adımlarla, 40 milisaniye arayla yürütür, "at 180" yazdırır, geri yürütür ve "back at 0" yazdırır. Her süpürme bittiğinde iki satırın geldiğini görmek için seri monitörü aç.

ESP32-C3 servo örneği, hafifçe kısaltılmış
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");
}

Bu kodu düzenleyicide açSadece kod: düzenleyici, kartı ve koddan okuyabildiği parçaları yerleştirir.

Adım 4: ya da ESP32Servo kütüphanesini kullan

Çoğu ESP32 servo eğitimi, Arduino Servo kütüphanesiyle aynı çağrılara sahip ESP32Servo kütüphanesini kullanır: attach(pin), sonra write(angle). Mokxi'de ESP32Servo.h, Servo.h ile aynı sınıftır, sadece o eğitimlerin kullandığı adla; böylece kodları oldukları gibi derlenir. Genişlik verilmeyen attach(pin), ESP32Servo'nun kendi varsayılanlarını, 544 ile 2400 mikrosaniyeyi kullanır, dolayısıyla write(90) 1472 mikrosaniye ve servoda 90 derecedir.

Yukarıdaki LEDC sürümünü yine de bilmeye değer. Kütüphanenin senin için ne yaptığını gösterir, hiç kütüphane gerektirmez ve kütüphanenin sunmadığı bir kare hızı ya da darbe penceresi istediğinde başvurulacak çağrıdır.

Düzenleyicide dene

Devreyi düzenleyicide aç ve adımı 5'ten 1 dereceye, gecikmeyi 40'tan 10 milisaniyeye değiştir: süpürme daha akıcı olur ve hız aşağı yukarı aynı kalır. Sonra MIN_US ve MAX_US değerlerini 1200 ve 1800 yap. Boynuz artık daha dar bir yay çizer, bu da bir servoyu mekanik bir durdurucudan uzak tutmanın yoludur.

Sinyal kablosunu başka bir GPIO'ya taşı ve SERVO_PIN'i ona uyacak şekilde değiştir. LEDC herhangi bir çıkış pinine yönlendirilebilir, yani servo peşinden gider. Servoyu seçerek darbe penceresi ve dönüş hızının da dahil olduğu özelliklerini gör.

Sık yapılan hatalar

Servoyu 3V3'ten beslemek. Servo hareket etmez ya da gerçek bir tezgaha bunu yaparsan seğirir ve takılır. 5V kullan ya da toprakları birleştirilmiş ayrı bir 5 voltluk kaynak kullan.

Eski ESP32 çekirdeği için yazılmış kod kullanmak. Arduino-ESP32 çekirdeğinin 2. sürümü için yazılmış eğitimler ledcSetup() ve ledcAttachPin()'i bir kanal numarasıyla çağırır. 3. sürüm bunların yerini ledcAttach(pin, frequency, resolution) ve ledcWrite(pin, duty) ile aldı; bu kodun kullandığı da budur.

Kartın durmuş bir servoyu besleyeceğini sanmak. Gerçek bir SG90 durduğunda birkaç yüz miliamper çekebilir, bu da USB'den çalışan bir ESP32'yi sıfırlamaya yeter. Simülatör kaynak akımını modellemez, bu yüzden bunu gerçekten kuracaksan servoya kendi kaynağını ver.

Yanlış çözünürlük seçmek. 8 bitta 50 hertzlik bir karede yalnızca her biri 78 mikrosaniyelik 256 sayım vardır, yani servo tüm yolculuğu boyunca yaklaşık 13 adım alır. On dört bit yaklaşık 819 adım verir.

Bu devreyi düzenleyicide aç. ESP32-C3: servo süpürme, bu sayfanın üstünde çalıştığı haliyle kablolanmış. Bir parçayı ya da değeri değiştir ve yeniden çalıştır.

Devreyi aç

Sorular

Hangi ESP32 pinleri bir servoyu kontrol edebilir?

Çıkış olarak kullanılabilen herhangi bir GPIO. LEDC herhangi birine yönlendirilebilir. Kartının flash veya önyükleme için kullandığı pinlerden kaçın, kartın pin şeması bunları işaretler.

Bir SG90'u ESP32'nin 3.3 V pininden besleyebilir miyim?

Hayır. SG90 hareket etmek için yaklaşık 4 ila 6 volta ihtiyaç duyar. 5V'dan ya da kendi 5 voltluk kaynağından besle ve toprağı ESP32 ile paylaş. 3.3 voltluk sinyalin kendisi sorun değildir.

Arduino Servo kütüphanesi ESP32'de çalışır mı?

AVR zamanlayıcıları için yazılmış orijinali değil. ESP32Servo kütüphanesi aynı çağrılara sahiptir ve ESP32 eğitimlerinin kullandığı odur. Mokxi'de hem Servo.h hem ESP32Servo.h, ESP32 kartları için derlenir.

Bir ESP32 kaç servoyu sürebilir?

Boş LEDC kanalı ve çıkış pini olduğu kadar: ESP32-C3'te altı, klasik ESP32'de on altı LEDC kanalı vardır. Daha fazlası için ya da pin tasarrufu için bir PCA9685 kartı, I2C üzerinden on altı servoyu sürer.

Bunu gerçekten kur

Düzenleyiciyi aç, bir değeri değiştir ve sayının onunla birlikte değiştiğini izle. Kurulacak bir şey yok, hesaba da gerek yok.