Denge robotu demosu: eğim açısı kayıyor veya titriyor, canlı ayar verisi gönderirken rate_limit bağlantı kopmaları yaşıyorum
Yapay zekâ tarafından English dilinden çevrildi ·
Bir fuar standımız için yan proje: Hermetry paneli üzerinde kendi canlı verilerini gösteren iki tekerlekli bir denge robotu. ESP32, I2C üzerinden MPU6050, TB6612FNG sürücüde enkoderli iki adet 12 V redüktörlü motor. Denge döngüsü ve telemetri aynı sketch içinde.İki sorun var, muhtemelen birbiriyle ilişkili.Açı. Yalnızca ivmeölçerden (atan2(ax, az)) hesaplanan eğim, motorlar çalışırken çok titriyor. Yalnızca jiroskoptan (gy integre edilerek) hesaplanan açı ise pürüzsüz ama dakikada birkaç derece kayıyor. İvmeölçer açısı üzerinde bir PID kullandığımda robot giderek daha şiddetli salınıyor ve 3 saniye içinde düşüyor.Veri. Ayar yapabilmek için açı, PID çıkışı ve motor hızı grafiklerini istedim, bu yüzden her döngüyü 200 Hz ile v1/telemetry konusuna yayınlıyorum. Birkaç saniye içinde cihazın bağlantısı kopuyor ve Log sekmesi neden olarak rate_limit gösteriyor.
Side project for our booth at a trade show: a two-wheeled balancing robot that shows its own live data on a Hermetry dashboard. ESP32, MPU6050 over I2C, two 12 V gear motors with encoders on a TB6612FNG driver. Balancing loop and telemetry in the same sketch.
Two problems, possibly related.
The angle. From the accelerometer alone (atan2(ax, az)) the tilt jitters a lot when the motors run. From the gyro alone (integrating gy) it’s smooth but drifts a few degrees per minute. With a PID on the accelerometer angle the robot oscillates harder and harder and falls within 3 seconds.
The data. To tune I wanted charts of angle, PID output and motor speed, so I publish every loop at 200 Hz to v1/telemetry. Within seconds the device is disconnected, and the Log tab shows rate_limit as the reason.
Yapay zekâ tarafından English dilinden çevrildi ·
MPU6050 üzerindeki DMP’yi kullanabilir misiniz? Açı hesaplamalarını sizin yerinize yaptığını düşünmüştüm.
Could you use the DMP on the MPU6050? I thought it does the angle maths for you.
Yapay zekâ tarafından English dilinden çevrildi ·
Veri tarafında: bir cihaz profili varsayılan olarak saniyede 10 telemetri mesajına izin verir. Saniyede 200 mesajda bu sınırı aşarsınız ve bunu sürdüren bir cihazın oturumu kapatılır.
On the data side: a device profile allows 10 telemetry messages a second by default. At 200 a second you blow through it and a device that keeps doing that gets its session closed.
Yapay zekâ tarafından English dilinden çevrildi ·
Bu, bağlantı kopmalarını açıklıyor. Peki insanlar atılmadan ayar için hızlı veri nasıl alıyor?
That explains the disconnects. So how do people get fast data for tuning, without getting kicked?
Yapay zekâ tarafından English dilinden çevrildi ·
Birkaç yıl önce çocuğumla birlikte bunlardan birini yaptım ve iki hatayı da yaptım.Açı: iki sensörü tamamlayıcı bir filtreyle birleştirin. Jiroskop kısa vadede iyidir, ivmeölçer uzun vadede:
// fixed 200 Hz loop from a hardware timer, dt = 0.005
float accAngle = atan2f(ax, az) * RAD_TO_DEG;
angle = 0.98f * (angle + gy * dt) + 0.02f * accAngle;
Yoğun bir döngüde millis() farklarını değil, bir zamanlayıcıdan sabit bir döngü hızı kullanın ve MQTT’yi bu döngünün tamamen dışında tutun. Wilson’ın DMP yöntemi de işe yarar, ancak sizi o çipin kütüphanesine bağlar.PID: yalnızca P ile başlayın ve robot dik konum etrafında salınım yapana kadar artırın, ardından salınım sönene kadar D ekleyin, sonra sapma için küçük bir I ekleyin. Ayrıca motorların ölü bant değerini çıkışa ekleyin; dişli motorlar birkaç yüzde görev döngüsünün altında dönmez.Veri: hızlı döngüde örnek toplayın, 20 Hz’e seyreltin ve her biri kendi zaman damgasına sahip kayıtlardan oluşan bir dizi olarak saniyede bir mesaj gönderin:
[
{"ts": 1767600000000, "values": {"bal.angle": 0.42, "bal.out": 12.5, "bal.speed": 3.1}},
{"ts": 1767600000050, "values": {"bal.angle": 0.38, "bal.out": 11.9, "bal.speed": 3.0}},
...
]
Bu, 20 x 3 = 60 veri noktası içeren saniyede 1 mesajdır ve cihaz başına varsayılanların (saniyede 10 mesaj, saniyede 200 nokta ve dakikada 6.000) içindedir. Planınızda ayrıca kuruluş genelinde dakika başına veri noktası sınırı da var, bu yüzden diğer cihazlar yoğunsa Kullanım bölümünü kontrol edin. ESP32’nin ts için NTP zamanına ihtiyacı var; aksi halde ts alanını dışarıda bırakın. Son 24 saatlik bir grafik her ham noktayı gösterir, bu yüzden ayar eğrileri keskin kalır. Yük formatları: MQTT konuları ve yük başvurusu.
Built one of these with my kid a couple of years ago and made both mistakes.
Angle: combine the two sensors with a complementary filter. The gyro is good short-term, the accelerometer long-term:
// fixed 200 Hz loop from a hardware timer, dt = 0.005
float accAngle = atan2f(ax, az) * RAD_TO_DEG;
angle = 0.98f * (angle + gy * dt) + 0.02f * accAngle;
Use a fixed loop rate from a timer, not millis() differences in a busy loop, and keep MQTT out of that loop entirely. Wilson’s DMP route works too, it just ties you to that chip’s library.
PID: start with P only and raise it until the robot oscillates around upright, then add D until the oscillation dies down, then a small I for drift. And add the motors’ deadband to the output, gear motors don’t move below a few percent duty.
Data: collect samples in the fast loop, decimate to 20 Hz, and send one message per second as an array of records with their own timestamps:
[
{"ts": 1767600000000, "values": {"bal.angle": 0.42, "bal.out": 12.5, "bal.speed": 3.1}},
{"ts": 1767600000050, "values": {"bal.angle": 0.38, "bal.out": 11.9, "bal.speed": 3.0}},
...
]
That is 1 message a second with 20 x 3 = 60 data points, inside the per-device defaults (10 messages a second, 200 points a second and 6,000 a minute). Your plan has an organisation-wide data points per minute limit too, so check Usage if other devices are busy. The ESP32 needs NTP time for ts, otherwise leave ts out. A chart over the last 24 hours shows every raw point, so the tuning curves stay sharp. Payload forms: MQTT topics and payload reference.
Yapay zekâ tarafından English dilinden çevrildi ·
Gerçekten ince ayar için ayrıca tam 200 Hz veriyi bir SD karta kaydederdim ve fuar standındaki pano için Hermetry’yi kullanmaya devam ederdim. İki farklı iş.
For the really fine tuning I’d also log the full 200 Hz to an SD card and keep Hermetry for the booth dashboard. Two different jobs.
Yapay zekâ tarafından English dilinden çevrildi ·
0,98 değerinde tamamlayıcı filtre ve zamanlayıcı tarafından sürülen bir döngü; sonuç bu şekilde kalıyor. P=18, D=0.6, küçük bir I ve %6 ölü bant ile ayarladım. Saniyede 1 mesaj olacak şekilde, 20 Hz’de toplu gönderim çalışıyor; artık rate_limit hatası yok ve stant üzerindeki açı grafiği çok iyi görünüyor. Hatam, kontrol döngüsünün içinden yayın yapmaktı; her yayın döngüyü uzatıyor ve salınımı daha da kötüleştiriyordu.
Complementary filter at 0.98 and a timer-driven loop, and it stands. Tuned it with P=18, D=0.6, a tiny I, plus a 6 % deadband. The 1 message per second batches at 20 Hz work, no more rate_limit, and the angle chart on the booth board looks great. My mistake was publishing from inside the control loop, every publish stretched the loop and made the oscillation worse too.
- Bu konuyu yanıtlamak için giriş yapmış olmalısınız.
Sohbete katılın
Soru sormak ve yanıtlamak, yararlı gönderileri beğenmek ve sorununuzu çözen yanıtı işaretlemek için oturum açın. Her katkı puan ve seviye kazandırır.

